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 85e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 86e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 87e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 88e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 89e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 90e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 91e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 92e507e0e5SFrank Schaefer 93e507e0e5SFrank Schaefer 94d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 95d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 96d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 970c0d06caSMauro Carvalho Chehab 980c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 990c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 1000c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 1010c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 1020c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 1030c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 1040c0d06caSMauro Carvalho Chehab 1050c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1060c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1070c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1080c0d06caSMauro Carvalho Chehab 1090c0d06caSMauro Carvalho Chehab /* supported video standards */ 1100c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1110c0d06caSMauro Carvalho Chehab { 1120c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1130c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1140c0d06caSMauro Carvalho Chehab .depth = 16, 1150c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1160c0d06caSMauro Carvalho Chehab }, { 1170c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1180c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1190c0d06caSMauro Carvalho Chehab .depth = 16, 1200c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1210c0d06caSMauro Carvalho Chehab }, { 1220c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1230c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1240c0d06caSMauro Carvalho Chehab .depth = 8, 1250c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1260c0d06caSMauro Carvalho Chehab }, { 1270c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1280c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1290c0d06caSMauro Carvalho Chehab .depth = 8, 1300c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1310c0d06caSMauro Carvalho Chehab }, { 1320c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1330c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1340c0d06caSMauro Carvalho Chehab .depth = 8, 1350c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1360c0d06caSMauro Carvalho Chehab }, { 1370c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1380c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1390c0d06caSMauro Carvalho Chehab .depth = 12, 1400c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1410c0d06caSMauro Carvalho Chehab }, 1420c0d06caSMauro Carvalho Chehab }; 1430c0d06caSMauro Carvalho Chehab 14425c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 14525c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 14625c61e4cSFrank Schaefer { 14725c61e4cSFrank Schaefer if (dev->board.is_webcam) 14825c61e4cSFrank Schaefer return dev->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 { 15825c61e4cSFrank Schaefer if (dev->board.is_webcam) 15925c61e4cSFrank Schaefer return dev->sensor_yres; 16025c61e4cSFrank Schaefer 16125c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16225c61e4cSFrank Schaefer return 480; 16325c61e4cSFrank Schaefer 16425c61e4cSFrank Schaefer return (dev->norm & V4L2_STD_625_50) ? 576 : 480; 16525c61e4cSFrank Schaefer } 16625c61e4cSFrank Schaefer 16701c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1680560f337SMauro Carvalho Chehab { 1690560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1700560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1710560f337SMauro Carvalho Chehab return 0; 1720560f337SMauro Carvalho Chehab 1730560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1740560f337SMauro Carvalho Chehab return 0; 1750560f337SMauro Carvalho Chehab 1760560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1770560f337SMauro Carvalho Chehab 1780560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1790560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1800560f337SMauro Carvalho Chehab return 1; 1810560f337SMauro Carvalho Chehab 1820560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1830560f337SMauro Carvalho Chehab return 0; 1840560f337SMauro Carvalho Chehab } 1850560f337SMauro Carvalho Chehab 1860560f337SMauro Carvalho Chehab /* 1870560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1880560f337SMauro Carvalho Chehab * configure i2c attached devices 1890560f337SMauro Carvalho Chehab */ 19001c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1910560f337SMauro Carvalho Chehab { 19295d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 19395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1950560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 19695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_stream, 0); 1970560f337SMauro Carvalho Chehab } 1980560f337SMauro Carvalho Chehab 19901c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2000560f337SMauro Carvalho Chehab { 2010560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2020560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2030560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2070560f337SMauro Carvalho Chehab 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2090560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2140560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2150560f337SMauro Carvalho Chehab } 2160560f337SMauro Carvalho Chehab 21701c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2180560f337SMauro Carvalho Chehab { 2190560f337SMauro Carvalho Chehab int ret; 2200560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 221753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2220560f337SMauro Carvalho Chehab 2230560f337SMauro Carvalho Chehab fmt = dev->format->reg; 2240560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2250560f337SMauro Carvalho Chehab fmt |= 0x20; 2260560f337SMauro Carvalho Chehab /* 2270560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2280560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2290560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2300560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2310560f337SMauro Carvalho Chehab * 2320560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2330560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2340560f337SMauro Carvalho Chehab */ 2350560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2360560f337SMauro Carvalho Chehab if (ret < 0) 2370560f337SMauro Carvalho Chehab return ret; 2380560f337SMauro Carvalho Chehab 2390560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, dev->vinmode); 2400560f337SMauro Carvalho Chehab if (ret < 0) 2410560f337SMauro Carvalho Chehab return ret; 2420560f337SMauro Carvalho Chehab 2430560f337SMauro Carvalho Chehab vinctrl = dev->vinctl; 2440560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2450560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2460560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 247753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 248753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 2490560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 2500560f337SMauro Carvalho Chehab /* NTSC */ 2510560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 2520560f337SMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 2530560f337SMauro Carvalho Chehab /* PAL */ 2540560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2550560f337SMauro Carvalho Chehab } 2560560f337SMauro Carvalho Chehab } 2570560f337SMauro Carvalho Chehab 2580560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2590560f337SMauro Carvalho Chehab } 2600560f337SMauro Carvalho Chehab 2610560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2620560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2630560f337SMauro Carvalho Chehab { 2640560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2650560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2660560f337SMauro Carvalho Chehab 2670560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2680560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2690560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2700560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2710560f337SMauro Carvalho Chehab } 2720560f337SMauro Carvalho Chehab 2730560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2740560f337SMauro Carvalho Chehab u16 width, u16 height) 2750560f337SMauro Carvalho Chehab { 2760560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2770560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2780560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2790560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2800560f337SMauro Carvalho Chehab 2810560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2820560f337SMauro Carvalho Chehab hstart, vstart, 2830560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2840560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2850560f337SMauro Carvalho Chehab 2860560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2870560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2880560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2910560f337SMauro Carvalho Chehab 2920560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2930560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2940560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2950560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2960560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2970560f337SMauro Carvalho Chehab } 2980560f337SMauro Carvalho Chehab } 2990560f337SMauro Carvalho Chehab 3000560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3010560f337SMauro Carvalho Chehab { 302cba8e9b3SFrank Schaefer u8 mode = 0x00; 3030560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3040560f337SMauro Carvalho Chehab 3050560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3060560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3070560f337SMauro Carvalho Chehab } else { 3080560f337SMauro Carvalho Chehab u8 buf[2]; 3090560f337SMauro Carvalho Chehab 3100560f337SMauro Carvalho Chehab buf[0] = h; 3110560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3120560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3130560f337SMauro Carvalho Chehab 3140560f337SMauro Carvalho Chehab buf[0] = v; 3150560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3160560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3170560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3180560f337SMauro Carvalho Chehab to work correctly */ 3190560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3200560f337SMauro Carvalho Chehab } 321cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3220560f337SMauro Carvalho Chehab } 3230560f337SMauro Carvalho Chehab 3240560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32501c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3260560f337SMauro Carvalho Chehab { 327753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 328753aee77SFrank Schaefer int width = norm_maxw(dev); 329753aee77SFrank Schaefer int height = norm_maxh(dev); 3300560f337SMauro Carvalho Chehab 3310560f337SMauro Carvalho Chehab /* Properly setup VBI */ 332753aee77SFrank Schaefer v4l2->vbi_width = 720; 3330560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) 334753aee77SFrank Schaefer v4l2->vbi_height = 12; 3350560f337SMauro Carvalho Chehab else 336753aee77SFrank Schaefer v4l2->vbi_height = 18; 3370560f337SMauro Carvalho Chehab 3380560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3390560f337SMauro Carvalho Chehab 3400560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3410560f337SMauro Carvalho Chehab 3420560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3430560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3440560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3450560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3460560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3470560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3480560f337SMauro Carvalho Chehab region */ 3490560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3500560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3510560f337SMauro Carvalho Chehab else 3520560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3530560f337SMauro Carvalho Chehab 354753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3550560f337SMauro Carvalho Chehab } 3560560f337SMauro Carvalho Chehab 3570560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 35801c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3590560f337SMauro Carvalho Chehab { 360753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 3610560f337SMauro Carvalho Chehab int errCode; 3620560f337SMauro Carvalho Chehab int i; 363753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3640560f337SMauro Carvalho Chehab 3650560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3660560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3670560f337SMauro Carvalho Chehab dev->alt = 0; 3680560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3690560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3700560f337SMauro Carvalho Chehab dev->alt = alt; 3710560f337SMauro Carvalho Chehab goto set_alt; 3720560f337SMauro Carvalho Chehab } 3730560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3740560f337SMauro Carvalho Chehab goto set_alt; 3750560f337SMauro Carvalho Chehab 3760560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3770560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3780560f337SMauro Carvalho Chehab green screen will be received. 3790560f337SMauro Carvalho Chehab */ 380753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3810560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3820560f337SMauro Carvalho Chehab 3830560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3840560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3850560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3860560f337SMauro Carvalho Chehab dev->alt = i; 3870560f337SMauro Carvalho Chehab break; 3880560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3890560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3900560f337SMauro Carvalho Chehab */ 3910560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3920560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3930560f337SMauro Carvalho Chehab dev->alt = i; 3940560f337SMauro Carvalho Chehab } 3950560f337SMauro Carvalho Chehab 3960560f337SMauro Carvalho Chehab set_alt: 3970560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 3980560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 3990560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4000560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4010560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4020560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4030560f337SMauro Carvalho Chehab } else { /* isoc */ 4040560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4050560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4060560f337SMauro Carvalho Chehab dev->max_pkt_size = 4070560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4080560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4090560f337SMauro Carvalho Chehab } 4100560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4110560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 412961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 4130560f337SMauro Carvalho Chehab if (errCode < 0) { 4140560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 4150560f337SMauro Carvalho Chehab dev->alt, errCode); 4160560f337SMauro Carvalho Chehab return errCode; 4170560f337SMauro Carvalho Chehab } 4180560f337SMauro Carvalho Chehab return 0; 4190560f337SMauro Carvalho Chehab } 4200560f337SMauro Carvalho Chehab 4210c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4220c0d06caSMauro Carvalho Chehab DMA and thread functions 4230c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4240c0d06caSMauro Carvalho Chehab 4250c0d06caSMauro Carvalho Chehab /* 426948a49aaSFrank Schaefer * Finish the current buffer 4270c0d06caSMauro Carvalho Chehab */ 428948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4290c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4300c0d06caSMauro Carvalho Chehab { 431d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 432d3829fadSDevin Heitmueller 433d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 434d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 435d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 436d3829fadSDevin Heitmueller 437d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4380c0d06caSMauro Carvalho Chehab } 4390c0d06caSMauro Carvalho Chehab 4400c0d06caSMauro Carvalho Chehab /* 44136016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4420c0d06caSMauro Carvalho Chehab */ 4430c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4440c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 44536016a35SFrank Schaefer unsigned char *usb_buf, 4464078d625SFrank Schaefer unsigned long len) 4470c0d06caSMauro Carvalho Chehab { 4480c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4490c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 450753aee77SFrank Schaefer int bytesperline = dev->v4l2->width << 1; 4510c0d06caSMauro Carvalho Chehab 452d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 453d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4540c0d06caSMauro Carvalho Chehab 45536016a35SFrank Schaefer startread = usb_buf; 4560c0d06caSMauro Carvalho Chehab remain = len; 4570c0d06caSMauro Carvalho Chehab 458c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 45936016a35SFrank Schaefer fieldstart = buf->vb_buf; 460c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46136016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4620c0d06caSMauro Carvalho Chehab 4638732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4648732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4650c0d06caSMauro Carvalho Chehab 4660c0d06caSMauro Carvalho Chehab if (dev->progressive) 4670c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4680c0d06caSMauro Carvalho Chehab else 4690c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4700c0d06caSMauro Carvalho Chehab 4710c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4720c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4730c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4740c0d06caSMauro Carvalho Chehab 475d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4760c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 4770c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 478d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 479d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48036016a35SFrank Schaefer (char *)startwrite; 4810c0d06caSMauro Carvalho Chehab lencopy = remain; 4820c0d06caSMauro Carvalho Chehab } 4830c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4840c0d06caSMauro Carvalho Chehab return; 4850c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4860c0d06caSMauro Carvalho Chehab 4870c0d06caSMauro Carvalho Chehab remain -= lencopy; 4880c0d06caSMauro Carvalho Chehab 4890c0d06caSMauro Carvalho Chehab while (remain > 0) { 490c02ec71bSFrank Schaefer if (dev->progressive) 491c02ec71bSFrank Schaefer startwrite += lencopy; 492c02ec71bSFrank Schaefer else 4930c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 4940c0d06caSMauro Carvalho Chehab startread += lencopy; 4950c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 4960c0d06caSMauro Carvalho Chehab lencopy = remain; 4970c0d06caSMauro Carvalho Chehab else 4980c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 4990c0d06caSMauro Carvalho Chehab 50036016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 501d3829fadSDevin Heitmueller buf->length) { 5020c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 5030c0d06caSMauro Carvalho Chehab "(2)\n", 5040c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 505d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 506d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5070c0d06caSMauro Carvalho Chehab (char *)startwrite; 5080c0d06caSMauro Carvalho Chehab } 5090c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5100c0d06caSMauro Carvalho Chehab break; 5110c0d06caSMauro Carvalho Chehab 5120c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5130c0d06caSMauro Carvalho Chehab 5140c0d06caSMauro Carvalho Chehab remain -= lencopy; 5150c0d06caSMauro Carvalho Chehab } 5160c0d06caSMauro Carvalho Chehab 5178732533bSFrank Schaefer buf->pos += len; 5180c0d06caSMauro Carvalho Chehab } 5190c0d06caSMauro Carvalho Chehab 52036016a35SFrank Schaefer /* 52136016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52236016a35SFrank Schaefer */ 5230c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5240c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 52536016a35SFrank Schaefer unsigned char *usb_buf, 5264078d625SFrank Schaefer unsigned long len) 5270c0d06caSMauro Carvalho Chehab { 52836016a35SFrank Schaefer unsigned int offset; 5290c0d06caSMauro Carvalho Chehab 530d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 531d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5320c0d06caSMauro Carvalho Chehab 5338732533bSFrank Schaefer offset = buf->pos; 5340c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 53536016a35SFrank Schaefer if (buf->top_field == 0) 536753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5370c0d06caSMauro Carvalho Chehab 53836016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5398732533bSFrank Schaefer buf->pos += len; 5400c0d06caSMauro Carvalho Chehab } 5410c0d06caSMauro Carvalho Chehab 5420c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5430c0d06caSMauro Carvalho Chehab int packet, int status) 5440c0d06caSMauro Carvalho Chehab { 5450c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5460c0d06caSMauro Carvalho Chehab 5470c0d06caSMauro Carvalho Chehab switch (status) { 5480c0d06caSMauro Carvalho Chehab case -ENOENT: 5490c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5500c0d06caSMauro Carvalho Chehab break; 5510c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5520c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5530c0d06caSMauro Carvalho Chehab break; 5540c0d06caSMauro Carvalho Chehab case -ENOSR: 5550c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5560c0d06caSMauro Carvalho Chehab break; 5570c0d06caSMauro Carvalho Chehab case -EPIPE: 5580c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5590c0d06caSMauro Carvalho Chehab break; 5600c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5610c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5620c0d06caSMauro Carvalho Chehab break; 5630c0d06caSMauro Carvalho Chehab case -EPROTO: 5640c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5650c0d06caSMauro Carvalho Chehab break; 5660c0d06caSMauro Carvalho Chehab case -EILSEQ: 5670c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5680c0d06caSMauro Carvalho Chehab break; 5690c0d06caSMauro Carvalho Chehab case -ETIME: 5700c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5710c0d06caSMauro Carvalho Chehab break; 5720c0d06caSMauro Carvalho Chehab } 5730c0d06caSMauro Carvalho Chehab if (packet < 0) { 5740c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5750c0d06caSMauro Carvalho Chehab } else { 5760c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5770c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5780c0d06caSMauro Carvalho Chehab } 5790c0d06caSMauro Carvalho Chehab } 5800c0d06caSMauro Carvalho Chehab 5810c0d06caSMauro Carvalho Chehab /* 58224a6d849SFrank Schaefer * get the next available buffer from dma queue 5830c0d06caSMauro Carvalho Chehab */ 58424a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 58524a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5860c0d06caSMauro Carvalho Chehab { 58724a6d849SFrank Schaefer struct em28xx_buffer *buf; 5880c0d06caSMauro Carvalho Chehab 5890c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5900c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59124a6d849SFrank Schaefer return NULL; 5920c0d06caSMauro Carvalho Chehab } 5930c0d06caSMauro Carvalho Chehab 5940c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 595d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 5960c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 597d3829fadSDevin Heitmueller list_del(&buf->list); 5988732533bSFrank Schaefer buf->pos = 0; 599d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6000c0d06caSMauro Carvalho Chehab 60124a6d849SFrank Schaefer return buf; 6020c0d06caSMauro Carvalho Chehab } 6030c0d06caSMauro Carvalho Chehab 604e04c00d9SFrank Schaefer /* 605e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 606e04c00d9SFrank Schaefer */ 607e04c00d9SFrank Schaefer static struct em28xx_buffer * 608e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 609e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 610e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 611e04c00d9SFrank Schaefer { 612e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 613e04c00d9SFrank Schaefer if (buf != NULL) 614e04c00d9SFrank Schaefer finish_buffer(dev, buf); 615e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 616e04c00d9SFrank Schaefer } 617e04c00d9SFrank Schaefer if (buf != NULL) { 618e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 619e04c00d9SFrank Schaefer buf->pos = 0; 620e04c00d9SFrank Schaefer } 621e04c00d9SFrank Schaefer 622e04c00d9SFrank Schaefer return buf; 623e04c00d9SFrank Schaefer } 624e04c00d9SFrank Schaefer 625227b7c90SFrank Schaefer /* 626227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 627227b7c90SFrank Schaefer */ 628227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 629227b7c90SFrank Schaefer unsigned char *data_pkt, 630227b7c90SFrank Schaefer unsigned int data_len) 631227b7c90SFrank Schaefer { 632753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 633227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 634227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 635227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 636227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 637227b7c90SFrank Schaefer 638227b7c90SFrank Schaefer /* capture type 0 = vbi start 639227b7c90SFrank Schaefer capture type 1 = vbi in progress 640227b7c90SFrank Schaefer capture type 2 = video start 641227b7c90SFrank Schaefer capture type 3 = video in progress */ 642227b7c90SFrank Schaefer if (data_len >= 4) { 643227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 644227b7c90SFrank Schaefer * never split across packets */ 645227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 646227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 647227b7c90SFrank Schaefer /* Continuation */ 648227b7c90SFrank Schaefer data_pkt += 4; 649227b7c90SFrank Schaefer data_len -= 4; 650227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 651227b7c90SFrank Schaefer /* Field start (VBI mode) */ 652227b7c90SFrank Schaefer dev->capture_type = 0; 653227b7c90SFrank Schaefer dev->vbi_read = 0; 654227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 655227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 656227b7c90SFrank Schaefer data_pkt += 4; 657227b7c90SFrank Schaefer data_len -= 4; 658227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 659227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 660227b7c90SFrank Schaefer dev->capture_type = 2; 661227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 662227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 663227b7c90SFrank Schaefer data_pkt += 4; 664227b7c90SFrank Schaefer data_len -= 4; 665227b7c90SFrank Schaefer } 666227b7c90SFrank Schaefer } 667227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 668227b7c90SFrank Schaefer * have no continuation header */ 669227b7c90SFrank Schaefer 670227b7c90SFrank Schaefer if (dev->capture_type == 0) { 671227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 672227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 673227b7c90SFrank Schaefer dev->capture_type = 1; 674227b7c90SFrank Schaefer } 675227b7c90SFrank Schaefer 676227b7c90SFrank Schaefer if (dev->capture_type == 1) { 677753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 678227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 679227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 680227b7c90SFrank Schaefer 681227b7c90SFrank Schaefer /* Copy VBI data */ 682227b7c90SFrank Schaefer if (vbi_buf != NULL) 683227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 684227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 685227b7c90SFrank Schaefer 686227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 687227b7c90SFrank Schaefer /* Continue with copying video data */ 688227b7c90SFrank Schaefer dev->capture_type = 2; 689227b7c90SFrank Schaefer data_pkt += vbi_data_len; 690227b7c90SFrank Schaefer data_len -= vbi_data_len; 691227b7c90SFrank Schaefer } 692227b7c90SFrank Schaefer } 693227b7c90SFrank Schaefer 694227b7c90SFrank Schaefer if (dev->capture_type == 2) { 695227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 696227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 697227b7c90SFrank Schaefer dev->capture_type = 3; 698227b7c90SFrank Schaefer } 699227b7c90SFrank Schaefer 700227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 701227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 702227b7c90SFrank Schaefer } 703227b7c90SFrank Schaefer 704e507e0e5SFrank Schaefer /* 705e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 706e507e0e5SFrank Schaefer */ 707e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 708e507e0e5SFrank Schaefer unsigned char *data_pkt, 709e507e0e5SFrank Schaefer unsigned int data_len) 710e507e0e5SFrank Schaefer { 711e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 712e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 713e507e0e5SFrank Schaefer bool frame_end = 0; 714e507e0e5SFrank Schaefer 715e507e0e5SFrank Schaefer /* Check for header */ 716e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 717e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 718e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 719e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 720e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 721e507e0e5SFrank Schaefer dev->top_field = !(data_pkt[1] & 722e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 723e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 724e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 725e507e0e5SFrank Schaefer data_pkt += 2; 726e507e0e5SFrank Schaefer data_len -= 2; 727e507e0e5SFrank Schaefer } 728e507e0e5SFrank Schaefer 729e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 730e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 731e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 732e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 733e507e0e5SFrank Schaefer } 734e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 735e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 736e507e0e5SFrank Schaefer * first frame. 737e507e0e5SFrank Schaefer */ 738e507e0e5SFrank Schaefer } 739e507e0e5SFrank Schaefer 740e507e0e5SFrank Schaefer /* Copy data */ 741e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 742e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 743e507e0e5SFrank Schaefer 744e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 745e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 746e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 747e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 748e507e0e5SFrank Schaefer } 749e507e0e5SFrank Schaefer 750e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 751e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 752e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 753e507e0e5SFrank Schaefer * header like with the other em28xx devices. 754e507e0e5SFrank Schaefer */ 755e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 756e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 757e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 758e507e0e5SFrank Schaefer } 759e507e0e5SFrank Schaefer 760960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7610fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7620c0d06caSMauro Carvalho Chehab { 763227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 764227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 765227b7c90SFrank Schaefer unsigned int usb_data_len; 7660c0d06caSMauro Carvalho Chehab 7670c0d06caSMauro Carvalho Chehab if (!dev) 7680c0d06caSMauro Carvalho Chehab return 0; 7690c0d06caSMauro Carvalho Chehab 7702665c299SFrank Schaefer if (dev->disconnected) 7710c0d06caSMauro Carvalho Chehab return 0; 7720c0d06caSMauro Carvalho Chehab 7731653cb0cSFrank Schaefer if (urb->status < 0) 7740c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7750c0d06caSMauro Carvalho Chehab 7764601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7774601cc39SFrank Schaefer 7784601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7794601cc39SFrank Schaefer num_packets = 1; 7804601cc39SFrank Schaefer else /* isoc */ 7814601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7820c0d06caSMauro Carvalho Chehab 7834601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7844601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 785227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7864601cc39SFrank Schaefer 787227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7884601cc39SFrank Schaefer } else { /* isoc */ 7894601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7904601cc39SFrank Schaefer print_err_status(dev, i, 7914601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 7920c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 7930c0d06caSMauro Carvalho Chehab continue; 7940c0d06caSMauro Carvalho Chehab } 7950c0d06caSMauro Carvalho Chehab 796227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 797227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 7980c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 7990c0d06caSMauro Carvalho Chehab continue; 8000c0d06caSMauro Carvalho Chehab } 8010c0d06caSMauro Carvalho Chehab 802227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8034601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8044601cc39SFrank Schaefer } 8054601cc39SFrank Schaefer 806227b7c90SFrank Schaefer if (usb_data_len == 0) { 8074601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8084601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8094601cc39SFrank Schaefer continue; 8104601cc39SFrank Schaefer } 8110c0d06caSMauro Carvalho Chehab 812e507e0e5SFrank Schaefer if (dev->is_em25xx) 813e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 814e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 815e507e0e5SFrank Schaefer else 816e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 817e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 818e507e0e5SFrank Schaefer 8190c0d06caSMauro Carvalho Chehab } 820227b7c90SFrank Schaefer return 1; 8210c0d06caSMauro Carvalho Chehab } 8220c0d06caSMauro Carvalho Chehab 8230c0d06caSMauro Carvalho Chehab 824d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 825d3829fadSDevin Heitmueller { 826d3829fadSDevin Heitmueller switch (f_type) { 827d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 828d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 829d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 830d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 831d3829fadSDevin Heitmueller default: 832d3829fadSDevin Heitmueller BUG(); 833d3829fadSDevin Heitmueller return 0; 834d3829fadSDevin Heitmueller } 835d3829fadSDevin Heitmueller } 836d3829fadSDevin Heitmueller 837d3829fadSDevin Heitmueller /* Usage lock check functions */ 838d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 839d3829fadSDevin Heitmueller { 840d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 841d3829fadSDevin Heitmueller 842d3829fadSDevin Heitmueller /* is it free? */ 843d3829fadSDevin Heitmueller if (dev->resources & res_type) { 844d3829fadSDevin Heitmueller /* no, someone else uses it */ 845d3829fadSDevin Heitmueller return -EBUSY; 846d3829fadSDevin Heitmueller } 847d3829fadSDevin Heitmueller 848d3829fadSDevin Heitmueller /* it's free, grab it */ 849d3829fadSDevin Heitmueller dev->resources |= res_type; 850d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 851d3829fadSDevin Heitmueller return 0; 852d3829fadSDevin Heitmueller } 853d3829fadSDevin Heitmueller 854d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 855d3829fadSDevin Heitmueller { 856d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 857d3829fadSDevin Heitmueller 858d3829fadSDevin Heitmueller dev->resources &= ~res_type; 859d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 860d3829fadSDevin Heitmueller } 861d3829fadSDevin Heitmueller 8620c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 863d3829fadSDevin Heitmueller Videobuf2 operations 8640c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8650c0d06caSMauro Carvalho Chehab 866d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 867d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 868d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8690c0d06caSMauro Carvalho Chehab { 870d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 871753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 872d3829fadSDevin Heitmueller unsigned long size; 8730c0d06caSMauro Carvalho Chehab 874d3829fadSDevin Heitmueller if (fmt) 875d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 876d3829fadSDevin Heitmueller else 877753aee77SFrank Schaefer size = 878753aee77SFrank Schaefer (v4l2->width * v4l2->height * dev->format->depth + 7) >> 3; 8790c0d06caSMauro Carvalho Chehab 880d3829fadSDevin Heitmueller if (size == 0) 881d3829fadSDevin Heitmueller return -EINVAL; 8820c0d06caSMauro Carvalho Chehab 883d3829fadSDevin Heitmueller if (0 == *nbuffers) 884d3829fadSDevin Heitmueller *nbuffers = 32; 8850c0d06caSMauro Carvalho Chehab 886d3829fadSDevin Heitmueller *nplanes = 1; 887d3829fadSDevin Heitmueller sizes[0] = size; 8880c0d06caSMauro Carvalho Chehab 8890c0d06caSMauro Carvalho Chehab return 0; 8900c0d06caSMauro Carvalho Chehab } 8910c0d06caSMauro Carvalho Chehab 8920c0d06caSMauro Carvalho Chehab static int 893d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 8940c0d06caSMauro Carvalho Chehab { 895d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 896753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 8970c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 898d3829fadSDevin Heitmueller unsigned long size; 8990c0d06caSMauro Carvalho Chehab 900d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 9010c0d06caSMauro Carvalho Chehab 902753aee77SFrank Schaefer size = (v4l2->width * v4l2->height * dev->format->depth + 7) >> 3; 903d3829fadSDevin Heitmueller 904d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 905d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 906d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 9070c0d06caSMauro Carvalho Chehab return -EINVAL; 908d3829fadSDevin Heitmueller } 909d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 9100c0d06caSMauro Carvalho Chehab 911d3829fadSDevin Heitmueller return 0; 9120c0d06caSMauro Carvalho Chehab } 9130c0d06caSMauro Carvalho Chehab 914d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 915d3829fadSDevin Heitmueller { 916d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 917d3829fadSDevin Heitmueller struct v4l2_frequency f; 918d3829fadSDevin Heitmueller int rc = 0; 9190c0d06caSMauro Carvalho Chehab 920d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 921d3829fadSDevin Heitmueller 922d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 923d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 924d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 925d3829fadSDevin Heitmueller if (rc) 926d3829fadSDevin Heitmueller return rc; 927d3829fadSDevin Heitmueller 928032f1ddfSFrank Schaefer if (dev->streaming_users == 0) { 929d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 930d3829fadSDevin Heitmueller 931d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 932d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 933d3829fadSDevin Heitmueller 934d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 935d3829fadSDevin Heitmueller some i2c device 936d3829fadSDevin Heitmueller */ 937d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 938d3829fadSDevin Heitmueller 9390455eebfSFrank Schaefer dev->capture_type = -1; 940c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 941c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9420c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9430c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 944c647a91aSFrank Schaefer dev->packet_multiplier, 9450fa4a402SFrank Schaefer em28xx_urb_data_copy); 9460c0d06caSMauro Carvalho Chehab if (rc < 0) 947032f1ddfSFrank Schaefer return rc; 948d3829fadSDevin Heitmueller 949d3829fadSDevin Heitmueller /* 950d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 951d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 952d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 953d3829fadSDevin Heitmueller */ 954d3829fadSDevin Heitmueller 955d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 956d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 957d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 958d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 959d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 960d3829fadSDevin Heitmueller else 961d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 96295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 96395d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 9640c0d06caSMauro Carvalho Chehab } 9650c0d06caSMauro Carvalho Chehab 966032f1ddfSFrank Schaefer dev->streaming_users++; 967032f1ddfSFrank Schaefer 9680c0d06caSMauro Carvalho Chehab return rc; 9690c0d06caSMauro Carvalho Chehab } 9700c0d06caSMauro Carvalho Chehab 971e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 9720c0d06caSMauro Carvalho Chehab { 973d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9740c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 975d3829fadSDevin Heitmueller unsigned long flags = 0; 9760c0d06caSMauro Carvalho Chehab 977d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9780c0d06caSMauro Carvalho Chehab 979d3829fadSDevin Heitmueller res_free(dev, vq->type); 980d3829fadSDevin Heitmueller 981d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 982d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 983d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9840c0d06caSMauro Carvalho Chehab } 9850c0d06caSMauro Carvalho Chehab 986d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 987d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 988d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 989d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 990d3829fadSDevin Heitmueller list_del(&buf->list); 991d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 992d3829fadSDevin Heitmueller } 993d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 994d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 995d3829fadSDevin Heitmueller } 996d3829fadSDevin Heitmueller 997e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 9980c0d06caSMauro Carvalho Chehab { 999d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1000d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1001d3829fadSDevin Heitmueller unsigned long flags = 0; 10020c0d06caSMauro Carvalho Chehab 1003d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 10040c0d06caSMauro Carvalho Chehab 1005d3829fadSDevin Heitmueller res_free(dev, vq->type); 1006d3829fadSDevin Heitmueller 1007d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 1008d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1009d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 10100c0d06caSMauro Carvalho Chehab } 10110c0d06caSMauro Carvalho Chehab 1012d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1013d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1014d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1015d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1016d3829fadSDevin Heitmueller list_del(&buf->list); 1017d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1018d3829fadSDevin Heitmueller } 1019d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 1020d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1021d3829fadSDevin Heitmueller } 1022d3829fadSDevin Heitmueller 1023d3829fadSDevin Heitmueller static void 1024d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1025d3829fadSDevin Heitmueller { 1026d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1027d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 1028d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1029d3829fadSDevin Heitmueller unsigned long flags = 0; 1030d3829fadSDevin Heitmueller 1031d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1032d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1033d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1034d3829fadSDevin Heitmueller 1035d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1036d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1037d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1038d3829fadSDevin Heitmueller } 1039d3829fadSDevin Heitmueller 1040d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1041d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10420c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10430c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1044d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1045d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1046d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1047d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10480c0d06caSMauro Carvalho Chehab }; 10490c0d06caSMauro Carvalho Chehab 105001c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1051d3829fadSDevin Heitmueller { 1052d3829fadSDevin Heitmueller int rc; 1053d3829fadSDevin Heitmueller struct vb2_queue *q; 105427a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1055d3829fadSDevin Heitmueller 1056d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 105727a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1058d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1059ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1060ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1061d3829fadSDevin Heitmueller q->drv_priv = dev; 1062d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1063d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1064d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1065d3829fadSDevin Heitmueller 1066d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1067d3829fadSDevin Heitmueller if (rc < 0) 1068d3829fadSDevin Heitmueller return rc; 1069d3829fadSDevin Heitmueller 1070d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 107127a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1072d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1073d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1074ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1075d3829fadSDevin Heitmueller q->drv_priv = dev; 1076d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1077d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1078d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1079d3829fadSDevin Heitmueller 1080d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1081d3829fadSDevin Heitmueller if (rc < 0) 1082d3829fadSDevin Heitmueller return rc; 1083d3829fadSDevin Heitmueller 1084d3829fadSDevin Heitmueller return 0; 1085d3829fadSDevin Heitmueller } 1086d3829fadSDevin Heitmueller 10870c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 10880c0d06caSMauro Carvalho Chehab 10890c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 10900c0d06caSMauro Carvalho Chehab { 109195d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 10920c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 10930c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 10940c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 10950c0d06caSMauro Carvalho Chehab 10960c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 10970c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 10980c0d06caSMauro Carvalho Chehab 109995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 11000c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 11010c0d06caSMauro Carvalho Chehab 11020c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 11030c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 110495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 11050c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 11060c0d06caSMauro Carvalho Chehab } 11070c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 110895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11090c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 11100c0d06caSMauro Carvalho Chehab } 11110c0d06caSMauro Carvalho Chehab 11120c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 111395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11140c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 11150c0d06caSMauro Carvalho Chehab } 11160c0d06caSMauro Carvalho Chehab 11170c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 11180c0d06caSMauro Carvalho Chehab } 11190c0d06caSMauro Carvalho Chehab 112001c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 11210c0d06caSMauro Carvalho Chehab { 1122081b945eSHans Verkuil struct em28xx *dev = priv; 11230c0d06caSMauro Carvalho Chehab 11240c0d06caSMauro Carvalho Chehab /* 1125081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1126081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1127081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1128081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 11290c0d06caSMauro Carvalho Chehab */ 11300c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 11310c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1132081b945eSHans Verkuil dev->mute = ctrl->val; 1133081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11340c0d06caSMauro Carvalho Chehab break; 11350c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1136081b945eSHans Verkuil dev->volume = ctrl->val; 1137081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1138081b945eSHans Verkuil break; 1139081b945eSHans Verkuil } 1140081b945eSHans Verkuil } 1141081b945eSHans Verkuil 1142081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1143081b945eSHans Verkuil { 1144abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1145abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1146abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 11478f8b113aSFrank Schaefer int ret = -EINVAL; 1148081b945eSHans Verkuil 1149081b945eSHans Verkuil switch (ctrl->id) { 1150081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1151081b945eSHans Verkuil dev->mute = ctrl->val; 11528f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1153081b945eSHans Verkuil break; 1154081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1155081b945eSHans Verkuil dev->volume = ctrl->val; 11568f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11578f8b113aSFrank Schaefer break; 11588f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11598f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11608f8b113aSFrank Schaefer break; 11618f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11628f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11638f8b113aSFrank Schaefer break; 11648f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11658f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11668f8b113aSFrank Schaefer break; 11678f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11688f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11698f8b113aSFrank Schaefer break; 11708f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11718f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11728f8b113aSFrank Schaefer break; 11738f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11748f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11750c0d06caSMauro Carvalho Chehab break; 11760c0d06caSMauro Carvalho Chehab } 11770c0d06caSMauro Carvalho Chehab 11788f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 11790c0d06caSMauro Carvalho Chehab } 11800c0d06caSMauro Carvalho Chehab 11818068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1182081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1183081b945eSHans Verkuil }; 1184081b945eSHans Verkuil 11856b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 11860c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 11870c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 11880c0d06caSMauro Carvalho Chehab { 11890c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 11900c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 11910c0d06caSMauro Carvalho Chehab 11920c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 119381685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 119481685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 11950c0d06caSMauro Carvalho Chehab 11960c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 119781685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 119881685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 11990c0d06caSMauro Carvalho Chehab } 12000c0d06caSMauro Carvalho Chehab 1201b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1202b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1203b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1204b8374138SFrank Schaefer { 1205b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1206b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1207b8374138SFrank Schaefer 1208b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1209b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1210b8374138SFrank Schaefer } 1211b8374138SFrank Schaefer 12120c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 12130c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 12140c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 12150c0d06caSMauro Carvalho Chehab 12160c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 12170c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12180c0d06caSMauro Carvalho Chehab { 12190c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12200c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1221753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12220c0d06caSMauro Carvalho Chehab 1223753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1224753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 12250c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 1226753aee77SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * dev->format->depth + 7) >> 3; 1227753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 12280c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12290c0d06caSMauro Carvalho Chehab 12300c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 12310c0d06caSMauro Carvalho Chehab if (dev->progressive) 12320c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12330c0d06caSMauro Carvalho Chehab else 12340c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 12350c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12360c0d06caSMauro Carvalho Chehab return 0; 12370c0d06caSMauro Carvalho Chehab } 12380c0d06caSMauro Carvalho Chehab 12390c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12400c0d06caSMauro Carvalho Chehab { 12410c0d06caSMauro Carvalho Chehab unsigned int i; 12420c0d06caSMauro Carvalho Chehab 12430c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12440c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12450c0d06caSMauro Carvalho Chehab return &format[i]; 12460c0d06caSMauro Carvalho Chehab 12470c0d06caSMauro Carvalho Chehab return NULL; 12480c0d06caSMauro Carvalho Chehab } 12490c0d06caSMauro Carvalho Chehab 12500c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12510c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12520c0d06caSMauro Carvalho Chehab { 12530c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12540c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12550c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12560c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12570c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12580c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12590c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12600c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12610c0d06caSMauro Carvalho Chehab 12620c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12630c0d06caSMauro Carvalho Chehab if (!fmt) { 12640c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12650c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12660c0d06caSMauro Carvalho Chehab return -EINVAL; 12670c0d06caSMauro Carvalho Chehab } 12680c0d06caSMauro Carvalho Chehab 12690c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12700c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12710c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12720c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1273d3829fadSDevin Heitmueller /* 1274d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1275d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1276d3829fadSDevin Heitmueller * to 50% 1277d3829fadSDevin Heitmueller */ 12780c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 12790c0d06caSMauro Carvalho Chehab width /= 2; 12800c0d06caSMauro Carvalho Chehab } else { 12810c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 12820c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 12830c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 12840c0d06caSMauro Carvalho Chehab 1, 0); 12850c0d06caSMauro Carvalho Chehab } 12860c0d06caSMauro Carvalho Chehab 12876b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 128846f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 12890c0d06caSMauro Carvalho Chehab 12900c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 12910c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 12920c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1293e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 12940c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 12950c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12960c0d06caSMauro Carvalho Chehab if (dev->progressive) 12970c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12980c0d06caSMauro Carvalho Chehab else 12990c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 13000c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 130151dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 13020c0d06caSMauro Carvalho Chehab 13030c0d06caSMauro Carvalho Chehab return 0; 13040c0d06caSMauro Carvalho Chehab } 13050c0d06caSMauro Carvalho Chehab 13060c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 13070c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 13080c0d06caSMauro Carvalho Chehab { 13090c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1310753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13110c0d06caSMauro Carvalho Chehab 13120c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 13130c0d06caSMauro Carvalho Chehab if (!fmt) 13140c0d06caSMauro Carvalho Chehab return -EINVAL; 13150c0d06caSMauro Carvalho Chehab 13160c0d06caSMauro Carvalho Chehab dev->format = fmt; 1317753aee77SFrank Schaefer v4l2->width = width; 1318753aee77SFrank Schaefer v4l2->height = height; 13190c0d06caSMauro Carvalho Chehab 13200c0d06caSMauro Carvalho Chehab /* set new image size */ 1321753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1322753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13250c0d06caSMauro Carvalho Chehab 13260c0d06caSMauro Carvalho Chehab return 0; 13270c0d06caSMauro Carvalho Chehab } 13280c0d06caSMauro Carvalho Chehab 13290c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 13300c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13310c0d06caSMauro Carvalho Chehab { 1332d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 13330c0d06caSMauro Carvalho Chehab 1334d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1335d3829fadSDevin Heitmueller return -EBUSY; 13360c0d06caSMauro Carvalho Chehab 13370c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13380c0d06caSMauro Carvalho Chehab 13390c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13400c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13410c0d06caSMauro Carvalho Chehab } 13420c0d06caSMauro Carvalho Chehab 13430c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13440c0d06caSMauro Carvalho Chehab { 13450c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13470c0d06caSMauro Carvalho Chehab 13480c0d06caSMauro Carvalho Chehab *norm = dev->norm; 13490c0d06caSMauro Carvalho Chehab 13500c0d06caSMauro Carvalho Chehab return 0; 13510c0d06caSMauro Carvalho Chehab } 13520c0d06caSMauro Carvalho Chehab 13530c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13540c0d06caSMauro Carvalho Chehab { 13550c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13560c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13570c0d06caSMauro Carvalho Chehab 135895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 13590c0d06caSMauro Carvalho Chehab 13600c0d06caSMauro Carvalho Chehab return 0; 13610c0d06caSMauro Carvalho Chehab } 13620c0d06caSMauro Carvalho Chehab 1363314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13640c0d06caSMauro Carvalho Chehab { 13650c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13660c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1367753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13680c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13690c0d06caSMauro Carvalho Chehab 1370314527acSHans Verkuil if (norm == dev->norm) 1371d8c95c08SHans Verkuil return 0; 13720c0d06caSMauro Carvalho Chehab 1373d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1374d8c95c08SHans Verkuil return -EBUSY; 1375d8c95c08SHans Verkuil 1376314527acSHans Verkuil dev->norm = norm; 13770c0d06caSMauro Carvalho Chehab 13780c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1379d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1380314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 13810c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 13820c0d06caSMauro Carvalho Chehab 13830c0d06caSMauro Carvalho Chehab /* set new image size */ 1384753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1385753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1386753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1387753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13880c0d06caSMauro Carvalho Chehab 13890c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 1390753aee77SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, dev->norm); 13910c0d06caSMauro Carvalho Chehab 13920c0d06caSMauro Carvalho Chehab return 0; 13930c0d06caSMauro Carvalho Chehab } 13940c0d06caSMauro Carvalho Chehab 13950c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 13960c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 13970c0d06caSMauro Carvalho Chehab { 13980c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13990c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14000c0d06caSMauro Carvalho Chehab int rc = 0; 14010c0d06caSMauro Carvalho Chehab 140286ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 14030c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 140495d2608bSFrank Schaefer rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 14050c0d06caSMauro Carvalho Chehab video, g_parm, p); 14060c0d06caSMauro Carvalho Chehab else 14070c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 14080c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 14090c0d06caSMauro Carvalho Chehab 14100c0d06caSMauro Carvalho Chehab return rc; 14110c0d06caSMauro Carvalho Chehab } 14120c0d06caSMauro Carvalho Chehab 14130c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 14140c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14150c0d06caSMauro Carvalho Chehab { 14160c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14170c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14180c0d06caSMauro Carvalho Chehab 141986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 142095d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 142195d2608bSFrank Schaefer 0, video, s_parm, p); 14220c0d06caSMauro Carvalho Chehab } 14230c0d06caSMauro Carvalho Chehab 14240c0d06caSMauro Carvalho Chehab static const char *iname[] = { 14250c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 14260c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 14270c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 14280c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 14290c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 14300c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 14310c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 14320c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 14330c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 14340c0d06caSMauro Carvalho Chehab }; 14350c0d06caSMauro Carvalho Chehab 14360c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 14370c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 14380c0d06caSMauro Carvalho Chehab { 14390c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14400c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14410c0d06caSMauro Carvalho Chehab unsigned int n; 14420c0d06caSMauro Carvalho Chehab 14430c0d06caSMauro Carvalho Chehab n = i->index; 14440c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14450c0d06caSMauro Carvalho Chehab return -EINVAL; 14460c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14470c0d06caSMauro Carvalho Chehab return -EINVAL; 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab i->index = n; 14500c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14510c0d06caSMauro Carvalho Chehab 14520c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14530c0d06caSMauro Carvalho Chehab 14540c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14550c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14560c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14570c0d06caSMauro Carvalho Chehab 1458ef74a0b9SFrank Schaefer i->std = dev->v4l2->vdev->tvnorms; 1459d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1460d8c95c08SHans Verkuil if (dev->board.is_webcam) 1461d8c95c08SHans Verkuil i->capabilities = 0; 14620c0d06caSMauro Carvalho Chehab 14630c0d06caSMauro Carvalho Chehab return 0; 14640c0d06caSMauro Carvalho Chehab } 14650c0d06caSMauro Carvalho Chehab 14660c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14670c0d06caSMauro Carvalho Chehab { 14680c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14690c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14700c0d06caSMauro Carvalho Chehab 14710c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14720c0d06caSMauro Carvalho Chehab 14730c0d06caSMauro Carvalho Chehab return 0; 14740c0d06caSMauro Carvalho Chehab } 14750c0d06caSMauro Carvalho Chehab 14760c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 14770c0d06caSMauro Carvalho Chehab { 14780c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14790c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14800c0d06caSMauro Carvalho Chehab 14810c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 14820c0d06caSMauro Carvalho Chehab return -EINVAL; 14830c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14840c0d06caSMauro Carvalho Chehab return -EINVAL; 14850c0d06caSMauro Carvalho Chehab 14860c0d06caSMauro Carvalho Chehab video_mux(dev, i); 14870c0d06caSMauro Carvalho Chehab return 0; 14880c0d06caSMauro Carvalho Chehab } 14890c0d06caSMauro Carvalho Chehab 14900c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 14910c0d06caSMauro Carvalho Chehab { 14920c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14930c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14940c0d06caSMauro Carvalho Chehab 14950c0d06caSMauro Carvalho Chehab switch (a->index) { 14960c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 14970c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 14980c0d06caSMauro Carvalho Chehab break; 14990c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 15000c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 15010c0d06caSMauro Carvalho Chehab break; 15020c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 15030c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 15040c0d06caSMauro Carvalho Chehab break; 15050c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 15060c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 15070c0d06caSMauro Carvalho Chehab break; 15080c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 15090c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 15100c0d06caSMauro Carvalho Chehab break; 15110c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 15120c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 15130c0d06caSMauro Carvalho Chehab break; 15140c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 15150c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 15160c0d06caSMauro Carvalho Chehab break; 15170c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 15180c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 15190c0d06caSMauro Carvalho Chehab break; 15200c0d06caSMauro Carvalho Chehab default: 15210c0d06caSMauro Carvalho Chehab return -EINVAL; 15220c0d06caSMauro Carvalho Chehab } 15230c0d06caSMauro Carvalho Chehab 15240c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 15250c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 15260c0d06caSMauro Carvalho Chehab 15270c0d06caSMauro Carvalho Chehab return 0; 15280c0d06caSMauro Carvalho Chehab } 15290c0d06caSMauro Carvalho Chehab 15300e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 15310c0d06caSMauro Carvalho Chehab { 15320c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15330c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 15360c0d06caSMauro Carvalho Chehab return -EINVAL; 15370c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 15380c0d06caSMauro Carvalho Chehab return -EINVAL; 15390c0d06caSMauro Carvalho Chehab 15400c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15410c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15420c0d06caSMauro Carvalho Chehab 15430c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15440c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15450c0d06caSMauro Carvalho Chehab 15460c0d06caSMauro Carvalho Chehab return 0; 15470c0d06caSMauro Carvalho Chehab } 15480c0d06caSMauro Carvalho Chehab 15490c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15500c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15510c0d06caSMauro Carvalho Chehab { 15520c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15530c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab if (0 != t->index) 15560c0d06caSMauro Carvalho Chehab return -EINVAL; 15570c0d06caSMauro Carvalho Chehab 15580c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15590c0d06caSMauro Carvalho Chehab 156095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 15610c0d06caSMauro Carvalho Chehab return 0; 15620c0d06caSMauro Carvalho Chehab } 15630c0d06caSMauro Carvalho Chehab 15640c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15652f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15660c0d06caSMauro Carvalho Chehab { 15670c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15680c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15690c0d06caSMauro Carvalho Chehab 15700c0d06caSMauro Carvalho Chehab if (0 != t->index) 15710c0d06caSMauro Carvalho Chehab return -EINVAL; 15720c0d06caSMauro Carvalho Chehab 157395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 15740c0d06caSMauro Carvalho Chehab return 0; 15750c0d06caSMauro Carvalho Chehab } 15760c0d06caSMauro Carvalho Chehab 15770c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15780c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15790c0d06caSMauro Carvalho Chehab { 15800c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15810c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15820c0d06caSMauro Carvalho Chehab 158320deebfeSHans Verkuil if (0 != f->tuner) 158420deebfeSHans Verkuil return -EINVAL; 158520deebfeSHans Verkuil 15860c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 15870c0d06caSMauro Carvalho Chehab return 0; 15880c0d06caSMauro Carvalho Chehab } 15890c0d06caSMauro Carvalho Chehab 15900c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1591b530a447SHans Verkuil const struct v4l2_frequency *f) 15920c0d06caSMauro Carvalho Chehab { 1593b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 15940c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15950c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 159695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15970c0d06caSMauro Carvalho Chehab 15980c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 15990c0d06caSMauro Carvalho Chehab return -EINVAL; 16000c0d06caSMauro Carvalho Chehab 160195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 160295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 1603b530a447SHans Verkuil dev->ctl_freq = new_freq.frequency; 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab return 0; 16060c0d06caSMauro Carvalho Chehab } 16070c0d06caSMauro Carvalho Chehab 1608cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 160996b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 161096b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 16113b2d17b4SHans Verkuil { 16123b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 16133b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 16143b2d17b4SHans Verkuil 16153b2d17b4SHans Verkuil if (chip->match.addr > 1) 16163b2d17b4SHans Verkuil return -EINVAL; 16173b2d17b4SHans Verkuil if (chip->match.addr == 1) 16183b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 16193b2d17b4SHans Verkuil else 162095d2608bSFrank Schaefer strlcpy(chip->name, 162195d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 16223b2d17b4SHans Verkuil return 0; 16233b2d17b4SHans Verkuil } 16243b2d17b4SHans Verkuil 162535deba32SFrank Schaefer static int em28xx_reg_len(int reg) 162635deba32SFrank Schaefer { 162735deba32SFrank Schaefer switch (reg) { 162835deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 162935deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 163035deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 163135deba32SFrank Schaefer return 2; 163235deba32SFrank Schaefer default: 163335deba32SFrank Schaefer return 1; 163435deba32SFrank Schaefer } 163535deba32SFrank Schaefer } 16360c0d06caSMauro Carvalho Chehab 16370c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16380c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16390c0d06caSMauro Carvalho Chehab { 16400c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16410c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16420c0d06caSMauro Carvalho Chehab int ret; 16430c0d06caSMauro Carvalho Chehab 16443b2d17b4SHans Verkuil if (reg->match.addr > 1) 16453b2d17b4SHans Verkuil return -EINVAL; 1646abca2056SHans Verkuil if (reg->match.addr) { 16470c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16480c0d06caSMauro Carvalho Chehab if (ret < 0) 16490c0d06caSMauro Carvalho Chehab return ret; 16500c0d06caSMauro Carvalho Chehab 16510c0d06caSMauro Carvalho Chehab reg->val = ret; 16520c0d06caSMauro Carvalho Chehab reg->size = 1; 16530c0d06caSMauro Carvalho Chehab return 0; 16540c0d06caSMauro Carvalho Chehab } 16550c0d06caSMauro Carvalho Chehab 16560c0d06caSMauro Carvalho Chehab /* Match host */ 16570c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16580c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16590c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16600c0d06caSMauro Carvalho Chehab 16610c0d06caSMauro Carvalho Chehab if (ret < 0) 16620c0d06caSMauro Carvalho Chehab return ret; 16630c0d06caSMauro Carvalho Chehab 16640c0d06caSMauro Carvalho Chehab reg->val = ret; 16650c0d06caSMauro Carvalho Chehab } else { 16660c0d06caSMauro Carvalho Chehab __le16 val = 0; 166701c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16680c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16690c0d06caSMauro Carvalho Chehab if (ret < 0) 16700c0d06caSMauro Carvalho Chehab return ret; 16710c0d06caSMauro Carvalho Chehab 16720c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16730c0d06caSMauro Carvalho Chehab } 16740c0d06caSMauro Carvalho Chehab 16750c0d06caSMauro Carvalho Chehab return 0; 16760c0d06caSMauro Carvalho Chehab } 16770c0d06caSMauro Carvalho Chehab 16780c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1679977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16800c0d06caSMauro Carvalho Chehab { 16810c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16820c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16830c0d06caSMauro Carvalho Chehab __le16 buf; 16840c0d06caSMauro Carvalho Chehab 16853b2d17b4SHans Verkuil if (reg->match.addr > 1) 16863b2d17b4SHans Verkuil return -EINVAL; 1687abca2056SHans Verkuil if (reg->match.addr) 16880c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16890c0d06caSMauro Carvalho Chehab 16900c0d06caSMauro Carvalho Chehab /* Match host */ 16910c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 16920c0d06caSMauro Carvalho Chehab 16930c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 16940c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 16950c0d06caSMauro Carvalho Chehab } 16960c0d06caSMauro Carvalho Chehab #endif 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab 16990c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 17000c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 17010c0d06caSMauro Carvalho Chehab { 1702a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 17030c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17040c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1705ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 17080c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 17090c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 17100c0d06caSMauro Carvalho Chehab 1711a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1712a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1713a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1714a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1715a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1716a9d79fe5SHans Verkuil else 17171d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 17180c0d06caSMauro Carvalho Chehab 17190c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1720a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 17210c0d06caSMauro Carvalho Chehab 17220c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1723a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 17240c0d06caSMauro Carvalho Chehab 1725a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1726a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1727ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 17281d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1729ef74a0b9SFrank Schaefer if (v4l2->radio_dev) 1730a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 17310c0d06caSMauro Carvalho Chehab return 0; 17320c0d06caSMauro Carvalho Chehab } 17330c0d06caSMauro Carvalho Chehab 17340c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 17350c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 17360c0d06caSMauro Carvalho Chehab { 17370c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 17380c0d06caSMauro Carvalho Chehab return -EINVAL; 17390c0d06caSMauro Carvalho Chehab 17400c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 17410c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 17420c0d06caSMauro Carvalho Chehab 17430c0d06caSMauro Carvalho Chehab return 0; 17440c0d06caSMauro Carvalho Chehab } 17450c0d06caSMauro Carvalho Chehab 17460c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17470c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17480c0d06caSMauro Carvalho Chehab { 17490c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17500c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17510c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17520c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17530c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17540c0d06caSMauro Carvalho Chehab 17550c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17560c0d06caSMauro Carvalho Chehab if (!fmt) { 17570c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17580c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17590c0d06caSMauro Carvalho Chehab return -EINVAL; 17600c0d06caSMauro Carvalho Chehab } 17610c0d06caSMauro Carvalho Chehab 17620c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17630c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17640c0d06caSMauro Carvalho Chehab return -EINVAL; 17650c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17660c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17670c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17680c0d06caSMauro Carvalho Chehab return 0; 17690c0d06caSMauro Carvalho Chehab } 17700c0d06caSMauro Carvalho Chehab 17710c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17720c0d06caSMauro Carvalho Chehab return -EINVAL; 17730c0d06caSMauro Carvalho Chehab 17740c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17750c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17766c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17776c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17786c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17790c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17806c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17816c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17820c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17830c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17840c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 17850c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 17860c0d06caSMauro Carvalho Chehab return 0; 17870c0d06caSMauro Carvalho Chehab } 17880c0d06caSMauro Carvalho Chehab 17890c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 17900c0d06caSMauro Carvalho Chehab 17910c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 17920c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 17930c0d06caSMauro Carvalho Chehab { 17940c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17950c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1796753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17970c0d06caSMauro Carvalho Chehab 1798753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 17990c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 18000c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 18010c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 18020c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1803753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1804753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 18052a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 18060c0d06caSMauro Carvalho Chehab 18070c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 18080c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 18090c0d06caSMauro Carvalho Chehab /* NTSC */ 18100c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 18110c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 18120c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 18130c0d06caSMauro Carvalho Chehab /* PAL */ 18140c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 18150c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 18160c0d06caSMauro Carvalho Chehab } 18170c0d06caSMauro Carvalho Chehab 18180c0d06caSMauro Carvalho Chehab return 0; 18190c0d06caSMauro Carvalho Chehab } 18200c0d06caSMauro Carvalho Chehab 18210c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18220c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 18230c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18240c0d06caSMauro Carvalho Chehab 18250c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 18260c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18270c0d06caSMauro Carvalho Chehab { 18280c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18290c0d06caSMauro Carvalho Chehab 18300c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 18310c0d06caSMauro Carvalho Chehab return -EINVAL; 18320c0d06caSMauro Carvalho Chehab 18330c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 18340c0d06caSMauro Carvalho Chehab 183595d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18360c0d06caSMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab return 0; 18380c0d06caSMauro Carvalho Chehab } 18390c0d06caSMauro Carvalho Chehab 18400c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18412f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18420c0d06caSMauro Carvalho Chehab { 18430c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18440c0d06caSMauro Carvalho Chehab 18450c0d06caSMauro Carvalho Chehab if (0 != t->index) 18460c0d06caSMauro Carvalho Chehab return -EINVAL; 18470c0d06caSMauro Carvalho Chehab 184895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18490c0d06caSMauro Carvalho Chehab 18500c0d06caSMauro Carvalho Chehab return 0; 18510c0d06caSMauro Carvalho Chehab } 18520c0d06caSMauro Carvalho Chehab 18530c0d06caSMauro Carvalho Chehab /* 185495d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 185595d2608bSFrank Schaefer * 185695d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 185795d2608bSFrank Schaefer * 185895d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 185995d2608bSFrank Schaefer */ 186095d2608bSFrank Schaefer void em28xx_free_v4l2(struct kref *ref) 186195d2608bSFrank Schaefer { 186295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 186395d2608bSFrank Schaefer 1864abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 186595d2608bSFrank Schaefer kfree(v4l2); 186695d2608bSFrank Schaefer } 186795d2608bSFrank Schaefer 186895d2608bSFrank Schaefer /* 18690c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18700c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18710c0d06caSMauro Carvalho Chehab */ 18720c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18730c0d06caSMauro Carvalho Chehab { 18740c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18750c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 187695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18770c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18780c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 18790c0d06caSMauro Carvalho Chehab 18800c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18810c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18820c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18830c0d06caSMauro Carvalho Chehab break; 18840c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 18850c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 18860c0d06caSMauro Carvalho Chehab break; 18874e170240SFrank Schaefer case VFL_TYPE_RADIO: 18884e170240SFrank Schaefer break; 18894e170240SFrank Schaefer default: 18904e170240SFrank Schaefer return -EINVAL; 18910c0d06caSMauro Carvalho Chehab } 18920c0d06caSMauro Carvalho Chehab 18930c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 18940c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 18950c0d06caSMauro Carvalho Chehab dev->users); 18960c0d06caSMauro Carvalho Chehab 18970c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 18980c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 18990c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 19000c0d06caSMauro Carvalho Chehab if (!fh) { 19010c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 19020c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19030c0d06caSMauro Carvalho Chehab return -ENOMEM; 19040c0d06caSMauro Carvalho Chehab } 190569a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 19060c0d06caSMauro Carvalho Chehab fh->dev = dev; 19070c0d06caSMauro Carvalho Chehab fh->type = fh_type; 19080c0d06caSMauro Carvalho Chehab filp->private_data = fh; 19090c0d06caSMauro Carvalho Chehab 19104e170240SFrank Schaefer if (dev->users == 0) { 19110c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 19124e170240SFrank Schaefer 19134e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 19140c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 19150c0d06caSMauro Carvalho Chehab 19164e170240SFrank Schaefer /* 19174e170240SFrank Schaefer * Needed, since GPIO might have disabled power 19184e170240SFrank Schaefer * of some i2c devices 19190c0d06caSMauro Carvalho Chehab */ 19200c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 19210c0d06caSMauro Carvalho Chehab } 1922d3829fadSDevin Heitmueller 1923d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 19240c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 192595d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 19260c0d06caSMauro Carvalho Chehab } 19270c0d06caSMauro Carvalho Chehab 192847677e51SMauro Carvalho Chehab kref_get(&dev->ref); 192995d2608bSFrank Schaefer kref_get(&v4l2->ref); 19300c0d06caSMauro Carvalho Chehab dev->users++; 19310c0d06caSMauro Carvalho Chehab 19320c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 193369a61642SHans Verkuil v4l2_fh_add(&fh->fh); 19340c0d06caSMauro Carvalho Chehab 1935d3829fadSDevin Heitmueller return 0; 19360c0d06caSMauro Carvalho Chehab } 19370c0d06caSMauro Carvalho Chehab 19380c0d06caSMauro Carvalho Chehab /* 193901c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 19400c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 19410c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 19420c0d06caSMauro Carvalho Chehab */ 194301c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 19440c0d06caSMauro Carvalho Chehab { 194595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 194695d2608bSFrank Schaefer 1947822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 1948822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 1949822b8deaSMauro Carvalho Chehab return 0; 1950822b8deaSMauro Carvalho Chehab } 1951822b8deaSMauro Carvalho Chehab 195201c28193SMauro Carvalho Chehab if (!dev->has_video) { 195301c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 195401c28193SMauro Carvalho Chehab return 0; 195501c28193SMauro Carvalho Chehab } 19560c0d06caSMauro Carvalho Chehab 195795d2608bSFrank Schaefer if (v4l2 == NULL) 195895d2608bSFrank Schaefer return 0; 195995d2608bSFrank Schaefer 1960aa929ad7SMauro Carvalho Chehab em28xx_info("Closing video extension"); 1961aa929ad7SMauro Carvalho Chehab 1962ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 1963ebbfbc20SMauro Carvalho Chehab 196495d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 19655ad10de6SFrank Schaefer 196623e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 196723e8642cSFrank Schaefer 1968ef74a0b9SFrank Schaefer if (v4l2->radio_dev) { 1969e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 1970ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 1971ef74a0b9SFrank Schaefer video_unregister_device(v4l2->radio_dev); 19720c0d06caSMauro Carvalho Chehab } 1973ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) { 19740c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1975ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 1976ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vbi_dev); 19770c0d06caSMauro Carvalho Chehab } 1978ef74a0b9SFrank Schaefer if (v4l2->vdev) { 19790c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1980ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 1981ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vdev); 19820c0d06caSMauro Carvalho Chehab } 198301c28193SMauro Carvalho Chehab 1984abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 198595d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 1986103f18a2SFrank Schaefer 19872c52a2fcSFrank Schaefer if (v4l2->clk) { 19882c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 19892c52a2fcSFrank Schaefer v4l2->clk = NULL; 199025dd1652SFrank Schaefer } 199125dd1652SFrank Schaefer 199295d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 199395d2608bSFrank Schaefer 1994ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 199595d2608bSFrank Schaefer 199647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 19975ad10de6SFrank Schaefer 199801c28193SMauro Carvalho Chehab return 0; 19990c0d06caSMauro Carvalho Chehab } 20000c0d06caSMauro Carvalho Chehab 2001a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2002a61f6811SShuah Khan { 2003a61f6811SShuah Khan if (dev->is_audio_only) 2004a61f6811SShuah Khan return 0; 2005a61f6811SShuah Khan 2006a61f6811SShuah Khan if (!dev->has_video) 2007a61f6811SShuah Khan return 0; 2008a61f6811SShuah Khan 2009a61f6811SShuah Khan em28xx_info("Suspending video extension"); 2010a61f6811SShuah Khan em28xx_stop_urbs(dev); 2011a61f6811SShuah Khan return 0; 2012a61f6811SShuah Khan } 2013a61f6811SShuah Khan 2014a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2015a61f6811SShuah Khan { 2016a61f6811SShuah Khan if (dev->is_audio_only) 2017a61f6811SShuah Khan return 0; 2018a61f6811SShuah Khan 2019a61f6811SShuah Khan if (!dev->has_video) 2020a61f6811SShuah Khan return 0; 2021a61f6811SShuah Khan 2022a61f6811SShuah Khan em28xx_info("Resuming video extension"); 2023a61f6811SShuah Khan /* what do we do here */ 2024a61f6811SShuah Khan return 0; 2025a61f6811SShuah Khan } 2026a61f6811SShuah Khan 20270c0d06caSMauro Carvalho Chehab /* 20280c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 20290c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 20300c0d06caSMauro Carvalho Chehab * calls and ioctls 20310c0d06caSMauro Carvalho Chehab */ 20320c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 20330c0d06caSMauro Carvalho Chehab { 20340c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 20350c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 203695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20370c0d06caSMauro Carvalho Chehab int errCode; 20380c0d06caSMauro Carvalho Chehab 20390c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 20400c0d06caSMauro Carvalho Chehab 2041d3829fadSDevin Heitmueller vb2_fop_release(filp); 204298c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 20430c0d06caSMauro Carvalho Chehab 20440c0d06caSMauro Carvalho Chehab if (dev->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: 206695d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 20670c0d06caSMauro Carvalho Chehab dev->users--; 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 21820c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 21830c0d06caSMauro Carvalho Chehab const struct video_device *template, 21840c0d06caSMauro Carvalho Chehab const char *type_name) 21850c0d06caSMauro Carvalho Chehab { 21860c0d06caSMauro Carvalho Chehab struct video_device *vfd; 21870c0d06caSMauro Carvalho Chehab 21880c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 21890c0d06caSMauro Carvalho Chehab if (NULL == vfd) 21900c0d06caSMauro Carvalho Chehab return NULL; 21910c0d06caSMauro Carvalho Chehab 21920c0d06caSMauro Carvalho Chehab *vfd = *template; 219395d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 21940c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 21950c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 219669a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 2197d8c95c08SHans Verkuil if (dev->board.is_webcam) 2198d8c95c08SHans Verkuil vfd->tvnorms = 0; 21990c0d06caSMauro Carvalho Chehab 22000c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 22010c0d06caSMauro Carvalho Chehab dev->name, type_name); 22020c0d06caSMauro Carvalho Chehab 22030c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 22040c0d06caSMauro Carvalho Chehab return vfd; 22050c0d06caSMauro Carvalho Chehab } 22060c0d06caSMauro Carvalho Chehab 220701c28193SMauro Carvalho Chehab static void em28xx_tuner_setup(struct em28xx *dev) 22080560f337SMauro Carvalho Chehab { 220995d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &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 if (dev->tuner_type == TUNER_ABSENT) 22140560f337SMauro Carvalho Chehab return; 22150560f337SMauro Carvalho Chehab 22160560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 22170560f337SMauro Carvalho Chehab 22180560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 22190560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 22200560f337SMauro Carvalho Chehab 22210560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 22220560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 22230560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 22240560f337SMauro Carvalho Chehab 222595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 222695d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22270560f337SMauro Carvalho Chehab } 22280560f337SMauro Carvalho Chehab 22290560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 22300560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 22310560f337SMauro Carvalho Chehab tun_setup.addr = dev->tuner_addr; 22320560f337SMauro Carvalho Chehab 223395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 223495d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22350560f337SMauro Carvalho Chehab } 22360560f337SMauro Carvalho Chehab 22370560f337SMauro Carvalho Chehab if (dev->tda9887_conf) { 22380560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 22390560f337SMauro Carvalho Chehab 22400560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 22410560f337SMauro Carvalho Chehab tda9887_cfg.priv = &dev->tda9887_conf; 22420560f337SMauro Carvalho Chehab 224395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 224495d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 22450560f337SMauro Carvalho Chehab } 22460560f337SMauro Carvalho Chehab 22470560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 22480560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 22490560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 22500560f337SMauro Carvalho Chehab 22510560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 22520560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 22530560f337SMauro Carvalho Chehab 22540560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 22550560f337SMauro Carvalho Chehab 22560560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 22570560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 22580560f337SMauro Carvalho Chehab 225995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 22600560f337SMauro Carvalho Chehab } 22610560f337SMauro Carvalho Chehab 22620560f337SMauro Carvalho Chehab /* configure tuner */ 22630560f337SMauro Carvalho Chehab f.tuner = 0; 22640560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 22650560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 22660560f337SMauro Carvalho Chehab dev->ctl_freq = f.frequency; 226795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 22680560f337SMauro Carvalho Chehab } 22690560f337SMauro Carvalho Chehab 227001c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 22710c0d06caSMauro Carvalho Chehab { 22720c0d06caSMauro Carvalho Chehab u8 val; 22730c0d06caSMauro Carvalho Chehab int ret; 22740c0d06caSMauro Carvalho Chehab unsigned int maxw; 2275abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 227695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2277b64f8e9aSMauro Carvalho Chehab 2278822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2279822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2280822b8deaSMauro Carvalho Chehab return 0; 2281822b8deaSMauro Carvalho Chehab } 2282822b8deaSMauro Carvalho Chehab 228301c28193SMauro Carvalho Chehab if (!dev->has_video) { 2284b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2285b64f8e9aSMauro Carvalho Chehab return 0; 2286b64f8e9aSMauro Carvalho Chehab } 22870c0d06caSMauro Carvalho Chehab 22889634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 22890c0d06caSMauro Carvalho Chehab 229001c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 229101c28193SMauro Carvalho Chehab 229295d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 229395d2608bSFrank Schaefer if (v4l2 == NULL) { 229495d2608bSFrank Schaefer em28xx_info("em28xx_v4l: memory allocation failed\n"); 229595d2608bSFrank Schaefer mutex_unlock(&dev->lock); 229695d2608bSFrank Schaefer return -ENOMEM; 229795d2608bSFrank Schaefer } 229895d2608bSFrank Schaefer kref_init(&v4l2->ref); 2299abc1308fSFrank Schaefer v4l2->dev = dev; 230095d2608bSFrank Schaefer dev->v4l2 = v4l2; 230195d2608bSFrank Schaefer 230295d2608bSFrank Schaefer ret = v4l2_device_register(&dev->udev->dev, &v4l2->v4l2_dev); 2303b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2304b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2305b64f8e9aSMauro Carvalho Chehab goto err; 2306b64f8e9aSMauro Carvalho Chehab } 2307b64f8e9aSMauro Carvalho Chehab 2308abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2309b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 231095d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2311b64f8e9aSMauro Carvalho Chehab 2312b64f8e9aSMauro Carvalho Chehab /* 2313b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2314b64f8e9aSMauro Carvalho Chehab */ 2315b64f8e9aSMauro Carvalho Chehab dev->vinmode = 0x10; 2316b64f8e9aSMauro Carvalho Chehab dev->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) { 2344b64f8e9aSMauro Carvalho Chehab int has_demod = (dev->tda9887_conf & TDA9887_PRESENT); 2345b64f8e9aSMauro Carvalho Chehab 2346b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 234795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2349b64f8e9aSMauro Carvalho Chehab "tuner", dev->board.radio_addr, NULL); 2350b64f8e9aSMauro Carvalho Chehab 2351b64f8e9aSMauro Carvalho Chehab if (has_demod) 235295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2353b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2354b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 2355b64f8e9aSMauro Carvalho Chehab if (dev->tuner_addr == 0) { 2356b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2357b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2358b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2359b64f8e9aSMauro Carvalho Chehab 236095d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2361b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2362b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(type)); 2363b64f8e9aSMauro Carvalho Chehab 2364b64f8e9aSMauro Carvalho Chehab if (sd) 2365b64f8e9aSMauro Carvalho Chehab dev->tuner_addr = v4l2_i2c_subdev_addr(sd); 2366b64f8e9aSMauro Carvalho Chehab } else { 236795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 236895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2369b64f8e9aSMauro Carvalho Chehab "tuner", dev->tuner_addr, NULL); 2370b64f8e9aSMauro Carvalho Chehab } 2371b64f8e9aSMauro Carvalho Chehab } 2372b64f8e9aSMauro Carvalho Chehab 2373b64f8e9aSMauro Carvalho Chehab em28xx_tuner_setup(dev); 2374d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2375b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2376b64f8e9aSMauro Carvalho Chehab 2377b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2378b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2379b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2380b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2381b64f8e9aSMauro Carvalho Chehab __func__, ret); 2382b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2383b64f8e9aSMauro Carvalho Chehab } 2384b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2385b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2386b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2387b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2388b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2389b64f8e9aSMauro Carvalho Chehab } else { 2390b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2391b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2392b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2393b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2394b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2395b64f8e9aSMauro Carvalho Chehab } 2396b64f8e9aSMauro Carvalho Chehab 2397b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2398b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2399b64f8e9aSMauro Carvalho Chehab 2400b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2401b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2402b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2403b64f8e9aSMauro Carvalho Chehab 2404b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2405b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2406b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2407b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2408b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2409b64f8e9aSMauro Carvalho Chehab __func__, ret); 2410b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2411b64f8e9aSMauro Carvalho Chehab } 2412b64f8e9aSMauro Carvalho Chehab msleep(3); 2413b64f8e9aSMauro Carvalho Chehab 2414b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2415b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2416b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2417b64f8e9aSMauro Carvalho Chehab __func__, ret); 2418b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2419b64f8e9aSMauro Carvalho Chehab } 2420b64f8e9aSMauro Carvalho Chehab msleep(3); 2421b64f8e9aSMauro Carvalho Chehab } 2422b64f8e9aSMauro Carvalho Chehab 24230c0d06caSMauro Carvalho Chehab /* set default norm */ 2424d8c95c08SHans Verkuil dev->norm = V4L2_STD_PAL; 242595d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, dev->norm); 24260c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 24270c0d06caSMauro Carvalho Chehab 24280c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 24290c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 24300c0d06caSMauro Carvalho Chehab 24310c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 24320c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 24330c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 24340c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 24350c0d06caSMauro Carvalho Chehab maxw /= 2; 24360c0d06caSMauro Carvalho Chehab 24370c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 24380c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 24390c0d06caSMauro Carvalho Chehab 24400c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 24410c0d06caSMauro Carvalho Chehab 24420c0d06caSMauro Carvalho Chehab /* Audio defaults */ 24430c0d06caSMauro Carvalho Chehab dev->mute = 1; 24440c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 24450c0d06caSMauro Carvalho Chehab 24460c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 24470c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 24480c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 24490c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 24500c0d06caSMauro Carvalho Chehab 24510c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 24520c0d06caSMauro Carvalho Chehab 24538f8b113aSFrank Schaefer /* Add image controls */ 24548f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 24558f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2456ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2457ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24588f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 24598f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2460ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2461ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24628f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 24638f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2464ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2465ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24668f8b113aSFrank Schaefer V4L2_CID_SATURATION, 24678f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2468ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2469ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24708f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 24718f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2472ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2473ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24748f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 24758f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2476ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2477ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24788f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 24798f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 24808f8b113aSFrank Schaefer 24818f8b113aSFrank Schaefer /* Reset image controls */ 24828f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2483ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2484ad298055SFrank Schaefer ret = hdl->error; 2485b64f8e9aSMauro Carvalho Chehab if (ret) 2486b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24878f8b113aSFrank Schaefer 24880c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2489ef74a0b9SFrank Schaefer v4l2->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 2490ef74a0b9SFrank Schaefer if (!v4l2->vdev) { 24910c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2492b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2493b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24940c0d06caSMauro Carvalho Chehab } 249527a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 249627a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 249727a36df6SFrank Schaefer v4l2->vdev->queue = &v4l2->vb_vidq; 249827a36df6SFrank Schaefer v4l2->vdev->queue->lock = &v4l2->vb_queue_lock; 24990c0d06caSMauro Carvalho Chehab 25006e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 25016e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2502ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_QUERYSTD); 2503ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_STD); 2504ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_STD); 25053bc85cceSFrank Schaefer } else { 2506ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 25076e46dabaSFrank Schaefer } 250866df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2509ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_TUNER); 2510ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_TUNER); 2511ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_FREQUENCY); 2512ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_FREQUENCY); 251366df67b7SFrank Schaefer } 2514c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2515ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_AUDIO); 2516ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_AUDIO); 2517c2dcef83SFrank Schaefer } 25186e46dabaSFrank Schaefer 25190c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2520ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vdev, VFL_TYPE_GRABBER, 25210c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 25220c0d06caSMauro Carvalho Chehab if (ret) { 25230c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 25240c0d06caSMauro Carvalho Chehab ret); 2525b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25260c0d06caSMauro Carvalho Chehab } 25270c0d06caSMauro Carvalho Chehab 25280c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 25290c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2530ef74a0b9SFrank Schaefer v4l2->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 25310c0d06caSMauro Carvalho Chehab "vbi"); 25320c0d06caSMauro Carvalho Chehab 253327a36df6SFrank Schaefer v4l2->vbi_dev->queue = &v4l2->vb_vbiq; 253427a36df6SFrank Schaefer v4l2->vbi_dev->queue->lock = &v4l2->vb_vbi_queue_lock; 2535d3829fadSDevin Heitmueller 253666df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2537ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 253866df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2539ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_TUNER); 2540ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_TUNER); 2541ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2542ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 254366df67b7SFrank Schaefer } 2544c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2545ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_AUDIO); 2546ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_AUDIO); 2547c2dcef83SFrank Schaefer } 254866df67b7SFrank Schaefer 25490c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2550ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vbi_dev, VFL_TYPE_VBI, 25510c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 25520c0d06caSMauro Carvalho Chehab if (ret < 0) { 25530c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2554b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25550c0d06caSMauro Carvalho Chehab } 25560c0d06caSMauro Carvalho Chehab } 25570c0d06caSMauro Carvalho Chehab 25580c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2559ef74a0b9SFrank Schaefer v4l2->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 25600c0d06caSMauro Carvalho Chehab "radio"); 2561ef74a0b9SFrank Schaefer if (!v4l2->radio_dev) { 25620c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2563b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2564b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25650c0d06caSMauro Carvalho Chehab } 2566ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->radio_dev, VFL_TYPE_RADIO, 25670c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 25680c0d06caSMauro Carvalho Chehab if (ret < 0) { 25690c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2570b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25710c0d06caSMauro Carvalho Chehab } 25720c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 2573ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 25740c0d06caSMauro Carvalho Chehab } 25750c0d06caSMauro Carvalho Chehab 25760c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 2577ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 25780c0d06caSMauro Carvalho Chehab 2579ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 25800c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 2581ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 25820c0d06caSMauro Carvalho Chehab 2583b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 258495d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2585b64f8e9aSMauro Carvalho Chehab 2586b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2587b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2588b64f8e9aSMauro Carvalho Chehab 25899634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 25909634614fSMauro Carvalho Chehab 259147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 259247677e51SMauro Carvalho Chehab 259301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 25940c0d06caSMauro Carvalho Chehab return 0; 2595b64f8e9aSMauro Carvalho Chehab 2596b64f8e9aSMauro Carvalho Chehab unregister_dev: 2597abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 259895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2599b64f8e9aSMauro Carvalho Chehab err: 260095d2608bSFrank Schaefer dev->v4l2 = NULL; 260195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 260201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2603b64f8e9aSMauro Carvalho Chehab return ret; 26040c0d06caSMauro Carvalho Chehab } 260501c28193SMauro Carvalho Chehab 260601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 260701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 260801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 260901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 261001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2611a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2612a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 261301c28193SMauro Carvalho Chehab }; 261401c28193SMauro Carvalho Chehab 261501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 261601c28193SMauro Carvalho Chehab { 261701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 261801c28193SMauro Carvalho Chehab } 261901c28193SMauro Carvalho Chehab 262001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 262101c28193SMauro Carvalho Chehab { 262201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 262301c28193SMauro Carvalho Chehab } 262401c28193SMauro Carvalho Chehab 262501c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 262601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2627