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> 460c0d06caSMauro Carvalho Chehab #include <media/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); 19995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_stream, 0); 2000560f337SMauro Carvalho Chehab } 2010560f337SMauro Carvalho Chehab 20201c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2030560f337SMauro Carvalho Chehab { 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2090560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2100560f337SMauro Carvalho Chehab 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2160560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2170560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2180560f337SMauro Carvalho Chehab } 2190560f337SMauro Carvalho Chehab 22001c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2210560f337SMauro Carvalho Chehab { 2220560f337SMauro Carvalho Chehab int ret; 2230560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 224753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2250560f337SMauro Carvalho Chehab 22606e20672SFrank Schaefer fmt = v4l2->format->reg; 2270560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2280560f337SMauro Carvalho Chehab fmt |= 0x20; 2290560f337SMauro Carvalho Chehab /* 2300560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2310560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2320560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2330560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2340560f337SMauro Carvalho Chehab * 2350560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2360560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2370560f337SMauro Carvalho Chehab */ 2380560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2390560f337SMauro Carvalho Chehab if (ret < 0) 2400560f337SMauro Carvalho Chehab return ret; 2410560f337SMauro Carvalho Chehab 2429297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2430560f337SMauro Carvalho Chehab if (ret < 0) 2440560f337SMauro Carvalho Chehab return ret; 2450560f337SMauro Carvalho Chehab 2469297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2470560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2480560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2490560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 250753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 251753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25252faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2530560f337SMauro Carvalho Chehab /* NTSC */ 2540560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25552faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2560560f337SMauro Carvalho Chehab /* PAL */ 2570560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2580560f337SMauro Carvalho Chehab } 2590560f337SMauro Carvalho Chehab } 2600560f337SMauro Carvalho Chehab 2610560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2620560f337SMauro Carvalho Chehab } 2630560f337SMauro Carvalho Chehab 2640560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2650560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2660560f337SMauro Carvalho Chehab { 2670560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2680560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2690560f337SMauro Carvalho Chehab 2700560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2720560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2730560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2740560f337SMauro Carvalho Chehab } 2750560f337SMauro Carvalho Chehab 2760560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2770560f337SMauro Carvalho Chehab u16 width, u16 height) 2780560f337SMauro Carvalho Chehab { 2790560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2800560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2810560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2820560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2830560f337SMauro Carvalho Chehab 2840560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2850560f337SMauro Carvalho Chehab hstart, vstart, 2860560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2870560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2880560f337SMauro Carvalho Chehab 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2930560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2940560f337SMauro Carvalho Chehab 2950560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2960560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2970560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2990560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 3000560f337SMauro Carvalho Chehab } 3010560f337SMauro Carvalho Chehab } 3020560f337SMauro Carvalho Chehab 3030560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3040560f337SMauro Carvalho Chehab { 305cba8e9b3SFrank Schaefer u8 mode = 0x00; 3060560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3070560f337SMauro Carvalho Chehab 3080560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3090560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3100560f337SMauro Carvalho Chehab } else { 3110560f337SMauro Carvalho Chehab u8 buf[2]; 3120560f337SMauro Carvalho Chehab 3130560f337SMauro Carvalho Chehab buf[0] = h; 3140560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3150560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3160560f337SMauro Carvalho Chehab 3170560f337SMauro Carvalho Chehab buf[0] = v; 3180560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3190560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3200560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3210560f337SMauro Carvalho Chehab to work correctly */ 3220560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3230560f337SMauro Carvalho Chehab } 324cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3250560f337SMauro Carvalho Chehab } 3260560f337SMauro Carvalho Chehab 3270560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32801c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3290560f337SMauro Carvalho Chehab { 330753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 331753aee77SFrank Schaefer int width = norm_maxw(dev); 332753aee77SFrank Schaefer int height = norm_maxh(dev); 3330560f337SMauro Carvalho Chehab 3340560f337SMauro Carvalho Chehab /* Properly setup VBI */ 335753aee77SFrank Schaefer v4l2->vbi_width = 720; 33652faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 337753aee77SFrank Schaefer v4l2->vbi_height = 12; 3380560f337SMauro Carvalho Chehab else 339753aee77SFrank Schaefer v4l2->vbi_height = 18; 3400560f337SMauro Carvalho Chehab 3410560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3420560f337SMauro Carvalho Chehab 3430560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3440560f337SMauro Carvalho Chehab 3450560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3460560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3470560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3480560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3490560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3500560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3510560f337SMauro Carvalho Chehab region */ 3520560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3530560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3540560f337SMauro Carvalho Chehab else 3550560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3560560f337SMauro Carvalho Chehab 357753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3580560f337SMauro Carvalho Chehab } 3590560f337SMauro Carvalho Chehab 3600560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36101c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3620560f337SMauro Carvalho Chehab { 363753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 3640560f337SMauro Carvalho Chehab int errCode; 3650560f337SMauro Carvalho Chehab int i; 366753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3670560f337SMauro Carvalho Chehab 3680560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3690560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3700560f337SMauro Carvalho Chehab dev->alt = 0; 3710560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3720560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3730560f337SMauro Carvalho Chehab dev->alt = alt; 3740560f337SMauro Carvalho Chehab goto set_alt; 3750560f337SMauro Carvalho Chehab } 3760560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3770560f337SMauro Carvalho Chehab goto set_alt; 3780560f337SMauro Carvalho Chehab 3790560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3800560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3810560f337SMauro Carvalho Chehab green screen will be received. 3820560f337SMauro Carvalho Chehab */ 383753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3840560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3850560f337SMauro Carvalho Chehab 3860560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3870560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3880560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3890560f337SMauro Carvalho Chehab dev->alt = i; 3900560f337SMauro Carvalho Chehab break; 3910560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3920560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3930560f337SMauro Carvalho Chehab */ 3940560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3950560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3960560f337SMauro Carvalho Chehab dev->alt = i; 3970560f337SMauro Carvalho Chehab } 3980560f337SMauro Carvalho Chehab 3990560f337SMauro Carvalho Chehab set_alt: 4000560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4010560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4020560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4030560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4040560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4050560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4060560f337SMauro Carvalho Chehab } else { /* isoc */ 4070560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4080560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4090560f337SMauro Carvalho Chehab dev->max_pkt_size = 4100560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4110560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4120560f337SMauro Carvalho Chehab } 4130560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4140560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 415961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 4160560f337SMauro Carvalho Chehab if (errCode < 0) { 4170560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 4180560f337SMauro Carvalho Chehab dev->alt, errCode); 4190560f337SMauro Carvalho Chehab return errCode; 4200560f337SMauro Carvalho Chehab } 4210560f337SMauro Carvalho Chehab return 0; 4220560f337SMauro Carvalho Chehab } 4230560f337SMauro Carvalho Chehab 4240c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4250c0d06caSMauro Carvalho Chehab DMA and thread functions 4260c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4270c0d06caSMauro Carvalho Chehab 4280c0d06caSMauro Carvalho Chehab /* 429948a49aaSFrank Schaefer * Finish the current buffer 4300c0d06caSMauro Carvalho Chehab */ 431948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4320c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4330c0d06caSMauro Carvalho Chehab { 434d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 435d3829fadSDevin Heitmueller 436f0e38230SFrank Schaefer buf->vb.v4l2_buf.sequence = dev->v4l2->field_count++; 437662c97cfSFrank Schaefer if (dev->v4l2->progressive) 438662c97cfSFrank Schaefer buf->vb.v4l2_buf.field = V4L2_FIELD_NONE; 439662c97cfSFrank Schaefer else 440d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 441d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 442d3829fadSDevin Heitmueller 443d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4440c0d06caSMauro Carvalho Chehab } 4450c0d06caSMauro Carvalho Chehab 4460c0d06caSMauro Carvalho Chehab /* 44736016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4480c0d06caSMauro Carvalho Chehab */ 4490c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4500c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45136016a35SFrank Schaefer unsigned char *usb_buf, 4524078d625SFrank Schaefer unsigned long len) 4530c0d06caSMauro Carvalho Chehab { 45458159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4550c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4560c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45758159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4580c0d06caSMauro Carvalho Chehab 459d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 460d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4610c0d06caSMauro Carvalho Chehab 46236016a35SFrank Schaefer startread = usb_buf; 4630c0d06caSMauro Carvalho Chehab remain = len; 4640c0d06caSMauro Carvalho Chehab 46558159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46636016a35SFrank Schaefer fieldstart = buf->vb_buf; 467c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46836016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4690c0d06caSMauro Carvalho Chehab 4708732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4718732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4720c0d06caSMauro Carvalho Chehab 47358159171SFrank Schaefer if (v4l2->progressive) 4740c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4750c0d06caSMauro Carvalho Chehab else 4760c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4770c0d06caSMauro Carvalho Chehab 4780c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4790c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4800c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4810c0d06caSMauro Carvalho Chehab 482d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4837983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4840c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 485d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 486d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48736016a35SFrank Schaefer (char *)startwrite; 4880c0d06caSMauro Carvalho Chehab lencopy = remain; 4890c0d06caSMauro Carvalho Chehab } 4900c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4910c0d06caSMauro Carvalho Chehab return; 4920c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4930c0d06caSMauro Carvalho Chehab 4940c0d06caSMauro Carvalho Chehab remain -= lencopy; 4950c0d06caSMauro Carvalho Chehab 4960c0d06caSMauro Carvalho Chehab while (remain > 0) { 49758159171SFrank Schaefer if (v4l2->progressive) 498c02ec71bSFrank Schaefer startwrite += lencopy; 499c02ec71bSFrank Schaefer else 5000c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5010c0d06caSMauro Carvalho Chehab startread += lencopy; 5020c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5030c0d06caSMauro Carvalho Chehab lencopy = remain; 5040c0d06caSMauro Carvalho Chehab else 5050c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5060c0d06caSMauro Carvalho Chehab 50736016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 508d3829fadSDevin Heitmueller buf->length) { 5097983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end" 5100c0d06caSMauro Carvalho Chehab "(2)\n", 5110c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 512d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 513d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5140c0d06caSMauro Carvalho Chehab (char *)startwrite; 5150c0d06caSMauro Carvalho Chehab } 5160c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5170c0d06caSMauro Carvalho Chehab break; 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5200c0d06caSMauro Carvalho Chehab 5210c0d06caSMauro Carvalho Chehab remain -= lencopy; 5220c0d06caSMauro Carvalho Chehab } 5230c0d06caSMauro Carvalho Chehab 5248732533bSFrank Schaefer buf->pos += len; 5250c0d06caSMauro Carvalho Chehab } 5260c0d06caSMauro Carvalho Chehab 52736016a35SFrank Schaefer /* 52836016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52936016a35SFrank Schaefer */ 5300c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53236016a35SFrank Schaefer unsigned char *usb_buf, 5334078d625SFrank Schaefer unsigned long len) 5340c0d06caSMauro Carvalho Chehab { 53536016a35SFrank Schaefer unsigned int offset; 5360c0d06caSMauro Carvalho Chehab 537d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 538d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5390c0d06caSMauro Carvalho Chehab 5408732533bSFrank Schaefer offset = buf->pos; 5410c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54236016a35SFrank Schaefer if (buf->top_field == 0) 543753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5440c0d06caSMauro Carvalho Chehab 54536016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5468732533bSFrank Schaefer buf->pos += len; 5470c0d06caSMauro Carvalho Chehab } 5480c0d06caSMauro Carvalho Chehab 5490c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5500c0d06caSMauro Carvalho Chehab int packet, int status) 5510c0d06caSMauro Carvalho Chehab { 5520c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5530c0d06caSMauro Carvalho Chehab 5540c0d06caSMauro Carvalho Chehab switch (status) { 5550c0d06caSMauro Carvalho Chehab case -ENOENT: 5560c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5570c0d06caSMauro Carvalho Chehab break; 5580c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5590c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5600c0d06caSMauro Carvalho Chehab break; 5610c0d06caSMauro Carvalho Chehab case -ENOSR: 5620c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5630c0d06caSMauro Carvalho Chehab break; 5640c0d06caSMauro Carvalho Chehab case -EPIPE: 5650c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5660c0d06caSMauro Carvalho Chehab break; 5670c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5680c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5690c0d06caSMauro Carvalho Chehab break; 5700c0d06caSMauro Carvalho Chehab case -EPROTO: 5710c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5720c0d06caSMauro Carvalho Chehab break; 5730c0d06caSMauro Carvalho Chehab case -EILSEQ: 5740c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5750c0d06caSMauro Carvalho Chehab break; 5760c0d06caSMauro Carvalho Chehab case -ETIME: 5770c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5780c0d06caSMauro Carvalho Chehab break; 5790c0d06caSMauro Carvalho Chehab } 5800c0d06caSMauro Carvalho Chehab if (packet < 0) { 5810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5820c0d06caSMauro Carvalho Chehab } else { 5830c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5840c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab } 5870c0d06caSMauro Carvalho Chehab 5880c0d06caSMauro Carvalho Chehab /* 58924a6d849SFrank Schaefer * get the next available buffer from dma queue 5900c0d06caSMauro Carvalho Chehab */ 59124a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59224a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5930c0d06caSMauro Carvalho Chehab { 59424a6d849SFrank Schaefer struct em28xx_buffer *buf; 5950c0d06caSMauro Carvalho Chehab 5960c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5970c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59824a6d849SFrank Schaefer return NULL; 5990c0d06caSMauro Carvalho Chehab } 6000c0d06caSMauro Carvalho Chehab 6010c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 602d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6030c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 604d3829fadSDevin Heitmueller list_del(&buf->list); 6058732533bSFrank Schaefer buf->pos = 0; 606d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6070c0d06caSMauro Carvalho Chehab 60824a6d849SFrank Schaefer return buf; 6090c0d06caSMauro Carvalho Chehab } 6100c0d06caSMauro Carvalho Chehab 611e04c00d9SFrank Schaefer /* 612e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 613e04c00d9SFrank Schaefer */ 614e04c00d9SFrank Schaefer static struct em28xx_buffer * 615e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 616e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 617e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 618e04c00d9SFrank Schaefer { 61958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 62058159171SFrank Schaefer 621f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 622e04c00d9SFrank Schaefer if (buf != NULL) 623e04c00d9SFrank Schaefer finish_buffer(dev, buf); 624e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 625e04c00d9SFrank Schaefer } 626e04c00d9SFrank Schaefer if (buf != NULL) { 627f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 628e04c00d9SFrank Schaefer buf->pos = 0; 629e04c00d9SFrank Schaefer } 630e04c00d9SFrank Schaefer 631e04c00d9SFrank Schaefer return buf; 632e04c00d9SFrank Schaefer } 633e04c00d9SFrank Schaefer 634227b7c90SFrank Schaefer /* 635227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 636227b7c90SFrank Schaefer */ 637227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 638227b7c90SFrank Schaefer unsigned char *data_pkt, 639227b7c90SFrank Schaefer unsigned int data_len) 640227b7c90SFrank Schaefer { 641753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 642227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 643227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 644227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 645227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 646227b7c90SFrank Schaefer 647227b7c90SFrank Schaefer /* capture type 0 = vbi start 648227b7c90SFrank Schaefer capture type 1 = vbi in progress 649227b7c90SFrank Schaefer capture type 2 = video start 650227b7c90SFrank Schaefer capture type 3 = video in progress */ 651227b7c90SFrank Schaefer if (data_len >= 4) { 652227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 653227b7c90SFrank Schaefer * never split across packets */ 654227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 655227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 656227b7c90SFrank Schaefer /* Continuation */ 657227b7c90SFrank Schaefer data_pkt += 4; 658227b7c90SFrank Schaefer data_len -= 4; 659227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 660227b7c90SFrank Schaefer /* Field start (VBI mode) */ 661f0e38230SFrank Schaefer v4l2->capture_type = 0; 662f0e38230SFrank Schaefer v4l2->vbi_read = 0; 663227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 664f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 665227b7c90SFrank Schaefer data_pkt += 4; 666227b7c90SFrank Schaefer data_len -= 4; 667227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 668227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 669f0e38230SFrank Schaefer v4l2->capture_type = 2; 670227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 671f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 672227b7c90SFrank Schaefer data_pkt += 4; 673227b7c90SFrank Schaefer data_len -= 4; 674227b7c90SFrank Schaefer } 675227b7c90SFrank Schaefer } 676227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 677227b7c90SFrank Schaefer * have no continuation header */ 678227b7c90SFrank Schaefer 679f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 680227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 681227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 682f0e38230SFrank Schaefer v4l2->capture_type = 1; 683227b7c90SFrank Schaefer } 684227b7c90SFrank Schaefer 685f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 686753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 687f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 688f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 689227b7c90SFrank Schaefer 690227b7c90SFrank Schaefer /* Copy VBI data */ 691227b7c90SFrank Schaefer if (vbi_buf != NULL) 692227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 693f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 694227b7c90SFrank Schaefer 695227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 696227b7c90SFrank Schaefer /* Continue with copying video data */ 697f0e38230SFrank Schaefer v4l2->capture_type = 2; 698227b7c90SFrank Schaefer data_pkt += vbi_data_len; 699227b7c90SFrank Schaefer data_len -= vbi_data_len; 700227b7c90SFrank Schaefer } 701227b7c90SFrank Schaefer } 702227b7c90SFrank Schaefer 703f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 704227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 705227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 706f0e38230SFrank Schaefer v4l2->capture_type = 3; 707227b7c90SFrank Schaefer } 708227b7c90SFrank Schaefer 709f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 710227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 711227b7c90SFrank Schaefer } 712227b7c90SFrank Schaefer 713e507e0e5SFrank Schaefer /* 714e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 715e507e0e5SFrank Schaefer */ 716e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 717e507e0e5SFrank Schaefer unsigned char *data_pkt, 718e507e0e5SFrank Schaefer unsigned int data_len) 719e507e0e5SFrank Schaefer { 720e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 721e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 722f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7237e6c8c19SMauro Carvalho Chehab bool frame_end = false; 724e507e0e5SFrank Schaefer 725e507e0e5SFrank Schaefer /* Check for header */ 726e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 727e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 728e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 729e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 730e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 731f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 732e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 733e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 734e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 735e507e0e5SFrank Schaefer data_pkt += 2; 736e507e0e5SFrank Schaefer data_len -= 2; 737e507e0e5SFrank Schaefer } 738e507e0e5SFrank Schaefer 739e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 740e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 741e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 742e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 743e507e0e5SFrank Schaefer } 744e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 745e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 746e507e0e5SFrank Schaefer * first frame. 747e507e0e5SFrank Schaefer */ 748e507e0e5SFrank Schaefer } 749e507e0e5SFrank Schaefer 750e507e0e5SFrank Schaefer /* Copy data */ 751e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 752e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 753e507e0e5SFrank Schaefer 754e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 755e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 756e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 757e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 758e507e0e5SFrank Schaefer } 759e507e0e5SFrank Schaefer 760e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 761e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 762e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 763e507e0e5SFrank Schaefer * header like with the other em28xx devices. 764e507e0e5SFrank Schaefer */ 765e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 766e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 767e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 768e507e0e5SFrank Schaefer } 769e507e0e5SFrank Schaefer 770960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7710fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7720c0d06caSMauro Carvalho Chehab { 773227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 774227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 775227b7c90SFrank Schaefer unsigned int usb_data_len; 7760c0d06caSMauro Carvalho Chehab 7770c0d06caSMauro Carvalho Chehab if (!dev) 7780c0d06caSMauro Carvalho Chehab return 0; 7790c0d06caSMauro Carvalho Chehab 7802665c299SFrank Schaefer if (dev->disconnected) 7810c0d06caSMauro Carvalho Chehab return 0; 7820c0d06caSMauro Carvalho Chehab 7831653cb0cSFrank Schaefer if (urb->status < 0) 7840c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7850c0d06caSMauro Carvalho Chehab 7864601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7874601cc39SFrank Schaefer 7884601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7894601cc39SFrank Schaefer num_packets = 1; 7904601cc39SFrank Schaefer else /* isoc */ 7914601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7920c0d06caSMauro Carvalho Chehab 7934601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7944601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 795227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7964601cc39SFrank Schaefer 797227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7984601cc39SFrank Schaefer } else { /* isoc */ 7994601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8004601cc39SFrank Schaefer print_err_status(dev, i, 8014601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8020c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8030c0d06caSMauro Carvalho Chehab continue; 8040c0d06caSMauro Carvalho Chehab } 8050c0d06caSMauro Carvalho Chehab 806227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 807227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8080c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8090c0d06caSMauro Carvalho Chehab continue; 8100c0d06caSMauro Carvalho Chehab } 8110c0d06caSMauro Carvalho Chehab 812227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8134601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8144601cc39SFrank Schaefer } 8154601cc39SFrank Schaefer 816227b7c90SFrank Schaefer if (usb_data_len == 0) { 8174601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8184601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8194601cc39SFrank Schaefer continue; 8204601cc39SFrank Schaefer } 8210c0d06caSMauro Carvalho Chehab 822e507e0e5SFrank Schaefer if (dev->is_em25xx) 823e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 824e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 825e507e0e5SFrank Schaefer else 826e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 827e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 828e507e0e5SFrank Schaefer 8290c0d06caSMauro Carvalho Chehab } 830227b7c90SFrank Schaefer return 1; 8310c0d06caSMauro Carvalho Chehab } 8320c0d06caSMauro Carvalho Chehab 833d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 834d3829fadSDevin Heitmueller { 835d3829fadSDevin Heitmueller switch (f_type) { 836d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 837d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 838d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 839d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 840d3829fadSDevin Heitmueller default: 841d3829fadSDevin Heitmueller BUG(); 842d3829fadSDevin Heitmueller return 0; 843d3829fadSDevin Heitmueller } 844d3829fadSDevin Heitmueller } 845d3829fadSDevin Heitmueller 846d3829fadSDevin Heitmueller /* Usage lock check functions */ 847d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 848d3829fadSDevin Heitmueller { 849d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 850d3829fadSDevin Heitmueller 851d3829fadSDevin Heitmueller /* is it free? */ 852d3829fadSDevin Heitmueller if (dev->resources & res_type) { 853d3829fadSDevin Heitmueller /* no, someone else uses it */ 854d3829fadSDevin Heitmueller return -EBUSY; 855d3829fadSDevin Heitmueller } 856d3829fadSDevin Heitmueller 857d3829fadSDevin Heitmueller /* it's free, grab it */ 858d3829fadSDevin Heitmueller dev->resources |= res_type; 859d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 860d3829fadSDevin Heitmueller return 0; 861d3829fadSDevin Heitmueller } 862d3829fadSDevin Heitmueller 863d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 864d3829fadSDevin Heitmueller { 865d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 866d3829fadSDevin Heitmueller 867d3829fadSDevin Heitmueller dev->resources &= ~res_type; 868d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 869d3829fadSDevin Heitmueller } 870d3829fadSDevin Heitmueller 8710c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 872d3829fadSDevin Heitmueller Videobuf2 operations 8730c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8740c0d06caSMauro Carvalho Chehab 875d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 876d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 877d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8780c0d06caSMauro Carvalho Chehab { 879d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 880753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 881d3829fadSDevin Heitmueller unsigned long size; 8820c0d06caSMauro Carvalho Chehab 883d3829fadSDevin Heitmueller if (fmt) 884d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 885d3829fadSDevin Heitmueller else 886753aee77SFrank Schaefer size = 88706e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 8880c0d06caSMauro Carvalho Chehab 889d3829fadSDevin Heitmueller if (size == 0) 890d3829fadSDevin Heitmueller return -EINVAL; 8910c0d06caSMauro Carvalho Chehab 892d3829fadSDevin Heitmueller if (0 == *nbuffers) 893d3829fadSDevin Heitmueller *nbuffers = 32; 8940c0d06caSMauro Carvalho Chehab 895d3829fadSDevin Heitmueller *nplanes = 1; 896d3829fadSDevin Heitmueller sizes[0] = size; 8970c0d06caSMauro Carvalho Chehab 8980c0d06caSMauro Carvalho Chehab return 0; 8990c0d06caSMauro Carvalho Chehab } 9000c0d06caSMauro Carvalho Chehab 9010c0d06caSMauro Carvalho Chehab static int 902d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 9030c0d06caSMauro Carvalho Chehab { 904d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 905753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 9060c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 907d3829fadSDevin Heitmueller unsigned long size; 9080c0d06caSMauro Carvalho Chehab 909d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 9100c0d06caSMauro Carvalho Chehab 91106e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 912d3829fadSDevin Heitmueller 913d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 914d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 915d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 9160c0d06caSMauro Carvalho Chehab return -EINVAL; 917d3829fadSDevin Heitmueller } 918d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 9190c0d06caSMauro Carvalho Chehab 920d3829fadSDevin Heitmueller return 0; 9210c0d06caSMauro Carvalho Chehab } 9220c0d06caSMauro Carvalho Chehab 923d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 924d3829fadSDevin Heitmueller { 925d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 926f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 927d3829fadSDevin Heitmueller struct v4l2_frequency f; 928d3829fadSDevin Heitmueller int rc = 0; 9290c0d06caSMauro Carvalho Chehab 930d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 931d3829fadSDevin Heitmueller 932d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 933d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 934d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 935d3829fadSDevin Heitmueller if (rc) 936d3829fadSDevin Heitmueller return rc; 937d3829fadSDevin Heitmueller 9388139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 939d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 940d3829fadSDevin Heitmueller 941d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 942d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 943d3829fadSDevin Heitmueller 944d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 945d3829fadSDevin Heitmueller some i2c device 946d3829fadSDevin Heitmueller */ 947d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 948d3829fadSDevin Heitmueller 949f0e38230SFrank Schaefer v4l2->capture_type = -1; 950c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 951c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9520c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9530c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 954c647a91aSFrank Schaefer dev->packet_multiplier, 9550fa4a402SFrank Schaefer em28xx_urb_data_copy); 9560c0d06caSMauro Carvalho Chehab if (rc < 0) 957032f1ddfSFrank Schaefer return rc; 958d3829fadSDevin Heitmueller 959d3829fadSDevin Heitmueller /* 960d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 961d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 962d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 963d3829fadSDevin Heitmueller */ 964d3829fadSDevin Heitmueller 965d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 966d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 9673854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 968d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 969d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 970d3829fadSDevin Heitmueller else 971d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 972f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 97395d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 9740c0d06caSMauro Carvalho Chehab } 9750c0d06caSMauro Carvalho Chehab 9768139a4d5SFrank Schaefer v4l2->streaming_users++; 977032f1ddfSFrank Schaefer 9780c0d06caSMauro Carvalho Chehab return rc; 9790c0d06caSMauro Carvalho Chehab } 9800c0d06caSMauro Carvalho Chehab 981e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 9820c0d06caSMauro Carvalho Chehab { 983d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9848139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 9850c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 986d3829fadSDevin Heitmueller unsigned long flags = 0; 9870c0d06caSMauro Carvalho Chehab 988d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9890c0d06caSMauro Carvalho Chehab 990d3829fadSDevin Heitmueller res_free(dev, vq->type); 991d3829fadSDevin Heitmueller 9928139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 993d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 994d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9950c0d06caSMauro Carvalho Chehab } 9960c0d06caSMauro Carvalho Chehab 997d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 998627530c3SFrank Schaefer if (dev->usb_ctl.vid_buf != NULL) { 999627530c3SFrank Schaefer vb2_buffer_done(&dev->usb_ctl.vid_buf->vb, VB2_BUF_STATE_ERROR); 1000627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1001627530c3SFrank Schaefer } 1002d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1003d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1004fdf1bc9fSMauro Carvalho Chehab 1005d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1006d3829fadSDevin Heitmueller list_del(&buf->list); 1007d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1008d3829fadSDevin Heitmueller } 1009d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1010d3829fadSDevin Heitmueller } 1011d3829fadSDevin Heitmueller 1012e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 10130c0d06caSMauro Carvalho Chehab { 1014d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 10158139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1016d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1017d3829fadSDevin Heitmueller unsigned long flags = 0; 10180c0d06caSMauro Carvalho Chehab 1019d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 10200c0d06caSMauro Carvalho Chehab 1021d3829fadSDevin Heitmueller res_free(dev, vq->type); 1022d3829fadSDevin Heitmueller 10238139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 1024d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1025d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 10260c0d06caSMauro Carvalho Chehab } 10270c0d06caSMauro Carvalho Chehab 1028d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1029627530c3SFrank Schaefer if (dev->usb_ctl.vbi_buf != NULL) { 1030627530c3SFrank Schaefer vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb, VB2_BUF_STATE_ERROR); 1031627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1032627530c3SFrank Schaefer } 1033d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1034d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1035fdf1bc9fSMauro Carvalho Chehab 1036d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1037d3829fadSDevin Heitmueller list_del(&buf->list); 1038d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1039d3829fadSDevin Heitmueller } 1040d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1041d3829fadSDevin Heitmueller } 1042d3829fadSDevin Heitmueller 1043d3829fadSDevin Heitmueller static void 1044d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1045d3829fadSDevin Heitmueller { 1046d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1047d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 1048d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1049d3829fadSDevin Heitmueller unsigned long flags = 0; 1050d3829fadSDevin Heitmueller 1051d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1052d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1053d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1054d3829fadSDevin Heitmueller 1055d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1056d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1057d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1058d3829fadSDevin Heitmueller } 1059d3829fadSDevin Heitmueller 1060d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1061d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10620c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10630c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1064d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1065d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1066d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1067d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10680c0d06caSMauro Carvalho Chehab }; 10690c0d06caSMauro Carvalho Chehab 107001c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1071d3829fadSDevin Heitmueller { 1072d3829fadSDevin Heitmueller int rc; 1073d3829fadSDevin Heitmueller struct vb2_queue *q; 107427a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1075d3829fadSDevin Heitmueller 1076d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 107727a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1078d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1079ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1080ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1081d3829fadSDevin Heitmueller q->drv_priv = dev; 1082d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1083d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1084d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1085d3829fadSDevin Heitmueller 1086d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1087d3829fadSDevin Heitmueller if (rc < 0) 1088d3829fadSDevin Heitmueller return rc; 1089d3829fadSDevin Heitmueller 1090d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 109127a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1092d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1093d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1094ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1095d3829fadSDevin Heitmueller q->drv_priv = dev; 1096d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1097d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1098d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1099d3829fadSDevin Heitmueller 1100d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1101d3829fadSDevin Heitmueller if (rc < 0) 1102d3829fadSDevin Heitmueller return rc; 1103d3829fadSDevin Heitmueller 1104d3829fadSDevin Heitmueller return 0; 1105d3829fadSDevin Heitmueller } 1106d3829fadSDevin Heitmueller 11070c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 11080c0d06caSMauro Carvalho Chehab 11090c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 11100c0d06caSMauro Carvalho Chehab { 111195d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1112fdf1bc9fSMauro Carvalho Chehab 11130c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 11140c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 11150c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 11160c0d06caSMauro Carvalho Chehab 11170c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11180c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11190c0d06caSMauro Carvalho Chehab 112095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 11210c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 11220c0d06caSMauro Carvalho Chehab 11230c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 11240c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 112595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 11260c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 11270c0d06caSMauro Carvalho Chehab } 11280c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 112995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1130fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1131fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 11320c0d06caSMauro Carvalho Chehab } 11330c0d06caSMauro Carvalho Chehab 11340c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 113595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11360c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 11370c0d06caSMauro Carvalho Chehab } 11380c0d06caSMauro Carvalho Chehab 11390c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 11400c0d06caSMauro Carvalho Chehab } 11410c0d06caSMauro Carvalho Chehab 114201c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 11430c0d06caSMauro Carvalho Chehab { 1144081b945eSHans Verkuil struct em28xx *dev = priv; 11450c0d06caSMauro Carvalho Chehab 11460c0d06caSMauro Carvalho Chehab /* 1147081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1148081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1149081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1150081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 11510c0d06caSMauro Carvalho Chehab */ 11520c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 11530c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1154081b945eSHans Verkuil dev->mute = ctrl->val; 1155081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11560c0d06caSMauro Carvalho Chehab break; 11570c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1158081b945eSHans Verkuil dev->volume = ctrl->val; 1159081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1160081b945eSHans Verkuil break; 1161081b945eSHans Verkuil } 1162081b945eSHans Verkuil } 1163081b945eSHans Verkuil 1164081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1165081b945eSHans Verkuil { 1166abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1167abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1168abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 11698f8b113aSFrank Schaefer int ret = -EINVAL; 1170081b945eSHans Verkuil 1171081b945eSHans Verkuil switch (ctrl->id) { 1172081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1173081b945eSHans Verkuil dev->mute = ctrl->val; 11748f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1175081b945eSHans Verkuil break; 1176081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1177081b945eSHans Verkuil dev->volume = ctrl->val; 11788f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11798f8b113aSFrank Schaefer break; 11808f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11818f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11828f8b113aSFrank Schaefer break; 11838f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11848f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11858f8b113aSFrank Schaefer break; 11868f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11878f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11888f8b113aSFrank Schaefer break; 11898f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11908f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11918f8b113aSFrank Schaefer break; 11928f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11938f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11948f8b113aSFrank Schaefer break; 11958f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11968f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11970c0d06caSMauro Carvalho Chehab break; 11980c0d06caSMauro Carvalho Chehab } 11990c0d06caSMauro Carvalho Chehab 12008f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 12010c0d06caSMauro Carvalho Chehab } 12020c0d06caSMauro Carvalho Chehab 12038068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1204081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1205081b945eSHans Verkuil }; 1206081b945eSHans Verkuil 12076b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 12080c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 12090c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 12100c0d06caSMauro Carvalho Chehab { 12110c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12120c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12130c0d06caSMauro Carvalho Chehab 12140c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 121581685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 121681685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 12170c0d06caSMauro Carvalho Chehab 12180c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 121981685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 122081685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 12210c0d06caSMauro Carvalho Chehab } 12220c0d06caSMauro Carvalho Chehab 1223b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1224b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1225b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1226b8374138SFrank Schaefer { 1227b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1228b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1229b8374138SFrank Schaefer 1230b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1231b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1232b8374138SFrank Schaefer } 1233b8374138SFrank Schaefer 12340c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 12350c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 12360c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 12370c0d06caSMauro Carvalho Chehab 12380c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 12390c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12400c0d06caSMauro Carvalho Chehab { 1241917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1242753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12430c0d06caSMauro Carvalho Chehab 1244753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1245753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 124606e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 124706e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1248753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 12490c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12500c0d06caSMauro Carvalho Chehab 12510c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 125258159171SFrank Schaefer if (v4l2->progressive) 12530c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12540c0d06caSMauro Carvalho Chehab else 125558159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 12560c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12570c0d06caSMauro Carvalho Chehab return 0; 12580c0d06caSMauro Carvalho Chehab } 12590c0d06caSMauro Carvalho Chehab 12600c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12610c0d06caSMauro Carvalho Chehab { 12620c0d06caSMauro Carvalho Chehab unsigned int i; 12630c0d06caSMauro Carvalho Chehab 12640c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12650c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12660c0d06caSMauro Carvalho Chehab return &format[i]; 12670c0d06caSMauro Carvalho Chehab 12680c0d06caSMauro Carvalho Chehab return NULL; 12690c0d06caSMauro Carvalho Chehab } 12700c0d06caSMauro Carvalho Chehab 12710c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12720c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12730c0d06caSMauro Carvalho Chehab { 1274917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 127558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12760c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12770c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12780c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12790c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12800c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12810c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12820c0d06caSMauro Carvalho Chehab 12830c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12840c0d06caSMauro Carvalho Chehab if (!fmt) { 12850c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12860c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12870c0d06caSMauro Carvalho Chehab return -EINVAL; 12880c0d06caSMauro Carvalho Chehab } 12890c0d06caSMauro Carvalho Chehab 12900c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12910c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12920c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12930c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1294d3829fadSDevin Heitmueller /* 1295d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1296d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1297d3829fadSDevin Heitmueller * to 50% 1298d3829fadSDevin Heitmueller */ 12990c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 13000c0d06caSMauro Carvalho Chehab width /= 2; 13010c0d06caSMauro Carvalho Chehab } else { 13020c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 13030c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 13040c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 13050c0d06caSMauro Carvalho Chehab 1, 0); 13060c0d06caSMauro Carvalho Chehab } 13070c0d06caSMauro Carvalho Chehab 13086b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 130946f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 13100c0d06caSMauro Carvalho Chehab 13110c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 13120c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 13130c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1314e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 13150c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 13160c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 131758159171SFrank Schaefer if (v4l2->progressive) 13180c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 13190c0d06caSMauro Carvalho Chehab else 132058159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 13210c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 132251dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab return 0; 13250c0d06caSMauro Carvalho Chehab } 13260c0d06caSMauro Carvalho Chehab 13270c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 13280c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 13290c0d06caSMauro Carvalho Chehab { 13300c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1331753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13320c0d06caSMauro Carvalho Chehab 13330c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 13340c0d06caSMauro Carvalho Chehab if (!fmt) 13350c0d06caSMauro Carvalho Chehab return -EINVAL; 13360c0d06caSMauro Carvalho Chehab 133706e20672SFrank Schaefer v4l2->format = fmt; 1338753aee77SFrank Schaefer v4l2->width = width; 1339753aee77SFrank Schaefer v4l2->height = height; 13400c0d06caSMauro Carvalho Chehab 13410c0d06caSMauro Carvalho Chehab /* set new image size */ 1342753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1343753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13440c0d06caSMauro Carvalho Chehab 13450c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13460c0d06caSMauro Carvalho Chehab 13470c0d06caSMauro Carvalho Chehab return 0; 13480c0d06caSMauro Carvalho Chehab } 13490c0d06caSMauro Carvalho Chehab 13500c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 13510c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13520c0d06caSMauro Carvalho Chehab { 1353d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 13548139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13550c0d06caSMauro Carvalho Chehab 1356c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1357d3829fadSDevin Heitmueller return -EBUSY; 13580c0d06caSMauro Carvalho Chehab 13590c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13600c0d06caSMauro Carvalho Chehab 13610c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13620c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13630c0d06caSMauro Carvalho Chehab } 13640c0d06caSMauro Carvalho Chehab 13650c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13660c0d06caSMauro Carvalho Chehab { 1367917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 13680c0d06caSMauro Carvalho Chehab 136952faaf78SFrank Schaefer *norm = dev->v4l2->norm; 13700c0d06caSMauro Carvalho Chehab 13710c0d06caSMauro Carvalho Chehab return 0; 13720c0d06caSMauro Carvalho Chehab } 13730c0d06caSMauro Carvalho Chehab 13740c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13750c0d06caSMauro Carvalho Chehab { 1376917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 13770c0d06caSMauro Carvalho Chehab 137895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 13790c0d06caSMauro Carvalho Chehab 13800c0d06caSMauro Carvalho Chehab return 0; 13810c0d06caSMauro Carvalho Chehab } 13820c0d06caSMauro Carvalho Chehab 1383314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13840c0d06caSMauro Carvalho Chehab { 1385917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1386753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13870c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13880c0d06caSMauro Carvalho Chehab 138952faaf78SFrank Schaefer if (norm == v4l2->norm) 1390d8c95c08SHans Verkuil return 0; 13910c0d06caSMauro Carvalho Chehab 13928139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1393d8c95c08SHans Verkuil return -EBUSY; 1394d8c95c08SHans Verkuil 139552faaf78SFrank Schaefer v4l2->norm = norm; 13960c0d06caSMauro Carvalho Chehab 13970c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1398d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1399314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 14000c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 14010c0d06caSMauro Carvalho Chehab 14020c0d06caSMauro Carvalho Chehab /* set new image size */ 1403753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1404753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1405753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1406753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 14070c0d06caSMauro Carvalho Chehab 14080c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 14098774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 14100c0d06caSMauro Carvalho Chehab 14110c0d06caSMauro Carvalho Chehab return 0; 14120c0d06caSMauro Carvalho Chehab } 14130c0d06caSMauro Carvalho Chehab 14140c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 14150c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14160c0d06caSMauro Carvalho Chehab { 1417917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 141852faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14190c0d06caSMauro Carvalho Chehab int rc = 0; 14200c0d06caSMauro Carvalho Chehab 142186ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 14220c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 142352faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 14240c0d06caSMauro Carvalho Chehab video, g_parm, p); 14250c0d06caSMauro Carvalho Chehab else 142652faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 14270c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 14280c0d06caSMauro Carvalho Chehab 14290c0d06caSMauro Carvalho Chehab return rc; 14300c0d06caSMauro Carvalho Chehab } 14310c0d06caSMauro Carvalho Chehab 14320c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 14330c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14340c0d06caSMauro Carvalho Chehab { 1435917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 14360c0d06caSMauro Carvalho Chehab 143786ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 143895d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 143995d2608bSFrank Schaefer 0, video, s_parm, p); 14400c0d06caSMauro Carvalho Chehab } 14410c0d06caSMauro Carvalho Chehab 14420c0d06caSMauro Carvalho Chehab static const char *iname[] = { 14430c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 14440c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 14450c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 14460c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 14470c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 14480c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 14490c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 14500c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 14510c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 14520c0d06caSMauro Carvalho Chehab }; 14530c0d06caSMauro Carvalho Chehab 14540c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 14550c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 14560c0d06caSMauro Carvalho Chehab { 1457917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 14580c0d06caSMauro Carvalho Chehab unsigned int n; 14590c0d06caSMauro Carvalho Chehab 14600c0d06caSMauro Carvalho Chehab n = i->index; 14610c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14620c0d06caSMauro Carvalho Chehab return -EINVAL; 14630c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14640c0d06caSMauro Carvalho Chehab return -EINVAL; 14650c0d06caSMauro Carvalho Chehab 14660c0d06caSMauro Carvalho Chehab i->index = n; 14670c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14680c0d06caSMauro Carvalho Chehab 14690c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14700c0d06caSMauro Carvalho Chehab 14710c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14720c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14730c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14740c0d06caSMauro Carvalho Chehab 1475ef74a0b9SFrank Schaefer i->std = dev->v4l2->vdev->tvnorms; 1476d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1477d8c95c08SHans Verkuil if (dev->board.is_webcam) 1478d8c95c08SHans Verkuil i->capabilities = 0; 14790c0d06caSMauro Carvalho Chehab 14800c0d06caSMauro Carvalho Chehab return 0; 14810c0d06caSMauro Carvalho Chehab } 14820c0d06caSMauro Carvalho Chehab 14830c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14840c0d06caSMauro Carvalho Chehab { 1485917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 14860c0d06caSMauro Carvalho Chehab 14870c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14880c0d06caSMauro Carvalho Chehab 14890c0d06caSMauro Carvalho Chehab return 0; 14900c0d06caSMauro Carvalho Chehab } 14910c0d06caSMauro Carvalho Chehab 14920c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 14930c0d06caSMauro Carvalho Chehab { 1494917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 14950c0d06caSMauro Carvalho Chehab 14960c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 14970c0d06caSMauro Carvalho Chehab return -EINVAL; 14980c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14990c0d06caSMauro Carvalho Chehab return -EINVAL; 15000c0d06caSMauro Carvalho Chehab 15010c0d06caSMauro Carvalho Chehab video_mux(dev, i); 15020c0d06caSMauro Carvalho Chehab return 0; 15030c0d06caSMauro Carvalho Chehab } 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 15060c0d06caSMauro Carvalho Chehab { 1507917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab switch (a->index) { 15100c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 15110c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 15120c0d06caSMauro Carvalho Chehab break; 15130c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 15140c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 15150c0d06caSMauro Carvalho Chehab break; 15160c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 15170c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 15180c0d06caSMauro Carvalho Chehab break; 15190c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 15200c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 15210c0d06caSMauro Carvalho Chehab break; 15220c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 15230c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 15240c0d06caSMauro Carvalho Chehab break; 15250c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 15260c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 15270c0d06caSMauro Carvalho Chehab break; 15280c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 15290c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 15300c0d06caSMauro Carvalho Chehab break; 15310c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 15320c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 15330c0d06caSMauro Carvalho Chehab break; 15340c0d06caSMauro Carvalho Chehab default: 15350c0d06caSMauro Carvalho Chehab return -EINVAL; 15360c0d06caSMauro Carvalho Chehab } 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 15390c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 15400c0d06caSMauro Carvalho Chehab 15410c0d06caSMauro Carvalho Chehab return 0; 15420c0d06caSMauro Carvalho Chehab } 15430c0d06caSMauro Carvalho Chehab 15440e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 15450c0d06caSMauro Carvalho Chehab { 1546917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15470c0d06caSMauro Carvalho Chehab 15480c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 15490c0d06caSMauro Carvalho Chehab return -EINVAL; 15500c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 15510c0d06caSMauro Carvalho Chehab return -EINVAL; 15520c0d06caSMauro Carvalho Chehab 15530c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15540c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15550c0d06caSMauro Carvalho Chehab 15560c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15570c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15580c0d06caSMauro Carvalho Chehab 15590c0d06caSMauro Carvalho Chehab return 0; 15600c0d06caSMauro Carvalho Chehab } 15610c0d06caSMauro Carvalho Chehab 15620c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15630c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15640c0d06caSMauro Carvalho Chehab { 1565917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15660c0d06caSMauro Carvalho Chehab 15670c0d06caSMauro Carvalho Chehab if (0 != t->index) 15680c0d06caSMauro Carvalho Chehab return -EINVAL; 15690c0d06caSMauro Carvalho Chehab 15700c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15710c0d06caSMauro Carvalho Chehab 157295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 15730c0d06caSMauro Carvalho Chehab return 0; 15740c0d06caSMauro Carvalho Chehab } 15750c0d06caSMauro Carvalho Chehab 15760c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15772f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15780c0d06caSMauro Carvalho Chehab { 1579917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15800c0d06caSMauro Carvalho Chehab 15810c0d06caSMauro Carvalho Chehab if (0 != t->index) 15820c0d06caSMauro Carvalho Chehab return -EINVAL; 15830c0d06caSMauro Carvalho Chehab 158495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 15850c0d06caSMauro Carvalho Chehab return 0; 15860c0d06caSMauro Carvalho Chehab } 15870c0d06caSMauro Carvalho Chehab 15880c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15890c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15900c0d06caSMauro Carvalho Chehab { 1591917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15923854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15930c0d06caSMauro Carvalho Chehab 159420deebfeSHans Verkuil if (0 != f->tuner) 159520deebfeSHans Verkuil return -EINVAL; 159620deebfeSHans Verkuil 15973854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 15980c0d06caSMauro Carvalho Chehab return 0; 15990c0d06caSMauro Carvalho Chehab } 16000c0d06caSMauro Carvalho Chehab 16010c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1602b530a447SHans Verkuil const struct v4l2_frequency *f) 16030c0d06caSMauro Carvalho Chehab { 1604b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1605917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 160695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16070c0d06caSMauro Carvalho Chehab 16080c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 16090c0d06caSMauro Carvalho Chehab return -EINVAL; 16100c0d06caSMauro Carvalho Chehab 161195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 161295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 16133854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 16140c0d06caSMauro Carvalho Chehab 16150c0d06caSMauro Carvalho Chehab return 0; 16160c0d06caSMauro Carvalho Chehab } 16170c0d06caSMauro Carvalho Chehab 1618cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 161996b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 162096b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 16213b2d17b4SHans Verkuil { 1622917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16233b2d17b4SHans Verkuil 16243b2d17b4SHans Verkuil if (chip->match.addr > 1) 16253b2d17b4SHans Verkuil return -EINVAL; 16263b2d17b4SHans Verkuil if (chip->match.addr == 1) 16273b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 16283b2d17b4SHans Verkuil else 162995d2608bSFrank Schaefer strlcpy(chip->name, 163095d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 16313b2d17b4SHans Verkuil return 0; 16323b2d17b4SHans Verkuil } 16333b2d17b4SHans Verkuil 163435deba32SFrank Schaefer static int em28xx_reg_len(int reg) 163535deba32SFrank Schaefer { 163635deba32SFrank Schaefer switch (reg) { 163735deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 163835deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 163935deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 164035deba32SFrank Schaefer return 2; 164135deba32SFrank Schaefer default: 164235deba32SFrank Schaefer return 1; 164335deba32SFrank Schaefer } 164435deba32SFrank Schaefer } 16450c0d06caSMauro Carvalho Chehab 16460c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16470c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16480c0d06caSMauro Carvalho Chehab { 1649917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16500c0d06caSMauro Carvalho Chehab int ret; 16510c0d06caSMauro Carvalho Chehab 16523b2d17b4SHans Verkuil if (reg->match.addr > 1) 16533b2d17b4SHans Verkuil return -EINVAL; 1654abca2056SHans Verkuil if (reg->match.addr) { 16550c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16560c0d06caSMauro Carvalho Chehab if (ret < 0) 16570c0d06caSMauro Carvalho Chehab return ret; 16580c0d06caSMauro Carvalho Chehab 16590c0d06caSMauro Carvalho Chehab reg->val = ret; 16600c0d06caSMauro Carvalho Chehab reg->size = 1; 16610c0d06caSMauro Carvalho Chehab return 0; 16620c0d06caSMauro Carvalho Chehab } 16630c0d06caSMauro Carvalho Chehab 16640c0d06caSMauro Carvalho Chehab /* Match host */ 16650c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16660c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16670c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16680c0d06caSMauro Carvalho Chehab 16690c0d06caSMauro Carvalho Chehab if (ret < 0) 16700c0d06caSMauro Carvalho Chehab return ret; 16710c0d06caSMauro Carvalho Chehab 16720c0d06caSMauro Carvalho Chehab reg->val = ret; 16730c0d06caSMauro Carvalho Chehab } else { 16740c0d06caSMauro Carvalho Chehab __le16 val = 0; 1675fdf1bc9fSMauro Carvalho Chehab 167601c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16770c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16780c0d06caSMauro Carvalho Chehab if (ret < 0) 16790c0d06caSMauro Carvalho Chehab return ret; 16800c0d06caSMauro Carvalho Chehab 16810c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16820c0d06caSMauro Carvalho Chehab } 16830c0d06caSMauro Carvalho Chehab 16840c0d06caSMauro Carvalho Chehab return 0; 16850c0d06caSMauro Carvalho Chehab } 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1688977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16890c0d06caSMauro Carvalho Chehab { 1690917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16910c0d06caSMauro Carvalho Chehab __le16 buf; 16920c0d06caSMauro Carvalho Chehab 16933b2d17b4SHans Verkuil if (reg->match.addr > 1) 16943b2d17b4SHans Verkuil return -EINVAL; 1695abca2056SHans Verkuil if (reg->match.addr) 16960c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab /* Match host */ 16990c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 17000c0d06caSMauro Carvalho Chehab 17010c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 17020c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 17030c0d06caSMauro Carvalho Chehab } 17040c0d06caSMauro Carvalho Chehab #endif 17050c0d06caSMauro Carvalho Chehab 17060c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 17070c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 17080c0d06caSMauro Carvalho Chehab { 1709a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1710917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1711ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 17140c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 17150c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 17160c0d06caSMauro Carvalho Chehab 1717a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1718a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1719a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1720a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1721a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1722a9d79fe5SHans Verkuil else 17231d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 17240c0d06caSMauro Carvalho Chehab 1725920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1726a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 17270c0d06caSMauro Carvalho Chehab 17280c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1729a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 17300c0d06caSMauro Carvalho Chehab 1731a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1732a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1733ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 17341d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1735ef74a0b9SFrank Schaefer if (v4l2->radio_dev) 1736a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 17370c0d06caSMauro Carvalho Chehab return 0; 17380c0d06caSMauro Carvalho Chehab } 17390c0d06caSMauro Carvalho Chehab 17400c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 17410c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 17420c0d06caSMauro Carvalho Chehab { 17430c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 17440c0d06caSMauro Carvalho Chehab return -EINVAL; 17450c0d06caSMauro Carvalho Chehab 17460c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 17470c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 17480c0d06caSMauro Carvalho Chehab 17490c0d06caSMauro Carvalho Chehab return 0; 17500c0d06caSMauro Carvalho Chehab } 17510c0d06caSMauro Carvalho Chehab 17520c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17530c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17540c0d06caSMauro Carvalho Chehab { 1755917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17560c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17570c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17580c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17590c0d06caSMauro Carvalho Chehab 17600c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17610c0d06caSMauro Carvalho Chehab if (!fmt) { 17620c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17630c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17640c0d06caSMauro Carvalho Chehab return -EINVAL; 17650c0d06caSMauro Carvalho Chehab } 17660c0d06caSMauro Carvalho Chehab 17670c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17680c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17690c0d06caSMauro Carvalho Chehab return -EINVAL; 17700c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17710c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17720c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17730c0d06caSMauro Carvalho Chehab return 0; 17740c0d06caSMauro Carvalho Chehab } 17750c0d06caSMauro Carvalho Chehab 17760c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17770c0d06caSMauro Carvalho Chehab return -EINVAL; 17780c0d06caSMauro Carvalho Chehab 17790c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17800c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17816c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17826c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17836c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17840c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17856c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17866c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17870c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17880c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17890c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 17900c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 17910c0d06caSMauro Carvalho Chehab return 0; 17920c0d06caSMauro Carvalho Chehab } 17930c0d06caSMauro Carvalho Chehab 17940c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 17970c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 17980c0d06caSMauro Carvalho Chehab { 1799917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1800753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18010c0d06caSMauro Carvalho Chehab 1802753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 18030c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 18040c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 18050c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 18060c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1807753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1808753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 18092a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 18100c0d06caSMauro Carvalho Chehab 18110c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 181252faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 18130c0d06caSMauro Carvalho Chehab /* NTSC */ 18140c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 18150c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 181652faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 18170c0d06caSMauro Carvalho Chehab /* PAL */ 18180c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 18190c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 18200c0d06caSMauro Carvalho Chehab } 18210c0d06caSMauro Carvalho Chehab 18220c0d06caSMauro Carvalho Chehab return 0; 18230c0d06caSMauro Carvalho Chehab } 18240c0d06caSMauro Carvalho Chehab 18250c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18260c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 18270c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18280c0d06caSMauro Carvalho Chehab 18290c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 18300c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18310c0d06caSMauro Carvalho Chehab { 1832917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 18350c0d06caSMauro Carvalho Chehab return -EINVAL; 18360c0d06caSMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 18380c0d06caSMauro Carvalho Chehab 183995d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18400c0d06caSMauro Carvalho Chehab 18410c0d06caSMauro Carvalho Chehab return 0; 18420c0d06caSMauro Carvalho Chehab } 18430c0d06caSMauro Carvalho Chehab 18440c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18452f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18460c0d06caSMauro Carvalho Chehab { 1847917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18480c0d06caSMauro Carvalho Chehab 18490c0d06caSMauro Carvalho Chehab if (0 != t->index) 18500c0d06caSMauro Carvalho Chehab return -EINVAL; 18510c0d06caSMauro Carvalho Chehab 185295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18530c0d06caSMauro Carvalho Chehab 18540c0d06caSMauro Carvalho Chehab return 0; 18550c0d06caSMauro Carvalho Chehab } 18560c0d06caSMauro Carvalho Chehab 18570c0d06caSMauro Carvalho Chehab /* 185895d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 185995d2608bSFrank Schaefer * 186095d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 186195d2608bSFrank Schaefer * 186295d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 186395d2608bSFrank Schaefer */ 1864f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 186595d2608bSFrank Schaefer { 186695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 186795d2608bSFrank Schaefer 1868abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 186995d2608bSFrank Schaefer kfree(v4l2); 187095d2608bSFrank Schaefer } 187195d2608bSFrank Schaefer 187295d2608bSFrank Schaefer /* 18730c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18740c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18750c0d06caSMauro Carvalho Chehab */ 18760c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18770c0d06caSMauro Carvalho Chehab { 18780c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18790c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 188095d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18810c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18823c0f90e1SFrank Schaefer int ret; 18830c0d06caSMauro Carvalho Chehab 18840c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18850c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18860c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18870c0d06caSMauro Carvalho Chehab break; 18880c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 18890c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 18900c0d06caSMauro Carvalho Chehab break; 18914e170240SFrank Schaefer case VFL_TYPE_RADIO: 18924e170240SFrank Schaefer break; 18934e170240SFrank Schaefer default: 18944e170240SFrank Schaefer return -EINVAL; 18950c0d06caSMauro Carvalho Chehab } 18960c0d06caSMauro Carvalho Chehab 18978e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 18988e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 18998e2c8717SFrank Schaefer v4l2->users); 19000c0d06caSMauro Carvalho Chehab 19010c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19020c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19033c0f90e1SFrank Schaefer 19043c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 19053c0f90e1SFrank Schaefer if (ret) { 19063c0f90e1SFrank Schaefer em28xx_errdev("%s: v4l2_fh_open() returned error %d\n", 19073c0f90e1SFrank Schaefer __func__, ret); 19080c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19093c0f90e1SFrank Schaefer return ret; 19100c0d06caSMauro Carvalho Chehab } 19110c0d06caSMauro Carvalho Chehab 19128e2c8717SFrank Schaefer if (v4l2->users == 0) { 19130c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 19144e170240SFrank Schaefer 19154e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 19160c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 19170c0d06caSMauro Carvalho Chehab 19184e170240SFrank Schaefer /* 19194e170240SFrank Schaefer * Needed, since GPIO might have disabled power 19204e170240SFrank Schaefer * of some i2c devices 19210c0d06caSMauro Carvalho Chehab */ 19220c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 19230c0d06caSMauro Carvalho Chehab } 1924d3829fadSDevin Heitmueller 1925d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 19260c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 192795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 19280c0d06caSMauro Carvalho Chehab } 19290c0d06caSMauro Carvalho Chehab 193047677e51SMauro Carvalho Chehab kref_get(&dev->ref); 193195d2608bSFrank Schaefer kref_get(&v4l2->ref); 19328e2c8717SFrank Schaefer v4l2->users++; 19330c0d06caSMauro Carvalho Chehab 19340c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19350c0d06caSMauro Carvalho Chehab 1936d3829fadSDevin Heitmueller return 0; 19370c0d06caSMauro Carvalho Chehab } 19380c0d06caSMauro Carvalho Chehab 19390c0d06caSMauro Carvalho Chehab /* 194001c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 19410c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 19420c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 19430c0d06caSMauro Carvalho Chehab */ 194401c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 19450c0d06caSMauro Carvalho Chehab { 194695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 194795d2608bSFrank Schaefer 1948822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 1949822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 1950822b8deaSMauro Carvalho Chehab return 0; 1951822b8deaSMauro Carvalho Chehab } 1952822b8deaSMauro Carvalho Chehab 195301c28193SMauro Carvalho Chehab if (!dev->has_video) { 195401c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 195501c28193SMauro Carvalho Chehab return 0; 195601c28193SMauro Carvalho Chehab } 19570c0d06caSMauro Carvalho Chehab 195895d2608bSFrank Schaefer if (v4l2 == NULL) 195995d2608bSFrank Schaefer return 0; 196095d2608bSFrank Schaefer 19610418ca60SRussell King em28xx_info("Closing video extension\n"); 1962aa929ad7SMauro Carvalho Chehab 1963ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 1964ebbfbc20SMauro Carvalho Chehab 196595d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 19665ad10de6SFrank Schaefer 196723e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 196823e8642cSFrank Schaefer 1969ef74a0b9SFrank Schaefer if (v4l2->radio_dev) { 1970e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 1971ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 1972ef74a0b9SFrank Schaefer video_unregister_device(v4l2->radio_dev); 19730c0d06caSMauro Carvalho Chehab } 1974ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) { 19750c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1976ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 1977ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vbi_dev); 19780c0d06caSMauro Carvalho Chehab } 1979ef74a0b9SFrank Schaefer if (v4l2->vdev) { 19800c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1981ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 1982ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vdev); 19830c0d06caSMauro Carvalho Chehab } 198401c28193SMauro Carvalho Chehab 1985abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 198695d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 1987103f18a2SFrank Schaefer 19882c52a2fcSFrank Schaefer if (v4l2->clk) { 19892c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 19902c52a2fcSFrank Schaefer v4l2->clk = NULL; 199125dd1652SFrank Schaefer } 199225dd1652SFrank Schaefer 199395d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 199495d2608bSFrank Schaefer 1995ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 199695d2608bSFrank Schaefer 199747677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 19985ad10de6SFrank Schaefer 199901c28193SMauro Carvalho Chehab return 0; 20000c0d06caSMauro Carvalho Chehab } 20010c0d06caSMauro Carvalho Chehab 2002a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2003a61f6811SShuah Khan { 2004a61f6811SShuah Khan if (dev->is_audio_only) 2005a61f6811SShuah Khan return 0; 2006a61f6811SShuah Khan 2007a61f6811SShuah Khan if (!dev->has_video) 2008a61f6811SShuah Khan return 0; 2009a61f6811SShuah Khan 2010a61f6811SShuah Khan em28xx_info("Suspending video extension"); 2011a61f6811SShuah Khan em28xx_stop_urbs(dev); 2012a61f6811SShuah Khan return 0; 2013a61f6811SShuah Khan } 2014a61f6811SShuah Khan 2015a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2016a61f6811SShuah Khan { 2017a61f6811SShuah Khan if (dev->is_audio_only) 2018a61f6811SShuah Khan return 0; 2019a61f6811SShuah Khan 2020a61f6811SShuah Khan if (!dev->has_video) 2021a61f6811SShuah Khan return 0; 2022a61f6811SShuah Khan 2023a61f6811SShuah Khan em28xx_info("Resuming video extension"); 2024a61f6811SShuah Khan /* what do we do here */ 2025a61f6811SShuah Khan return 0; 2026a61f6811SShuah Khan } 2027a61f6811SShuah Khan 20280c0d06caSMauro Carvalho Chehab /* 20290c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 20300c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 20310c0d06caSMauro Carvalho Chehab * calls and ioctls 20320c0d06caSMauro Carvalho Chehab */ 20330c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 20340c0d06caSMauro Carvalho Chehab { 2035917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 203695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20370c0d06caSMauro Carvalho Chehab int errCode; 20380c0d06caSMauro Carvalho Chehab 20398e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 20408e2c8717SFrank Schaefer 20418e2c8717SFrank Schaefer vb2_fop_release(filp); 204298c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 20430c0d06caSMauro Carvalho Chehab 20448e2c8717SFrank Schaefer if (v4l2->users == 1) { 204547677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 204647677e51SMauro Carvalho Chehab if (dev->disconnected) 204701c28193SMauro Carvalho Chehab goto exit; 20480c0d06caSMauro Carvalho Chehab 20490c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 205095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 20510c0d06caSMauro Carvalho Chehab 20520c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 20530c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 20540c0d06caSMauro Carvalho Chehab 20550c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 20560c0d06caSMauro Carvalho Chehab dev->alt = 0; 20570c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 20580c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 20590c0d06caSMauro Carvalho Chehab if (errCode < 0) { 20600c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 20610c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 20620c0d06caSMauro Carvalho Chehab } 20630c0d06caSMauro Carvalho Chehab } 20640c0d06caSMauro Carvalho Chehab 206501c28193SMauro Carvalho Chehab exit: 20668e2c8717SFrank Schaefer v4l2->users--; 206795d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 20680c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 206947677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 207047677e51SMauro Carvalho Chehab 20710c0d06caSMauro Carvalho Chehab return 0; 20720c0d06caSMauro Carvalho Chehab } 20730c0d06caSMauro Carvalho Chehab 20740c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 20750c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20760c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20770c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2078d3829fadSDevin Heitmueller .read = vb2_fop_read, 2079d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2080d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 20810c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20820c0d06caSMauro Carvalho Chehab }; 20830c0d06caSMauro Carvalho Chehab 20840c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 20850c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 20860c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 20870c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 20880c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 20890c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 20900c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20912a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2092aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20930c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 20940c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 20950c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 20960c0d06caSMauro Carvalho Chehab 2097d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2098d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2099d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2100d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2101d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2102d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2103d3829fadSDevin Heitmueller 21040c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 21050c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 21060c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 21070c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 21080c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 21090c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 21100c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 21110c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2112d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2113d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 21140c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 21150c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 21160c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21170c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 211850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 211950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21200c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 212196b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 21220c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21230c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21240c0d06caSMauro Carvalho Chehab #endif 21250c0d06caSMauro Carvalho Chehab }; 21260c0d06caSMauro Carvalho Chehab 21270c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 21280c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 21290c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2130ef74a0b9SFrank Schaefer .release = video_device_release, 21310c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 21320c0d06caSMauro Carvalho Chehab }; 21330c0d06caSMauro Carvalho Chehab 21340c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 21350c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 21360c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 21370c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 21380c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 21390c0d06caSMauro Carvalho Chehab }; 21400c0d06caSMauro Carvalho Chehab 21410c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2142a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 21430c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 21440c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 21450c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21460c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 214750fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 214850fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21490c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2150430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 21510c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21520c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21530c0d06caSMauro Carvalho Chehab #endif 21540c0d06caSMauro Carvalho Chehab }; 21550c0d06caSMauro Carvalho Chehab 21560c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 21570c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 21580c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2159ef74a0b9SFrank Schaefer .release = video_device_release, 21600c0d06caSMauro Carvalho Chehab }; 21610c0d06caSMauro Carvalho Chehab 2162b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2163b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2164b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2165b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2166b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2167b64f8e9aSMauro Carvalho Chehab 2168b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2169b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2170b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2171b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2172b64f8e9aSMauro Carvalho Chehab }; 2173b64f8e9aSMauro Carvalho Chehab 2174b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2175b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2176b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2177b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2178b64f8e9aSMauro Carvalho Chehab }; 2179b64f8e9aSMauro Carvalho Chehab 21800c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 21810c0d06caSMauro Carvalho Chehab 2182fdf1bc9fSMauro Carvalho Chehab static struct video_device 2183fdf1bc9fSMauro Carvalho Chehab *em28xx_vdev_init(struct em28xx *dev, 21840c0d06caSMauro Carvalho Chehab const struct video_device *template, 21850c0d06caSMauro Carvalho Chehab const char *type_name) 21860c0d06caSMauro Carvalho Chehab { 21870c0d06caSMauro Carvalho Chehab struct video_device *vfd; 21880c0d06caSMauro Carvalho Chehab 21890c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 21900c0d06caSMauro Carvalho Chehab if (NULL == vfd) 21910c0d06caSMauro Carvalho Chehab return NULL; 21920c0d06caSMauro Carvalho Chehab 21930c0d06caSMauro Carvalho Chehab *vfd = *template; 219495d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 21950c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2196d8c95c08SHans Verkuil if (dev->board.is_webcam) 2197d8c95c08SHans Verkuil vfd->tvnorms = 0; 21980c0d06caSMauro Carvalho Chehab 21990c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 22000c0d06caSMauro Carvalho Chehab dev->name, type_name); 22010c0d06caSMauro Carvalho Chehab 22020c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 22030c0d06caSMauro Carvalho Chehab return vfd; 22040c0d06caSMauro Carvalho Chehab } 22050c0d06caSMauro Carvalho Chehab 22063319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 22070560f337SMauro Carvalho Chehab { 22083854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 22093854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 22100560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 22110560f337SMauro Carvalho Chehab struct v4l2_frequency f; 22120560f337SMauro Carvalho Chehab 22130560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 22140560f337SMauro Carvalho Chehab 22150560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 22160560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 22170560f337SMauro Carvalho Chehab 22180560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 22190560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 22200560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 22210560f337SMauro Carvalho Chehab 222295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 222395d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22240560f337SMauro Carvalho Chehab } 22250560f337SMauro Carvalho Chehab 22260560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 22270560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 22283319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 22290560f337SMauro Carvalho Chehab 223095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 223195d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22320560f337SMauro Carvalho Chehab } 22330560f337SMauro Carvalho Chehab 22346867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 22350560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 22360560f337SMauro Carvalho Chehab 22370560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 22386867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 22390560f337SMauro Carvalho Chehab 224095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 224195d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 22420560f337SMauro Carvalho Chehab } 22430560f337SMauro Carvalho Chehab 22440560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 22450560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 22460560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 22470560f337SMauro Carvalho Chehab 22480560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 22490560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 22500560f337SMauro Carvalho Chehab 22510560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 22520560f337SMauro Carvalho Chehab 22530560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 22540560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 22550560f337SMauro Carvalho Chehab 225695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 22570560f337SMauro Carvalho Chehab } 22580560f337SMauro Carvalho Chehab 22590560f337SMauro Carvalho Chehab /* configure tuner */ 22600560f337SMauro Carvalho Chehab f.tuner = 0; 22610560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 22620560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 22633854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 226495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 22650560f337SMauro Carvalho Chehab } 22660560f337SMauro Carvalho Chehab 226701c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 22680c0d06caSMauro Carvalho Chehab { 22690c0d06caSMauro Carvalho Chehab u8 val; 22700c0d06caSMauro Carvalho Chehab int ret; 22710c0d06caSMauro Carvalho Chehab unsigned int maxw; 2272abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 227395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2274b64f8e9aSMauro Carvalho Chehab 2275822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2276822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2277822b8deaSMauro Carvalho Chehab return 0; 2278822b8deaSMauro Carvalho Chehab } 2279822b8deaSMauro Carvalho Chehab 228001c28193SMauro Carvalho Chehab if (!dev->has_video) { 2281b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2282b64f8e9aSMauro Carvalho Chehab return 0; 2283b64f8e9aSMauro Carvalho Chehab } 22840c0d06caSMauro Carvalho Chehab 22859634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 22860c0d06caSMauro Carvalho Chehab 228701c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 228801c28193SMauro Carvalho Chehab 228995d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 229095d2608bSFrank Schaefer if (v4l2 == NULL) { 229195d2608bSFrank Schaefer em28xx_info("em28xx_v4l: memory allocation failed\n"); 229295d2608bSFrank Schaefer mutex_unlock(&dev->lock); 229395d2608bSFrank Schaefer return -ENOMEM; 229495d2608bSFrank Schaefer } 229595d2608bSFrank Schaefer kref_init(&v4l2->ref); 2296abc1308fSFrank Schaefer v4l2->dev = dev; 229795d2608bSFrank Schaefer dev->v4l2 = v4l2; 229895d2608bSFrank Schaefer 229995d2608bSFrank Schaefer ret = v4l2_device_register(&dev->udev->dev, &v4l2->v4l2_dev); 2300b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2301b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2302b64f8e9aSMauro Carvalho Chehab goto err; 2303b64f8e9aSMauro Carvalho Chehab } 2304b64f8e9aSMauro Carvalho Chehab 2305abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2306b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 230795d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2308b64f8e9aSMauro Carvalho Chehab 230958159171SFrank Schaefer if (dev->board.is_webcam) 23107e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 231158159171SFrank Schaefer 2312b64f8e9aSMauro Carvalho Chehab /* 2313b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2314b64f8e9aSMauro Carvalho Chehab */ 23159297285eSFrank Schaefer v4l2->vinmode = 0x10; 23169297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2317b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2318b64f8e9aSMauro Carvalho Chehab 2319b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2320b64f8e9aSMauro Carvalho Chehab 2321b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 232295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 232395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2324b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2325b64f8e9aSMauro Carvalho Chehab 2326b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 232795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 232895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2329b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2330b64f8e9aSMauro Carvalho Chehab 2331b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 233295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 233395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2334b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2335b64f8e9aSMauro Carvalho Chehab 2336b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 233795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 233895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2339b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2340b64f8e9aSMauro Carvalho Chehab 2341b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2342b64f8e9aSMauro Carvalho Chehab 2343b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 23443319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 23456867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2346b64f8e9aSMauro Carvalho Chehab 2347b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 234895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2350fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2351fdf1bc9fSMauro Carvalho Chehab NULL); 2352b64f8e9aSMauro Carvalho Chehab 2353b64f8e9aSMauro Carvalho Chehab if (has_demod) 235495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2355fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2356fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2357fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 23583319e6f8SFrank Schaefer if (tuner_addr == 0) { 2359b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2360b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2361b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2362b64f8e9aSMauro Carvalho Chehab 236395d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2364fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2365fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2366fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2367b64f8e9aSMauro Carvalho Chehab 2368b64f8e9aSMauro Carvalho Chehab if (sd) 23693319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2370b64f8e9aSMauro Carvalho Chehab } else { 237195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 237295d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 23733319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2374b64f8e9aSMauro Carvalho Chehab } 2375b64f8e9aSMauro Carvalho Chehab 23763319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 23773319e6f8SFrank Schaefer } 23783319e6f8SFrank Schaefer 2379d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2380b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2381b64f8e9aSMauro Carvalho Chehab 2382b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2383b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2384b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2385b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2386b64f8e9aSMauro Carvalho Chehab __func__, ret); 2387b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2388b64f8e9aSMauro Carvalho Chehab } 2389b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2390b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2391b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2392b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2393b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2394b64f8e9aSMauro Carvalho Chehab } else { 2395b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2396b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2397b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2398b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2399b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2400b64f8e9aSMauro Carvalho Chehab } 2401b64f8e9aSMauro Carvalho Chehab 2402b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2403b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2404b64f8e9aSMauro Carvalho Chehab 2405b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2406b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2407b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2408b64f8e9aSMauro Carvalho Chehab 2409b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2410b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2411b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2412b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2413b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2414b64f8e9aSMauro Carvalho Chehab __func__, ret); 2415b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2416b64f8e9aSMauro Carvalho Chehab } 2417b64f8e9aSMauro Carvalho Chehab msleep(3); 2418b64f8e9aSMauro Carvalho Chehab 2419b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2420b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2421b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2422b64f8e9aSMauro Carvalho Chehab __func__, ret); 2423b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2424b64f8e9aSMauro Carvalho Chehab } 2425b64f8e9aSMauro Carvalho Chehab msleep(3); 2426b64f8e9aSMauro Carvalho Chehab } 2427b64f8e9aSMauro Carvalho Chehab 24280c0d06caSMauro Carvalho Chehab /* set default norm */ 242952faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 24308774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 243158159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 24320c0d06caSMauro Carvalho Chehab 24330c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 243406e20672SFrank Schaefer v4l2->format = &format[0]; 24350c0d06caSMauro Carvalho Chehab 24360c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 24370c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 24380c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 24390c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 24400c0d06caSMauro Carvalho Chehab maxw /= 2; 24410c0d06caSMauro Carvalho Chehab 24420c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 24430c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 24440c0d06caSMauro Carvalho Chehab 24450c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 24460c0d06caSMauro Carvalho Chehab 24470c0d06caSMauro Carvalho Chehab /* Audio defaults */ 24480c0d06caSMauro Carvalho Chehab dev->mute = 1; 24490c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 24500c0d06caSMauro Carvalho Chehab 24510c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 24520c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 24530c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 24540c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 24550c0d06caSMauro Carvalho Chehab 24560c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 24570c0d06caSMauro Carvalho Chehab 24588f8b113aSFrank Schaefer /* Add image controls */ 24598f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 24608f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2461ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2462ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24638f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 24648f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2465ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2466ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24678f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 24688f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2469ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2470ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24718f8b113aSFrank Schaefer V4L2_CID_SATURATION, 24728f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2473ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2474ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24758f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 24768f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2477ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2478ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24798f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 24808f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2481ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2482ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24838f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 24848f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 24858f8b113aSFrank Schaefer 24868f8b113aSFrank Schaefer /* Reset image controls */ 24878f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2488ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2489ad298055SFrank Schaefer ret = hdl->error; 2490b64f8e9aSMauro Carvalho Chehab if (ret) 2491b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24928f8b113aSFrank Schaefer 24930c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2494ef74a0b9SFrank Schaefer v4l2->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 2495ef74a0b9SFrank Schaefer if (!v4l2->vdev) { 24960c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2497b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2498b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24990c0d06caSMauro Carvalho Chehab } 250027a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 250127a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 250227a36df6SFrank Schaefer v4l2->vdev->queue = &v4l2->vb_vidq; 250327a36df6SFrank Schaefer v4l2->vdev->queue->lock = &v4l2->vb_queue_lock; 25040c0d06caSMauro Carvalho Chehab 25056e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 25066e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2507ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_QUERYSTD); 2508ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_STD); 2509ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_STD); 25103bc85cceSFrank Schaefer } else { 2511ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 25126e46dabaSFrank Schaefer } 251366df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2514ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_TUNER); 2515ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_TUNER); 2516ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_FREQUENCY); 2517ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_FREQUENCY); 251866df67b7SFrank Schaefer } 2519920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2520ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_AUDIO); 2521ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_AUDIO); 2522c2dcef83SFrank Schaefer } 25236e46dabaSFrank Schaefer 25240c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2525ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vdev, VFL_TYPE_GRABBER, 25260c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 25270c0d06caSMauro Carvalho Chehab if (ret) { 25280c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 25290c0d06caSMauro Carvalho Chehab ret); 2530b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25310c0d06caSMauro Carvalho Chehab } 25320c0d06caSMauro Carvalho Chehab 25330c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 25340c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2535ef74a0b9SFrank Schaefer v4l2->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 25360c0d06caSMauro Carvalho Chehab "vbi"); 25370c0d06caSMauro Carvalho Chehab 253827a36df6SFrank Schaefer v4l2->vbi_dev->queue = &v4l2->vb_vbiq; 253927a36df6SFrank Schaefer v4l2->vbi_dev->queue->lock = &v4l2->vb_vbi_queue_lock; 2540d3829fadSDevin Heitmueller 254166df67b7SFrank Schaefer /* disable inapplicable ioctls */ 25423d3a4109SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_PARM); 254366df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2544ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_TUNER); 2545ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_TUNER); 2546ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2547ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 254866df67b7SFrank Schaefer } 2549920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2550ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_AUDIO); 2551ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_AUDIO); 2552c2dcef83SFrank Schaefer } 255366df67b7SFrank Schaefer 25540c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2555ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vbi_dev, VFL_TYPE_VBI, 25560c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 25570c0d06caSMauro Carvalho Chehab if (ret < 0) { 25580c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2559b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25600c0d06caSMauro Carvalho Chehab } 25610c0d06caSMauro Carvalho Chehab } 25620c0d06caSMauro Carvalho Chehab 25630c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2564ef74a0b9SFrank Schaefer v4l2->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 25650c0d06caSMauro Carvalho Chehab "radio"); 2566ef74a0b9SFrank Schaefer if (!v4l2->radio_dev) { 25670c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2568b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2569b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25700c0d06caSMauro Carvalho Chehab } 2571ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->radio_dev, VFL_TYPE_RADIO, 25720c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 25730c0d06caSMauro Carvalho Chehab if (ret < 0) { 25740c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2575b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25760c0d06caSMauro Carvalho Chehab } 25770c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 2578ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 25790c0d06caSMauro Carvalho Chehab } 25800c0d06caSMauro Carvalho Chehab 25810c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 2582ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 25830c0d06caSMauro Carvalho Chehab 2584ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 25850c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 2586ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 25870c0d06caSMauro Carvalho Chehab 2588b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 258995d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2590b64f8e9aSMauro Carvalho Chehab 2591b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2592b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2593b64f8e9aSMauro Carvalho Chehab 25949634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 25959634614fSMauro Carvalho Chehab 259647677e51SMauro Carvalho Chehab kref_get(&dev->ref); 259747677e51SMauro Carvalho Chehab 259801c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 25990c0d06caSMauro Carvalho Chehab return 0; 2600b64f8e9aSMauro Carvalho Chehab 2601b64f8e9aSMauro Carvalho Chehab unregister_dev: 2602abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 260395d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2604b64f8e9aSMauro Carvalho Chehab err: 260595d2608bSFrank Schaefer dev->v4l2 = NULL; 260695d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 260701c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2608b64f8e9aSMauro Carvalho Chehab return ret; 26090c0d06caSMauro Carvalho Chehab } 261001c28193SMauro Carvalho Chehab 261101c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 261201c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 261301c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 261401c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 261501c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2616a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2617a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 261801c28193SMauro Carvalho Chehab }; 261901c28193SMauro Carvalho Chehab 262001c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 262101c28193SMauro Carvalho Chehab { 262201c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 262301c28193SMauro Carvalho Chehab } 262401c28193SMauro Carvalho Chehab 262501c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 262601c28193SMauro Carvalho Chehab { 262701c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 262801c28193SMauro Carvalho Chehab } 262901c28193SMauro Carvalho Chehab 263001c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 263101c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2632