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 { 147d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 148d7dc18daSFrank Schaefer 14925c61e4cSFrank Schaefer if (dev->board.is_webcam) 150d7dc18daSFrank Schaefer return v4l2->sensor_xres; 15125c61e4cSFrank Schaefer 15225c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15325c61e4cSFrank Schaefer return 640; 15425c61e4cSFrank Schaefer 15525c61e4cSFrank Schaefer return 720; 15625c61e4cSFrank Schaefer } 15725c61e4cSFrank Schaefer 15825c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 15925c61e4cSFrank Schaefer { 16052faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16152faaf78SFrank Schaefer 16225c61e4cSFrank Schaefer if (dev->board.is_webcam) 163d7dc18daSFrank Schaefer return v4l2->sensor_yres; 16425c61e4cSFrank Schaefer 16525c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16625c61e4cSFrank Schaefer return 480; 16725c61e4cSFrank Schaefer 16852faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 16925c61e4cSFrank Schaefer } 17025c61e4cSFrank Schaefer 17101c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1720560f337SMauro Carvalho Chehab { 1730560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1740560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1750560f337SMauro Carvalho Chehab return 0; 1760560f337SMauro Carvalho Chehab 1770560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1780560f337SMauro Carvalho Chehab return 0; 1790560f337SMauro Carvalho Chehab 1800560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1810560f337SMauro Carvalho Chehab 1820560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1830560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1840560f337SMauro Carvalho Chehab return 1; 1850560f337SMauro Carvalho Chehab 1860560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1870560f337SMauro Carvalho Chehab return 0; 1880560f337SMauro Carvalho Chehab } 1890560f337SMauro Carvalho Chehab 1900560f337SMauro Carvalho Chehab /* 1910560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1920560f337SMauro Carvalho Chehab * configure i2c attached devices 1930560f337SMauro Carvalho Chehab */ 19401c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1950560f337SMauro Carvalho Chehab { 19695d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 19795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1990560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 20095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_stream, 0); 2010560f337SMauro Carvalho Chehab } 2020560f337SMauro Carvalho Chehab 20301c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2040560f337SMauro Carvalho Chehab { 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2090560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2110560f337SMauro Carvalho Chehab 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2160560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2170560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2180560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2190560f337SMauro Carvalho Chehab } 2200560f337SMauro Carvalho Chehab 22101c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2220560f337SMauro Carvalho Chehab { 2230560f337SMauro Carvalho Chehab int ret; 2240560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 225753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2260560f337SMauro Carvalho Chehab 22706e20672SFrank Schaefer fmt = v4l2->format->reg; 2280560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2290560f337SMauro Carvalho Chehab fmt |= 0x20; 2300560f337SMauro Carvalho Chehab /* 2310560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2320560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2330560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2340560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2350560f337SMauro Carvalho Chehab * 2360560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2370560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2380560f337SMauro Carvalho Chehab */ 2390560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2400560f337SMauro Carvalho Chehab if (ret < 0) 2410560f337SMauro Carvalho Chehab return ret; 2420560f337SMauro Carvalho Chehab 2439297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2440560f337SMauro Carvalho Chehab if (ret < 0) 2450560f337SMauro Carvalho Chehab return ret; 2460560f337SMauro Carvalho Chehab 2479297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2480560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2490560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2500560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 251753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 252753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25352faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2540560f337SMauro Carvalho Chehab /* NTSC */ 2550560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25652faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2570560f337SMauro Carvalho Chehab /* PAL */ 2580560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2590560f337SMauro Carvalho Chehab } 2600560f337SMauro Carvalho Chehab } 2610560f337SMauro Carvalho Chehab 2620560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2630560f337SMauro Carvalho Chehab } 2640560f337SMauro Carvalho Chehab 2650560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2660560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2670560f337SMauro Carvalho Chehab { 2680560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2690560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2700560f337SMauro Carvalho Chehab 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2720560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2730560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2740560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2750560f337SMauro Carvalho Chehab } 2760560f337SMauro Carvalho Chehab 2770560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2780560f337SMauro Carvalho Chehab u16 width, u16 height) 2790560f337SMauro Carvalho Chehab { 2800560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2810560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2820560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2830560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2840560f337SMauro Carvalho Chehab 2850560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2860560f337SMauro Carvalho Chehab hstart, vstart, 2870560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2880560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2890560f337SMauro Carvalho Chehab 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2930560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2940560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2950560f337SMauro Carvalho Chehab 2960560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2970560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2980560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2990560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 3000560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 3010560f337SMauro Carvalho Chehab } 3020560f337SMauro Carvalho Chehab } 3030560f337SMauro Carvalho Chehab 3040560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3050560f337SMauro Carvalho Chehab { 306cba8e9b3SFrank Schaefer u8 mode = 0x00; 3070560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3080560f337SMauro Carvalho Chehab 3090560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3100560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3110560f337SMauro Carvalho Chehab } else { 3120560f337SMauro Carvalho Chehab u8 buf[2]; 3130560f337SMauro Carvalho Chehab 3140560f337SMauro Carvalho Chehab buf[0] = h; 3150560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3160560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3170560f337SMauro Carvalho Chehab 3180560f337SMauro Carvalho Chehab buf[0] = v; 3190560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3200560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3210560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3220560f337SMauro Carvalho Chehab to work correctly */ 3230560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3240560f337SMauro Carvalho Chehab } 325cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3260560f337SMauro Carvalho Chehab } 3270560f337SMauro Carvalho Chehab 3280560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32901c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3300560f337SMauro Carvalho Chehab { 331753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 332753aee77SFrank Schaefer int width = norm_maxw(dev); 333753aee77SFrank Schaefer int height = norm_maxh(dev); 3340560f337SMauro Carvalho Chehab 3350560f337SMauro Carvalho Chehab /* Properly setup VBI */ 336753aee77SFrank Schaefer v4l2->vbi_width = 720; 33752faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 338753aee77SFrank Schaefer v4l2->vbi_height = 12; 3390560f337SMauro Carvalho Chehab else 340753aee77SFrank Schaefer v4l2->vbi_height = 18; 3410560f337SMauro Carvalho Chehab 3420560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3430560f337SMauro Carvalho Chehab 3440560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3450560f337SMauro Carvalho Chehab 3460560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3470560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3480560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3490560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3500560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3510560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3520560f337SMauro Carvalho Chehab region */ 3530560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3540560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3550560f337SMauro Carvalho Chehab else 3560560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3570560f337SMauro Carvalho Chehab 358753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3590560f337SMauro Carvalho Chehab } 3600560f337SMauro Carvalho Chehab 3610560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36201c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3630560f337SMauro Carvalho Chehab { 364753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 3650560f337SMauro Carvalho Chehab int errCode; 3660560f337SMauro Carvalho Chehab int i; 367753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3680560f337SMauro Carvalho Chehab 3690560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3700560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3710560f337SMauro Carvalho Chehab dev->alt = 0; 3720560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3730560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3740560f337SMauro Carvalho Chehab dev->alt = alt; 3750560f337SMauro Carvalho Chehab goto set_alt; 3760560f337SMauro Carvalho Chehab } 3770560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3780560f337SMauro Carvalho Chehab goto set_alt; 3790560f337SMauro Carvalho Chehab 3800560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3810560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3820560f337SMauro Carvalho Chehab green screen will be received. 3830560f337SMauro Carvalho Chehab */ 384753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3850560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3860560f337SMauro Carvalho Chehab 3870560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3880560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3890560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3900560f337SMauro Carvalho Chehab dev->alt = i; 3910560f337SMauro Carvalho Chehab break; 3920560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3930560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3940560f337SMauro Carvalho Chehab */ 3950560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3960560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3970560f337SMauro Carvalho Chehab dev->alt = i; 3980560f337SMauro Carvalho Chehab } 3990560f337SMauro Carvalho Chehab 4000560f337SMauro Carvalho Chehab set_alt: 4010560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4020560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4030560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4040560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4050560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4060560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4070560f337SMauro Carvalho Chehab } else { /* isoc */ 4080560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4090560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4100560f337SMauro Carvalho Chehab dev->max_pkt_size = 4110560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4120560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4130560f337SMauro Carvalho Chehab } 4140560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4150560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 416961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 4170560f337SMauro Carvalho Chehab if (errCode < 0) { 4180560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 4190560f337SMauro Carvalho Chehab dev->alt, errCode); 4200560f337SMauro Carvalho Chehab return errCode; 4210560f337SMauro Carvalho Chehab } 4220560f337SMauro Carvalho Chehab return 0; 4230560f337SMauro Carvalho Chehab } 4240560f337SMauro Carvalho Chehab 4250c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4260c0d06caSMauro Carvalho Chehab DMA and thread functions 4270c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4280c0d06caSMauro Carvalho Chehab 4290c0d06caSMauro Carvalho Chehab /* 430948a49aaSFrank Schaefer * Finish the current buffer 4310c0d06caSMauro Carvalho Chehab */ 432948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4330c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4340c0d06caSMauro Carvalho Chehab { 435d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 436d3829fadSDevin Heitmueller 437f0e38230SFrank Schaefer buf->vb.v4l2_buf.sequence = dev->v4l2->field_count++; 438d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 439d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 440d3829fadSDevin Heitmueller 441d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4420c0d06caSMauro Carvalho Chehab } 4430c0d06caSMauro Carvalho Chehab 4440c0d06caSMauro Carvalho Chehab /* 44536016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4460c0d06caSMauro Carvalho Chehab */ 4470c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4480c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 44936016a35SFrank Schaefer unsigned char *usb_buf, 4504078d625SFrank Schaefer unsigned long len) 4510c0d06caSMauro Carvalho Chehab { 45258159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4530c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4540c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45558159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4560c0d06caSMauro Carvalho Chehab 457d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 458d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4590c0d06caSMauro Carvalho Chehab 46036016a35SFrank Schaefer startread = usb_buf; 4610c0d06caSMauro Carvalho Chehab remain = len; 4620c0d06caSMauro Carvalho Chehab 46358159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46436016a35SFrank Schaefer fieldstart = buf->vb_buf; 465c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46636016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4670c0d06caSMauro Carvalho Chehab 4688732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4698732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4700c0d06caSMauro Carvalho Chehab 47158159171SFrank Schaefer if (v4l2->progressive) 4720c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4730c0d06caSMauro Carvalho Chehab else 4740c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4750c0d06caSMauro Carvalho Chehab 4760c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4770c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4780c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4790c0d06caSMauro Carvalho Chehab 480d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 4820c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 483d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 484d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48536016a35SFrank Schaefer (char *)startwrite; 4860c0d06caSMauro Carvalho Chehab lencopy = remain; 4870c0d06caSMauro Carvalho Chehab } 4880c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4890c0d06caSMauro Carvalho Chehab return; 4900c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4910c0d06caSMauro Carvalho Chehab 4920c0d06caSMauro Carvalho Chehab remain -= lencopy; 4930c0d06caSMauro Carvalho Chehab 4940c0d06caSMauro Carvalho Chehab while (remain > 0) { 49558159171SFrank Schaefer if (v4l2->progressive) 496c02ec71bSFrank Schaefer startwrite += lencopy; 497c02ec71bSFrank Schaefer else 4980c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 4990c0d06caSMauro Carvalho Chehab startread += lencopy; 5000c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5010c0d06caSMauro Carvalho Chehab lencopy = remain; 5020c0d06caSMauro Carvalho Chehab else 5030c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5040c0d06caSMauro Carvalho Chehab 50536016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 506d3829fadSDevin Heitmueller buf->length) { 5070c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 5080c0d06caSMauro Carvalho Chehab "(2)\n", 5090c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 510d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 511d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5120c0d06caSMauro Carvalho Chehab (char *)startwrite; 5130c0d06caSMauro Carvalho Chehab } 5140c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5150c0d06caSMauro Carvalho Chehab break; 5160c0d06caSMauro Carvalho Chehab 5170c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab remain -= lencopy; 5200c0d06caSMauro Carvalho Chehab } 5210c0d06caSMauro Carvalho Chehab 5228732533bSFrank Schaefer buf->pos += len; 5230c0d06caSMauro Carvalho Chehab } 5240c0d06caSMauro Carvalho Chehab 52536016a35SFrank Schaefer /* 52636016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52736016a35SFrank Schaefer */ 5280c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5290c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53036016a35SFrank Schaefer unsigned char *usb_buf, 5314078d625SFrank Schaefer unsigned long len) 5320c0d06caSMauro Carvalho Chehab { 53336016a35SFrank Schaefer unsigned int offset; 5340c0d06caSMauro Carvalho Chehab 535d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 536d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5370c0d06caSMauro Carvalho Chehab 5388732533bSFrank Schaefer offset = buf->pos; 5390c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54036016a35SFrank Schaefer if (buf->top_field == 0) 541753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5420c0d06caSMauro Carvalho Chehab 54336016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5448732533bSFrank Schaefer buf->pos += len; 5450c0d06caSMauro Carvalho Chehab } 5460c0d06caSMauro Carvalho Chehab 5470c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5480c0d06caSMauro Carvalho Chehab int packet, int status) 5490c0d06caSMauro Carvalho Chehab { 5500c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5510c0d06caSMauro Carvalho Chehab 5520c0d06caSMauro Carvalho Chehab switch (status) { 5530c0d06caSMauro Carvalho Chehab case -ENOENT: 5540c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5550c0d06caSMauro Carvalho Chehab break; 5560c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5570c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5580c0d06caSMauro Carvalho Chehab break; 5590c0d06caSMauro Carvalho Chehab case -ENOSR: 5600c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5610c0d06caSMauro Carvalho Chehab break; 5620c0d06caSMauro Carvalho Chehab case -EPIPE: 5630c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5640c0d06caSMauro Carvalho Chehab break; 5650c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5660c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5670c0d06caSMauro Carvalho Chehab break; 5680c0d06caSMauro Carvalho Chehab case -EPROTO: 5690c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5700c0d06caSMauro Carvalho Chehab break; 5710c0d06caSMauro Carvalho Chehab case -EILSEQ: 5720c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5730c0d06caSMauro Carvalho Chehab break; 5740c0d06caSMauro Carvalho Chehab case -ETIME: 5750c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5760c0d06caSMauro Carvalho Chehab break; 5770c0d06caSMauro Carvalho Chehab } 5780c0d06caSMauro Carvalho Chehab if (packet < 0) { 5790c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5800c0d06caSMauro Carvalho Chehab } else { 5810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5820c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5830c0d06caSMauro Carvalho Chehab } 5840c0d06caSMauro Carvalho Chehab } 5850c0d06caSMauro Carvalho Chehab 5860c0d06caSMauro Carvalho Chehab /* 58724a6d849SFrank Schaefer * get the next available buffer from dma queue 5880c0d06caSMauro Carvalho Chehab */ 58924a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59024a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5910c0d06caSMauro Carvalho Chehab { 59224a6d849SFrank Schaefer struct em28xx_buffer *buf; 5930c0d06caSMauro Carvalho Chehab 5940c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5950c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59624a6d849SFrank Schaefer return NULL; 5970c0d06caSMauro Carvalho Chehab } 5980c0d06caSMauro Carvalho Chehab 5990c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 600d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6010c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 602d3829fadSDevin Heitmueller list_del(&buf->list); 6038732533bSFrank Schaefer buf->pos = 0; 604d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6050c0d06caSMauro Carvalho Chehab 60624a6d849SFrank Schaefer return buf; 6070c0d06caSMauro Carvalho Chehab } 6080c0d06caSMauro Carvalho Chehab 609e04c00d9SFrank Schaefer /* 610e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 611e04c00d9SFrank Schaefer */ 612e04c00d9SFrank Schaefer static struct em28xx_buffer * 613e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 614e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 615e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 616e04c00d9SFrank Schaefer { 61758159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 61858159171SFrank Schaefer 619f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 620e04c00d9SFrank Schaefer if (buf != NULL) 621e04c00d9SFrank Schaefer finish_buffer(dev, buf); 622e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 623e04c00d9SFrank Schaefer } 624e04c00d9SFrank Schaefer if (buf != NULL) { 625f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 626e04c00d9SFrank Schaefer buf->pos = 0; 627e04c00d9SFrank Schaefer } 628e04c00d9SFrank Schaefer 629e04c00d9SFrank Schaefer return buf; 630e04c00d9SFrank Schaefer } 631e04c00d9SFrank Schaefer 632227b7c90SFrank Schaefer /* 633227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 634227b7c90SFrank Schaefer */ 635227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 636227b7c90SFrank Schaefer unsigned char *data_pkt, 637227b7c90SFrank Schaefer unsigned int data_len) 638227b7c90SFrank Schaefer { 639753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 640227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 641227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 642227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 643227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 644227b7c90SFrank Schaefer 645227b7c90SFrank Schaefer /* capture type 0 = vbi start 646227b7c90SFrank Schaefer capture type 1 = vbi in progress 647227b7c90SFrank Schaefer capture type 2 = video start 648227b7c90SFrank Schaefer capture type 3 = video in progress */ 649227b7c90SFrank Schaefer if (data_len >= 4) { 650227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 651227b7c90SFrank Schaefer * never split across packets */ 652227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 653227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 654227b7c90SFrank Schaefer /* Continuation */ 655227b7c90SFrank Schaefer data_pkt += 4; 656227b7c90SFrank Schaefer data_len -= 4; 657227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 658227b7c90SFrank Schaefer /* Field start (VBI mode) */ 659f0e38230SFrank Schaefer v4l2->capture_type = 0; 660f0e38230SFrank Schaefer v4l2->vbi_read = 0; 661227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 662f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 663227b7c90SFrank Schaefer data_pkt += 4; 664227b7c90SFrank Schaefer data_len -= 4; 665227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 666227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 667f0e38230SFrank Schaefer v4l2->capture_type = 2; 668227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 669f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 670227b7c90SFrank Schaefer data_pkt += 4; 671227b7c90SFrank Schaefer data_len -= 4; 672227b7c90SFrank Schaefer } 673227b7c90SFrank Schaefer } 674227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 675227b7c90SFrank Schaefer * have no continuation header */ 676227b7c90SFrank Schaefer 677f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 678227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 679227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 680f0e38230SFrank Schaefer v4l2->capture_type = 1; 681227b7c90SFrank Schaefer } 682227b7c90SFrank Schaefer 683f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 684753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 685f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 686f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 687227b7c90SFrank Schaefer 688227b7c90SFrank Schaefer /* Copy VBI data */ 689227b7c90SFrank Schaefer if (vbi_buf != NULL) 690227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 691f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 692227b7c90SFrank Schaefer 693227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 694227b7c90SFrank Schaefer /* Continue with copying video data */ 695f0e38230SFrank Schaefer v4l2->capture_type = 2; 696227b7c90SFrank Schaefer data_pkt += vbi_data_len; 697227b7c90SFrank Schaefer data_len -= vbi_data_len; 698227b7c90SFrank Schaefer } 699227b7c90SFrank Schaefer } 700227b7c90SFrank Schaefer 701f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 702227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 703227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 704f0e38230SFrank Schaefer v4l2->capture_type = 3; 705227b7c90SFrank Schaefer } 706227b7c90SFrank Schaefer 707f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 708227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 709227b7c90SFrank Schaefer } 710227b7c90SFrank Schaefer 711e507e0e5SFrank Schaefer /* 712e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 713e507e0e5SFrank Schaefer */ 714e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 715e507e0e5SFrank Schaefer unsigned char *data_pkt, 716e507e0e5SFrank Schaefer unsigned int data_len) 717e507e0e5SFrank Schaefer { 718e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 719e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 720f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 721e507e0e5SFrank Schaefer bool frame_end = 0; 722e507e0e5SFrank Schaefer 723e507e0e5SFrank Schaefer /* Check for header */ 724e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 725e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 726e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 727e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 728e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 729f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 730e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 731e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 732e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 733e507e0e5SFrank Schaefer data_pkt += 2; 734e507e0e5SFrank Schaefer data_len -= 2; 735e507e0e5SFrank Schaefer } 736e507e0e5SFrank Schaefer 737e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 738e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 739e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 740e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 741e507e0e5SFrank Schaefer } 742e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 743e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 744e507e0e5SFrank Schaefer * first frame. 745e507e0e5SFrank Schaefer */ 746e507e0e5SFrank Schaefer } 747e507e0e5SFrank Schaefer 748e507e0e5SFrank Schaefer /* Copy data */ 749e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 750e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 751e507e0e5SFrank Schaefer 752e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 753e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 754e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 755e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 756e507e0e5SFrank Schaefer } 757e507e0e5SFrank Schaefer 758e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 759e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 760e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 761e507e0e5SFrank Schaefer * header like with the other em28xx devices. 762e507e0e5SFrank Schaefer */ 763e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 764e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 765e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 766e507e0e5SFrank Schaefer } 767e507e0e5SFrank Schaefer 768960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7690fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7700c0d06caSMauro Carvalho Chehab { 771227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 772227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 773227b7c90SFrank Schaefer unsigned int usb_data_len; 7740c0d06caSMauro Carvalho Chehab 7750c0d06caSMauro Carvalho Chehab if (!dev) 7760c0d06caSMauro Carvalho Chehab return 0; 7770c0d06caSMauro Carvalho Chehab 7782665c299SFrank Schaefer if (dev->disconnected) 7790c0d06caSMauro Carvalho Chehab return 0; 7800c0d06caSMauro Carvalho Chehab 7811653cb0cSFrank Schaefer if (urb->status < 0) 7820c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7830c0d06caSMauro Carvalho Chehab 7844601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7854601cc39SFrank Schaefer 7864601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7874601cc39SFrank Schaefer num_packets = 1; 7884601cc39SFrank Schaefer else /* isoc */ 7894601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7900c0d06caSMauro Carvalho Chehab 7914601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7924601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 793227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7944601cc39SFrank Schaefer 795227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7964601cc39SFrank Schaefer } else { /* isoc */ 7974601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7984601cc39SFrank Schaefer print_err_status(dev, i, 7994601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8000c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8010c0d06caSMauro Carvalho Chehab continue; 8020c0d06caSMauro Carvalho Chehab } 8030c0d06caSMauro Carvalho Chehab 804227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 805227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8060c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8070c0d06caSMauro Carvalho Chehab continue; 8080c0d06caSMauro Carvalho Chehab } 8090c0d06caSMauro Carvalho Chehab 810227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8114601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8124601cc39SFrank Schaefer } 8134601cc39SFrank Schaefer 814227b7c90SFrank Schaefer if (usb_data_len == 0) { 8154601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8164601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8174601cc39SFrank Schaefer continue; 8184601cc39SFrank Schaefer } 8190c0d06caSMauro Carvalho Chehab 820e507e0e5SFrank Schaefer if (dev->is_em25xx) 821e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 822e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 823e507e0e5SFrank Schaefer else 824e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 825e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 826e507e0e5SFrank Schaefer 8270c0d06caSMauro Carvalho Chehab } 828227b7c90SFrank Schaefer return 1; 8290c0d06caSMauro Carvalho Chehab } 8300c0d06caSMauro Carvalho Chehab 8310c0d06caSMauro Carvalho Chehab 832d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 833d3829fadSDevin Heitmueller { 834d3829fadSDevin Heitmueller switch (f_type) { 835d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 836d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 837d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 838d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 839d3829fadSDevin Heitmueller default: 840d3829fadSDevin Heitmueller BUG(); 841d3829fadSDevin Heitmueller return 0; 842d3829fadSDevin Heitmueller } 843d3829fadSDevin Heitmueller } 844d3829fadSDevin Heitmueller 845d3829fadSDevin Heitmueller /* Usage lock check functions */ 846d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 847d3829fadSDevin Heitmueller { 848d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 849d3829fadSDevin Heitmueller 850d3829fadSDevin Heitmueller /* is it free? */ 851d3829fadSDevin Heitmueller if (dev->resources & res_type) { 852d3829fadSDevin Heitmueller /* no, someone else uses it */ 853d3829fadSDevin Heitmueller return -EBUSY; 854d3829fadSDevin Heitmueller } 855d3829fadSDevin Heitmueller 856d3829fadSDevin Heitmueller /* it's free, grab it */ 857d3829fadSDevin Heitmueller dev->resources |= res_type; 858d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 859d3829fadSDevin Heitmueller return 0; 860d3829fadSDevin Heitmueller } 861d3829fadSDevin Heitmueller 862d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 863d3829fadSDevin Heitmueller { 864d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 865d3829fadSDevin Heitmueller 866d3829fadSDevin Heitmueller dev->resources &= ~res_type; 867d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 868d3829fadSDevin Heitmueller } 869d3829fadSDevin Heitmueller 8700c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 871d3829fadSDevin Heitmueller Videobuf2 operations 8720c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8730c0d06caSMauro Carvalho Chehab 874d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 875d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 876d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8770c0d06caSMauro Carvalho Chehab { 878d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 879753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 880d3829fadSDevin Heitmueller unsigned long size; 8810c0d06caSMauro Carvalho Chehab 882d3829fadSDevin Heitmueller if (fmt) 883d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 884d3829fadSDevin Heitmueller else 885753aee77SFrank Schaefer size = 88606e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 8870c0d06caSMauro Carvalho Chehab 888d3829fadSDevin Heitmueller if (size == 0) 889d3829fadSDevin Heitmueller return -EINVAL; 8900c0d06caSMauro Carvalho Chehab 891d3829fadSDevin Heitmueller if (0 == *nbuffers) 892d3829fadSDevin Heitmueller *nbuffers = 32; 8930c0d06caSMauro Carvalho Chehab 894d3829fadSDevin Heitmueller *nplanes = 1; 895d3829fadSDevin Heitmueller sizes[0] = size; 8960c0d06caSMauro Carvalho Chehab 8970c0d06caSMauro Carvalho Chehab return 0; 8980c0d06caSMauro Carvalho Chehab } 8990c0d06caSMauro Carvalho Chehab 9000c0d06caSMauro Carvalho Chehab static int 901d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 9020c0d06caSMauro Carvalho Chehab { 903d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 904753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 9050c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 906d3829fadSDevin Heitmueller unsigned long size; 9070c0d06caSMauro Carvalho Chehab 908d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 9090c0d06caSMauro Carvalho Chehab 91006e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 911d3829fadSDevin Heitmueller 912d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 913d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 914d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 9150c0d06caSMauro Carvalho Chehab return -EINVAL; 916d3829fadSDevin Heitmueller } 917d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 9180c0d06caSMauro Carvalho Chehab 919d3829fadSDevin Heitmueller return 0; 9200c0d06caSMauro Carvalho Chehab } 9210c0d06caSMauro Carvalho Chehab 922d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 923d3829fadSDevin Heitmueller { 924d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 925f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 926d3829fadSDevin Heitmueller struct v4l2_frequency f; 927d3829fadSDevin Heitmueller int rc = 0; 9280c0d06caSMauro Carvalho Chehab 929d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 930d3829fadSDevin Heitmueller 931d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 932d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 933d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 934d3829fadSDevin Heitmueller if (rc) 935d3829fadSDevin Heitmueller return rc; 936d3829fadSDevin Heitmueller 9378139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 938d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 939d3829fadSDevin Heitmueller 940d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 941d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 942d3829fadSDevin Heitmueller 943d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 944d3829fadSDevin Heitmueller some i2c device 945d3829fadSDevin Heitmueller */ 946d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 947d3829fadSDevin Heitmueller 948f0e38230SFrank Schaefer v4l2->capture_type = -1; 949c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 950c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9510c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9520c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 953c647a91aSFrank Schaefer dev->packet_multiplier, 9540fa4a402SFrank Schaefer em28xx_urb_data_copy); 9550c0d06caSMauro Carvalho Chehab if (rc < 0) 956032f1ddfSFrank Schaefer return rc; 957d3829fadSDevin Heitmueller 958d3829fadSDevin Heitmueller /* 959d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 960d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 961d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 962d3829fadSDevin Heitmueller */ 963d3829fadSDevin Heitmueller 964d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 965d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 9663854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 967d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 968d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 969d3829fadSDevin Heitmueller else 970d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 971f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 97295d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 9730c0d06caSMauro Carvalho Chehab } 9740c0d06caSMauro Carvalho Chehab 9758139a4d5SFrank Schaefer v4l2->streaming_users++; 976032f1ddfSFrank Schaefer 9770c0d06caSMauro Carvalho Chehab return rc; 9780c0d06caSMauro Carvalho Chehab } 9790c0d06caSMauro Carvalho Chehab 980e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 9810c0d06caSMauro Carvalho Chehab { 982d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9838139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 9840c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 985d3829fadSDevin Heitmueller unsigned long flags = 0; 9860c0d06caSMauro Carvalho Chehab 987d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9880c0d06caSMauro Carvalho Chehab 989d3829fadSDevin Heitmueller res_free(dev, vq->type); 990d3829fadSDevin Heitmueller 9918139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 992d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 993d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9940c0d06caSMauro Carvalho Chehab } 9950c0d06caSMauro Carvalho Chehab 996d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 997d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 998d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 999d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1000d3829fadSDevin Heitmueller list_del(&buf->list); 1001d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1002d3829fadSDevin Heitmueller } 1003d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 1004d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1005d3829fadSDevin Heitmueller } 1006d3829fadSDevin Heitmueller 1007e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 10080c0d06caSMauro Carvalho Chehab { 1009d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 10108139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1011d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1012d3829fadSDevin Heitmueller unsigned long flags = 0; 10130c0d06caSMauro Carvalho Chehab 1014d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 10150c0d06caSMauro Carvalho Chehab 1016d3829fadSDevin Heitmueller res_free(dev, vq->type); 1017d3829fadSDevin Heitmueller 10188139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 1019d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1020d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 10210c0d06caSMauro Carvalho Chehab } 10220c0d06caSMauro Carvalho Chehab 1023d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1024d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1025d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1026d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1027d3829fadSDevin Heitmueller list_del(&buf->list); 1028d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1029d3829fadSDevin Heitmueller } 1030d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 1031d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1032d3829fadSDevin Heitmueller } 1033d3829fadSDevin Heitmueller 1034d3829fadSDevin Heitmueller static void 1035d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1036d3829fadSDevin Heitmueller { 1037d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1038d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 1039d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1040d3829fadSDevin Heitmueller unsigned long flags = 0; 1041d3829fadSDevin Heitmueller 1042d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1043d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1044d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1045d3829fadSDevin Heitmueller 1046d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1047d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1048d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1049d3829fadSDevin Heitmueller } 1050d3829fadSDevin Heitmueller 1051d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1052d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10530c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10540c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1055d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1056d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1057d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1058d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10590c0d06caSMauro Carvalho Chehab }; 10600c0d06caSMauro Carvalho Chehab 106101c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1062d3829fadSDevin Heitmueller { 1063d3829fadSDevin Heitmueller int rc; 1064d3829fadSDevin Heitmueller struct vb2_queue *q; 106527a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1066d3829fadSDevin Heitmueller 1067d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 106827a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1069d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1070ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1071ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1072d3829fadSDevin Heitmueller q->drv_priv = dev; 1073d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1074d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1075d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1076d3829fadSDevin Heitmueller 1077d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1078d3829fadSDevin Heitmueller if (rc < 0) 1079d3829fadSDevin Heitmueller return rc; 1080d3829fadSDevin Heitmueller 1081d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 108227a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1083d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1084d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1085ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1086d3829fadSDevin Heitmueller q->drv_priv = dev; 1087d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1088d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1089d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1090d3829fadSDevin Heitmueller 1091d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1092d3829fadSDevin Heitmueller if (rc < 0) 1093d3829fadSDevin Heitmueller return rc; 1094d3829fadSDevin Heitmueller 1095d3829fadSDevin Heitmueller return 0; 1096d3829fadSDevin Heitmueller } 1097d3829fadSDevin Heitmueller 10980c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 10990c0d06caSMauro Carvalho Chehab 11000c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 11010c0d06caSMauro Carvalho Chehab { 110295d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 11030c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 11040c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 11050c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 11060c0d06caSMauro Carvalho Chehab 11070c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11080c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11090c0d06caSMauro Carvalho Chehab 111095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 11110c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 11120c0d06caSMauro Carvalho Chehab 11130c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 11140c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 111595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 11160c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 11170c0d06caSMauro Carvalho Chehab } 11180c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 111995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11200c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 11210c0d06caSMauro Carvalho Chehab } 11220c0d06caSMauro Carvalho Chehab 11230c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 112495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11250c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 11260c0d06caSMauro Carvalho Chehab } 11270c0d06caSMauro Carvalho Chehab 11280c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 11290c0d06caSMauro Carvalho Chehab } 11300c0d06caSMauro Carvalho Chehab 113101c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 11320c0d06caSMauro Carvalho Chehab { 1133081b945eSHans Verkuil struct em28xx *dev = priv; 11340c0d06caSMauro Carvalho Chehab 11350c0d06caSMauro Carvalho Chehab /* 1136081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1137081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1138081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1139081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 11400c0d06caSMauro Carvalho Chehab */ 11410c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 11420c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1143081b945eSHans Verkuil dev->mute = ctrl->val; 1144081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11450c0d06caSMauro Carvalho Chehab break; 11460c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1147081b945eSHans Verkuil dev->volume = ctrl->val; 1148081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1149081b945eSHans Verkuil break; 1150081b945eSHans Verkuil } 1151081b945eSHans Verkuil } 1152081b945eSHans Verkuil 1153081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1154081b945eSHans Verkuil { 1155abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1156abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1157abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 11588f8b113aSFrank Schaefer int ret = -EINVAL; 1159081b945eSHans Verkuil 1160081b945eSHans Verkuil switch (ctrl->id) { 1161081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1162081b945eSHans Verkuil dev->mute = ctrl->val; 11638f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1164081b945eSHans Verkuil break; 1165081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1166081b945eSHans Verkuil dev->volume = ctrl->val; 11678f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11688f8b113aSFrank Schaefer break; 11698f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11708f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11718f8b113aSFrank Schaefer break; 11728f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11738f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11748f8b113aSFrank Schaefer break; 11758f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11768f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11778f8b113aSFrank Schaefer break; 11788f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11798f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11808f8b113aSFrank Schaefer break; 11818f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11828f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11838f8b113aSFrank Schaefer break; 11848f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11858f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11860c0d06caSMauro Carvalho Chehab break; 11870c0d06caSMauro Carvalho Chehab } 11880c0d06caSMauro Carvalho Chehab 11898f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 11900c0d06caSMauro Carvalho Chehab } 11910c0d06caSMauro Carvalho Chehab 11928068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1193081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1194081b945eSHans Verkuil }; 1195081b945eSHans Verkuil 11966b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 11970c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 11980c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 11990c0d06caSMauro Carvalho Chehab { 12000c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12010c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12020c0d06caSMauro Carvalho Chehab 12030c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 120481685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 120581685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 12060c0d06caSMauro Carvalho Chehab 12070c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 120881685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 120981685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 12100c0d06caSMauro Carvalho Chehab } 12110c0d06caSMauro Carvalho Chehab 1212b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1213b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1214b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1215b8374138SFrank Schaefer { 1216b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1217b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1218b8374138SFrank Schaefer 1219b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1220b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1221b8374138SFrank Schaefer } 1222b8374138SFrank Schaefer 12230c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 12240c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 12250c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 12260c0d06caSMauro Carvalho Chehab 12270c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 12280c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12290c0d06caSMauro Carvalho Chehab { 12300c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12310c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1232753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12330c0d06caSMauro Carvalho Chehab 1234753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1235753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 123606e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 123706e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1238753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 12390c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12400c0d06caSMauro Carvalho Chehab 12410c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 124258159171SFrank Schaefer if (v4l2->progressive) 12430c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12440c0d06caSMauro Carvalho Chehab else 124558159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 12460c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12470c0d06caSMauro Carvalho Chehab return 0; 12480c0d06caSMauro Carvalho Chehab } 12490c0d06caSMauro Carvalho Chehab 12500c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12510c0d06caSMauro Carvalho Chehab { 12520c0d06caSMauro Carvalho Chehab unsigned int i; 12530c0d06caSMauro Carvalho Chehab 12540c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12550c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12560c0d06caSMauro Carvalho Chehab return &format[i]; 12570c0d06caSMauro Carvalho Chehab 12580c0d06caSMauro Carvalho Chehab return NULL; 12590c0d06caSMauro Carvalho Chehab } 12600c0d06caSMauro Carvalho Chehab 12610c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12620c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12630c0d06caSMauro Carvalho Chehab { 12640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 126658159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12670c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12680c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12690c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12700c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12710c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12720c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12730c0d06caSMauro Carvalho Chehab 12740c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12750c0d06caSMauro Carvalho Chehab if (!fmt) { 12760c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12770c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12780c0d06caSMauro Carvalho Chehab return -EINVAL; 12790c0d06caSMauro Carvalho Chehab } 12800c0d06caSMauro Carvalho Chehab 12810c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12820c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12830c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12840c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1285d3829fadSDevin Heitmueller /* 1286d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1287d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1288d3829fadSDevin Heitmueller * to 50% 1289d3829fadSDevin Heitmueller */ 12900c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 12910c0d06caSMauro Carvalho Chehab width /= 2; 12920c0d06caSMauro Carvalho Chehab } else { 12930c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 12940c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 12950c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 12960c0d06caSMauro Carvalho Chehab 1, 0); 12970c0d06caSMauro Carvalho Chehab } 12980c0d06caSMauro Carvalho Chehab 12996b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 130046f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 13010c0d06caSMauro Carvalho Chehab 13020c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 13030c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 13040c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1305e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 13060c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 13070c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 130858159171SFrank Schaefer if (v4l2->progressive) 13090c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 13100c0d06caSMauro Carvalho Chehab else 131158159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 13120c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 131351dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 13140c0d06caSMauro Carvalho Chehab 13150c0d06caSMauro Carvalho Chehab return 0; 13160c0d06caSMauro Carvalho Chehab } 13170c0d06caSMauro Carvalho Chehab 13180c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 13190c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 13200c0d06caSMauro Carvalho Chehab { 13210c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1322753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 13250c0d06caSMauro Carvalho Chehab if (!fmt) 13260c0d06caSMauro Carvalho Chehab return -EINVAL; 13270c0d06caSMauro Carvalho Chehab 132806e20672SFrank Schaefer v4l2->format = fmt; 1329753aee77SFrank Schaefer v4l2->width = width; 1330753aee77SFrank Schaefer v4l2->height = height; 13310c0d06caSMauro Carvalho Chehab 13320c0d06caSMauro Carvalho Chehab /* set new image size */ 1333753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1334753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13350c0d06caSMauro Carvalho Chehab 13360c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13370c0d06caSMauro Carvalho Chehab 13380c0d06caSMauro Carvalho Chehab return 0; 13390c0d06caSMauro Carvalho Chehab } 13400c0d06caSMauro Carvalho Chehab 13410c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 13420c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13430c0d06caSMauro Carvalho Chehab { 1344d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 13458139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13460c0d06caSMauro Carvalho Chehab 13478139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1348d3829fadSDevin Heitmueller return -EBUSY; 13490c0d06caSMauro Carvalho Chehab 13500c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13510c0d06caSMauro Carvalho Chehab 13520c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13530c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13540c0d06caSMauro Carvalho Chehab } 13550c0d06caSMauro Carvalho Chehab 13560c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13570c0d06caSMauro Carvalho Chehab { 13580c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13590c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13600c0d06caSMauro Carvalho Chehab 136152faaf78SFrank Schaefer *norm = dev->v4l2->norm; 13620c0d06caSMauro Carvalho Chehab 13630c0d06caSMauro Carvalho Chehab return 0; 13640c0d06caSMauro Carvalho Chehab } 13650c0d06caSMauro Carvalho Chehab 13660c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13670c0d06caSMauro Carvalho Chehab { 13680c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13690c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13700c0d06caSMauro Carvalho Chehab 137195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 13720c0d06caSMauro Carvalho Chehab 13730c0d06caSMauro Carvalho Chehab return 0; 13740c0d06caSMauro Carvalho Chehab } 13750c0d06caSMauro Carvalho Chehab 1376314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13770c0d06caSMauro Carvalho Chehab { 13780c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13790c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1380753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13810c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13820c0d06caSMauro Carvalho Chehab 138352faaf78SFrank Schaefer if (norm == v4l2->norm) 1384d8c95c08SHans Verkuil return 0; 13850c0d06caSMauro Carvalho Chehab 13868139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1387d8c95c08SHans Verkuil return -EBUSY; 1388d8c95c08SHans Verkuil 138952faaf78SFrank Schaefer v4l2->norm = norm; 13900c0d06caSMauro Carvalho Chehab 13910c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1392d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1393314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 13940c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 13950c0d06caSMauro Carvalho Chehab 13960c0d06caSMauro Carvalho Chehab /* set new image size */ 1397753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1398753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1399753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1400753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 14010c0d06caSMauro Carvalho Chehab 14020c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 140352faaf78SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, v4l2->norm); 14040c0d06caSMauro Carvalho Chehab 14050c0d06caSMauro Carvalho Chehab return 0; 14060c0d06caSMauro Carvalho Chehab } 14070c0d06caSMauro Carvalho Chehab 14080c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 14090c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14100c0d06caSMauro Carvalho Chehab { 14110c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14120c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 141352faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14140c0d06caSMauro Carvalho Chehab int rc = 0; 14150c0d06caSMauro Carvalho Chehab 141686ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 14170c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 141852faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 14190c0d06caSMauro Carvalho Chehab video, g_parm, p); 14200c0d06caSMauro Carvalho Chehab else 142152faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 14220c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 14230c0d06caSMauro Carvalho Chehab 14240c0d06caSMauro Carvalho Chehab return rc; 14250c0d06caSMauro Carvalho Chehab } 14260c0d06caSMauro Carvalho Chehab 14270c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 14280c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14290c0d06caSMauro Carvalho Chehab { 14300c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14310c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14320c0d06caSMauro Carvalho Chehab 143386ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 143495d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 143595d2608bSFrank Schaefer 0, video, s_parm, p); 14360c0d06caSMauro Carvalho Chehab } 14370c0d06caSMauro Carvalho Chehab 14380c0d06caSMauro Carvalho Chehab static const char *iname[] = { 14390c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 14400c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 14410c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 14420c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 14430c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 14440c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 14450c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 14460c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 14470c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 14480c0d06caSMauro Carvalho Chehab }; 14490c0d06caSMauro Carvalho Chehab 14500c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 14510c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 14520c0d06caSMauro Carvalho Chehab { 14530c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14540c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14550c0d06caSMauro Carvalho Chehab unsigned int n; 14560c0d06caSMauro Carvalho Chehab 14570c0d06caSMauro Carvalho Chehab n = i->index; 14580c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14590c0d06caSMauro Carvalho Chehab return -EINVAL; 14600c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14610c0d06caSMauro Carvalho Chehab return -EINVAL; 14620c0d06caSMauro Carvalho Chehab 14630c0d06caSMauro Carvalho Chehab i->index = n; 14640c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14650c0d06caSMauro Carvalho Chehab 14660c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14670c0d06caSMauro Carvalho Chehab 14680c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14690c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14700c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14710c0d06caSMauro Carvalho Chehab 1472ef74a0b9SFrank Schaefer i->std = dev->v4l2->vdev->tvnorms; 1473d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1474d8c95c08SHans Verkuil if (dev->board.is_webcam) 1475d8c95c08SHans Verkuil i->capabilities = 0; 14760c0d06caSMauro Carvalho Chehab 14770c0d06caSMauro Carvalho Chehab return 0; 14780c0d06caSMauro Carvalho Chehab } 14790c0d06caSMauro Carvalho Chehab 14800c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14810c0d06caSMauro Carvalho Chehab { 14820c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14830c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14840c0d06caSMauro Carvalho Chehab 14850c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14860c0d06caSMauro Carvalho Chehab 14870c0d06caSMauro Carvalho Chehab return 0; 14880c0d06caSMauro Carvalho Chehab } 14890c0d06caSMauro Carvalho Chehab 14900c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 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 if (i >= MAX_EM28XX_INPUT) 14960c0d06caSMauro Carvalho Chehab return -EINVAL; 14970c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14980c0d06caSMauro Carvalho Chehab return -EINVAL; 14990c0d06caSMauro Carvalho Chehab 15000c0d06caSMauro Carvalho Chehab video_mux(dev, i); 15010c0d06caSMauro Carvalho Chehab return 0; 15020c0d06caSMauro Carvalho Chehab } 15030c0d06caSMauro Carvalho Chehab 15040c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 15050c0d06caSMauro Carvalho Chehab { 15060c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15070c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab switch (a->index) { 15100c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 15110c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 15120c0d06caSMauro Carvalho Chehab break; 15130c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 15140c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 15150c0d06caSMauro Carvalho Chehab break; 15160c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 15170c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 15180c0d06caSMauro Carvalho Chehab break; 15190c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 15200c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 15210c0d06caSMauro Carvalho Chehab break; 15220c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 15230c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 15240c0d06caSMauro Carvalho Chehab break; 15250c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 15260c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 15270c0d06caSMauro Carvalho Chehab break; 15280c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 15290c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 15300c0d06caSMauro Carvalho Chehab break; 15310c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 15320c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 15330c0d06caSMauro Carvalho Chehab break; 15340c0d06caSMauro Carvalho Chehab default: 15350c0d06caSMauro Carvalho Chehab return -EINVAL; 15360c0d06caSMauro Carvalho Chehab } 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 15390c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 15400c0d06caSMauro Carvalho Chehab 15410c0d06caSMauro Carvalho Chehab return 0; 15420c0d06caSMauro Carvalho Chehab } 15430c0d06caSMauro Carvalho Chehab 15440e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 15450c0d06caSMauro Carvalho Chehab { 15460c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15470c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15480c0d06caSMauro Carvalho Chehab 15490c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 15500c0d06caSMauro Carvalho Chehab return -EINVAL; 15510c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 15520c0d06caSMauro Carvalho Chehab return -EINVAL; 15530c0d06caSMauro Carvalho Chehab 15540c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15550c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15560c0d06caSMauro Carvalho Chehab 15570c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15580c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15590c0d06caSMauro Carvalho Chehab 15600c0d06caSMauro Carvalho Chehab return 0; 15610c0d06caSMauro Carvalho Chehab } 15620c0d06caSMauro Carvalho Chehab 15630c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15640c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15650c0d06caSMauro Carvalho Chehab { 15660c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15670c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15680c0d06caSMauro Carvalho Chehab 15690c0d06caSMauro Carvalho Chehab if (0 != t->index) 15700c0d06caSMauro Carvalho Chehab return -EINVAL; 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15730c0d06caSMauro Carvalho Chehab 157495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 15750c0d06caSMauro Carvalho Chehab return 0; 15760c0d06caSMauro Carvalho Chehab } 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15792f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15800c0d06caSMauro Carvalho Chehab { 15810c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15820c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15830c0d06caSMauro Carvalho Chehab 15840c0d06caSMauro Carvalho Chehab if (0 != t->index) 15850c0d06caSMauro Carvalho Chehab return -EINVAL; 15860c0d06caSMauro Carvalho Chehab 158795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 15880c0d06caSMauro Carvalho Chehab return 0; 15890c0d06caSMauro Carvalho Chehab } 15900c0d06caSMauro Carvalho Chehab 15910c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15920c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15930c0d06caSMauro Carvalho Chehab { 15940c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15950c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15963854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15970c0d06caSMauro Carvalho Chehab 159820deebfeSHans Verkuil if (0 != f->tuner) 159920deebfeSHans Verkuil return -EINVAL; 160020deebfeSHans Verkuil 16013854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 16020c0d06caSMauro Carvalho Chehab return 0; 16030c0d06caSMauro Carvalho Chehab } 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1606b530a447SHans Verkuil const struct v4l2_frequency *f) 16070c0d06caSMauro Carvalho Chehab { 1608b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 16090c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16100c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 161195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16120c0d06caSMauro Carvalho Chehab 16130c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 16140c0d06caSMauro Carvalho Chehab return -EINVAL; 16150c0d06caSMauro Carvalho Chehab 161695d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 161795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 16183854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 16190c0d06caSMauro Carvalho Chehab 16200c0d06caSMauro Carvalho Chehab return 0; 16210c0d06caSMauro Carvalho Chehab } 16220c0d06caSMauro Carvalho Chehab 1623cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 162496b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 162596b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 16263b2d17b4SHans Verkuil { 16273b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 16283b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 16293b2d17b4SHans Verkuil 16303b2d17b4SHans Verkuil if (chip->match.addr > 1) 16313b2d17b4SHans Verkuil return -EINVAL; 16323b2d17b4SHans Verkuil if (chip->match.addr == 1) 16333b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 16343b2d17b4SHans Verkuil else 163595d2608bSFrank Schaefer strlcpy(chip->name, 163695d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 16373b2d17b4SHans Verkuil return 0; 16383b2d17b4SHans Verkuil } 16393b2d17b4SHans Verkuil 164035deba32SFrank Schaefer static int em28xx_reg_len(int reg) 164135deba32SFrank Schaefer { 164235deba32SFrank Schaefer switch (reg) { 164335deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 164435deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 164535deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 164635deba32SFrank Schaefer return 2; 164735deba32SFrank Schaefer default: 164835deba32SFrank Schaefer return 1; 164935deba32SFrank Schaefer } 165035deba32SFrank Schaefer } 16510c0d06caSMauro Carvalho Chehab 16520c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16530c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16540c0d06caSMauro Carvalho Chehab { 16550c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16560c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16570c0d06caSMauro Carvalho Chehab int ret; 16580c0d06caSMauro Carvalho Chehab 16593b2d17b4SHans Verkuil if (reg->match.addr > 1) 16603b2d17b4SHans Verkuil return -EINVAL; 1661abca2056SHans Verkuil if (reg->match.addr) { 16620c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16630c0d06caSMauro Carvalho Chehab if (ret < 0) 16640c0d06caSMauro Carvalho Chehab return ret; 16650c0d06caSMauro Carvalho Chehab 16660c0d06caSMauro Carvalho Chehab reg->val = ret; 16670c0d06caSMauro Carvalho Chehab reg->size = 1; 16680c0d06caSMauro Carvalho Chehab return 0; 16690c0d06caSMauro Carvalho Chehab } 16700c0d06caSMauro Carvalho Chehab 16710c0d06caSMauro Carvalho Chehab /* Match host */ 16720c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16730c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16740c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16750c0d06caSMauro Carvalho Chehab 16760c0d06caSMauro Carvalho Chehab if (ret < 0) 16770c0d06caSMauro Carvalho Chehab return ret; 16780c0d06caSMauro Carvalho Chehab 16790c0d06caSMauro Carvalho Chehab reg->val = ret; 16800c0d06caSMauro Carvalho Chehab } else { 16810c0d06caSMauro Carvalho Chehab __le16 val = 0; 168201c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16830c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16840c0d06caSMauro Carvalho Chehab if (ret < 0) 16850c0d06caSMauro Carvalho Chehab return ret; 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16880c0d06caSMauro Carvalho Chehab } 16890c0d06caSMauro Carvalho Chehab 16900c0d06caSMauro Carvalho Chehab return 0; 16910c0d06caSMauro Carvalho Chehab } 16920c0d06caSMauro Carvalho Chehab 16930c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1694977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16950c0d06caSMauro Carvalho Chehab { 16960c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16970c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16980c0d06caSMauro Carvalho Chehab __le16 buf; 16990c0d06caSMauro Carvalho Chehab 17003b2d17b4SHans Verkuil if (reg->match.addr > 1) 17013b2d17b4SHans Verkuil return -EINVAL; 1702abca2056SHans Verkuil if (reg->match.addr) 17030c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 17040c0d06caSMauro Carvalho Chehab 17050c0d06caSMauro Carvalho Chehab /* Match host */ 17060c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 17070c0d06caSMauro Carvalho Chehab 17080c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 17090c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 17100c0d06caSMauro Carvalho Chehab } 17110c0d06caSMauro Carvalho Chehab #endif 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab 17140c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 17150c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 17160c0d06caSMauro Carvalho Chehab { 1717a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 17180c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17190c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1720ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17210c0d06caSMauro Carvalho Chehab 17220c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 17230c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 17240c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 17250c0d06caSMauro Carvalho Chehab 1726a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1727a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1728a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1729a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1730a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1731a9d79fe5SHans Verkuil else 17321d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 17330c0d06caSMauro Carvalho Chehab 17340c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1735a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 17360c0d06caSMauro Carvalho Chehab 17370c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1738a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 17390c0d06caSMauro Carvalho Chehab 1740a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1741a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1742ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 17431d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1744ef74a0b9SFrank Schaefer if (v4l2->radio_dev) 1745a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 17460c0d06caSMauro Carvalho Chehab return 0; 17470c0d06caSMauro Carvalho Chehab } 17480c0d06caSMauro Carvalho Chehab 17490c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 17500c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 17510c0d06caSMauro Carvalho Chehab { 17520c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 17530c0d06caSMauro Carvalho Chehab return -EINVAL; 17540c0d06caSMauro Carvalho Chehab 17550c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 17560c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 17570c0d06caSMauro Carvalho Chehab 17580c0d06caSMauro Carvalho Chehab return 0; 17590c0d06caSMauro Carvalho Chehab } 17600c0d06caSMauro Carvalho Chehab 17610c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17620c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17630c0d06caSMauro Carvalho Chehab { 17640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17660c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17670c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17680c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17690c0d06caSMauro Carvalho Chehab 17700c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17710c0d06caSMauro Carvalho Chehab if (!fmt) { 17720c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17730c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17740c0d06caSMauro Carvalho Chehab return -EINVAL; 17750c0d06caSMauro Carvalho Chehab } 17760c0d06caSMauro Carvalho Chehab 17770c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17780c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17790c0d06caSMauro Carvalho Chehab return -EINVAL; 17800c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17810c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17820c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17830c0d06caSMauro Carvalho Chehab return 0; 17840c0d06caSMauro Carvalho Chehab } 17850c0d06caSMauro Carvalho Chehab 17860c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17870c0d06caSMauro Carvalho Chehab return -EINVAL; 17880c0d06caSMauro Carvalho Chehab 17890c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17900c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17916c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17926c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17936c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17940c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17956c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17966c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17970c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17980c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17990c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 18000c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 18010c0d06caSMauro Carvalho Chehab return 0; 18020c0d06caSMauro Carvalho Chehab } 18030c0d06caSMauro Carvalho Chehab 18040c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 18050c0d06caSMauro Carvalho Chehab 18060c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 18070c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 18080c0d06caSMauro Carvalho Chehab { 18090c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18100c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1811753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18120c0d06caSMauro Carvalho Chehab 1813753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 18140c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 18150c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 18160c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 18170c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1818753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1819753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 18202a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 18210c0d06caSMauro Carvalho Chehab 18220c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 182352faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 18240c0d06caSMauro Carvalho Chehab /* NTSC */ 18250c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 18260c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 182752faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 18280c0d06caSMauro Carvalho Chehab /* PAL */ 18290c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 18300c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 18310c0d06caSMauro Carvalho Chehab } 18320c0d06caSMauro Carvalho Chehab 18330c0d06caSMauro Carvalho Chehab return 0; 18340c0d06caSMauro Carvalho Chehab } 18350c0d06caSMauro Carvalho Chehab 18360c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18370c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 18380c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18390c0d06caSMauro Carvalho Chehab 18400c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 18410c0d06caSMauro Carvalho Chehab 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 (unlikely(t->index > 0)) 18460c0d06caSMauro Carvalho Chehab return -EINVAL; 18470c0d06caSMauro Carvalho Chehab 18480c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 18490c0d06caSMauro Carvalho Chehab 185095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab return 0; 18530c0d06caSMauro Carvalho Chehab } 18540c0d06caSMauro Carvalho Chehab 18550c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18562f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18570c0d06caSMauro Carvalho Chehab { 18580c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18590c0d06caSMauro Carvalho Chehab 18600c0d06caSMauro Carvalho Chehab if (0 != t->index) 18610c0d06caSMauro Carvalho Chehab return -EINVAL; 18620c0d06caSMauro Carvalho Chehab 186395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18640c0d06caSMauro Carvalho Chehab 18650c0d06caSMauro Carvalho Chehab return 0; 18660c0d06caSMauro Carvalho Chehab } 18670c0d06caSMauro Carvalho Chehab 18680c0d06caSMauro Carvalho Chehab /* 186995d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 187095d2608bSFrank Schaefer * 187195d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 187295d2608bSFrank Schaefer * 187395d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 187495d2608bSFrank Schaefer */ 187595d2608bSFrank Schaefer void em28xx_free_v4l2(struct kref *ref) 187695d2608bSFrank Schaefer { 187795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 187895d2608bSFrank Schaefer 1879abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 188095d2608bSFrank Schaefer kfree(v4l2); 188195d2608bSFrank Schaefer } 188295d2608bSFrank Schaefer 188395d2608bSFrank Schaefer /* 18840c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18850c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18860c0d06caSMauro Carvalho Chehab */ 18870c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18880c0d06caSMauro Carvalho Chehab { 18890c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18900c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 189195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18920c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18930c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 18940c0d06caSMauro Carvalho Chehab 18950c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18960c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18970c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18980c0d06caSMauro Carvalho Chehab break; 18990c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 19000c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 19010c0d06caSMauro Carvalho Chehab break; 19024e170240SFrank Schaefer case VFL_TYPE_RADIO: 19034e170240SFrank Schaefer break; 19044e170240SFrank Schaefer default: 19054e170240SFrank Schaefer return -EINVAL; 19060c0d06caSMauro Carvalho Chehab } 19070c0d06caSMauro Carvalho Chehab 19080c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 19090c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 19108139a4d5SFrank Schaefer v4l2->users); 19110c0d06caSMauro Carvalho Chehab 19120c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19130c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19140c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 19150c0d06caSMauro Carvalho Chehab if (!fh) { 19160c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 19170c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19180c0d06caSMauro Carvalho Chehab return -ENOMEM; 19190c0d06caSMauro Carvalho Chehab } 192069a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 19210c0d06caSMauro Carvalho Chehab fh->dev = dev; 19220c0d06caSMauro Carvalho Chehab fh->type = fh_type; 19230c0d06caSMauro Carvalho Chehab filp->private_data = fh; 19240c0d06caSMauro Carvalho Chehab 19258139a4d5SFrank Schaefer if (v4l2->users == 0) { 19260c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 19274e170240SFrank Schaefer 19284e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 19290c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 19300c0d06caSMauro Carvalho Chehab 19314e170240SFrank Schaefer /* 19324e170240SFrank Schaefer * Needed, since GPIO might have disabled power 19334e170240SFrank Schaefer * of some i2c devices 19340c0d06caSMauro Carvalho Chehab */ 19350c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 19360c0d06caSMauro Carvalho Chehab } 1937d3829fadSDevin Heitmueller 1938d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 19390c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 194095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 19410c0d06caSMauro Carvalho Chehab } 19420c0d06caSMauro Carvalho Chehab 194347677e51SMauro Carvalho Chehab kref_get(&dev->ref); 194495d2608bSFrank Schaefer kref_get(&v4l2->ref); 19458139a4d5SFrank Schaefer v4l2->users++; 19460c0d06caSMauro Carvalho Chehab 19470c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 194869a61642SHans Verkuil v4l2_fh_add(&fh->fh); 19490c0d06caSMauro Carvalho Chehab 1950d3829fadSDevin Heitmueller return 0; 19510c0d06caSMauro Carvalho Chehab } 19520c0d06caSMauro Carvalho Chehab 19530c0d06caSMauro Carvalho Chehab /* 195401c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 19550c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 19560c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 19570c0d06caSMauro Carvalho Chehab */ 195801c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 19590c0d06caSMauro Carvalho Chehab { 196095d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 196195d2608bSFrank Schaefer 1962822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 1963822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 1964822b8deaSMauro Carvalho Chehab return 0; 1965822b8deaSMauro Carvalho Chehab } 1966822b8deaSMauro Carvalho Chehab 196701c28193SMauro Carvalho Chehab if (!dev->has_video) { 196801c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 196901c28193SMauro Carvalho Chehab return 0; 197001c28193SMauro Carvalho Chehab } 19710c0d06caSMauro Carvalho Chehab 197295d2608bSFrank Schaefer if (v4l2 == NULL) 197395d2608bSFrank Schaefer return 0; 197495d2608bSFrank Schaefer 1975aa929ad7SMauro Carvalho Chehab em28xx_info("Closing video extension"); 1976aa929ad7SMauro Carvalho Chehab 1977ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 1978ebbfbc20SMauro Carvalho Chehab 197995d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 19805ad10de6SFrank Schaefer 198123e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 198223e8642cSFrank Schaefer 1983ef74a0b9SFrank Schaefer if (v4l2->radio_dev) { 1984e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 1985ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 1986ef74a0b9SFrank Schaefer video_unregister_device(v4l2->radio_dev); 19870c0d06caSMauro Carvalho Chehab } 1988ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) { 19890c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1990ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 1991ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vbi_dev); 19920c0d06caSMauro Carvalho Chehab } 1993ef74a0b9SFrank Schaefer if (v4l2->vdev) { 19940c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1995ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 1996ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vdev); 19970c0d06caSMauro Carvalho Chehab } 199801c28193SMauro Carvalho Chehab 1999abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 200095d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2001103f18a2SFrank Schaefer 20022c52a2fcSFrank Schaefer if (v4l2->clk) { 20032c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 20042c52a2fcSFrank Schaefer v4l2->clk = NULL; 200525dd1652SFrank Schaefer } 200625dd1652SFrank Schaefer 200795d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 200895d2608bSFrank Schaefer 2009ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 201095d2608bSFrank Schaefer 201147677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 20125ad10de6SFrank Schaefer 201301c28193SMauro Carvalho Chehab return 0; 20140c0d06caSMauro Carvalho Chehab } 20150c0d06caSMauro Carvalho Chehab 2016a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2017a61f6811SShuah Khan { 2018a61f6811SShuah Khan if (dev->is_audio_only) 2019a61f6811SShuah Khan return 0; 2020a61f6811SShuah Khan 2021a61f6811SShuah Khan if (!dev->has_video) 2022a61f6811SShuah Khan return 0; 2023a61f6811SShuah Khan 2024a61f6811SShuah Khan em28xx_info("Suspending video extension"); 2025a61f6811SShuah Khan em28xx_stop_urbs(dev); 2026a61f6811SShuah Khan return 0; 2027a61f6811SShuah Khan } 2028a61f6811SShuah Khan 2029a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2030a61f6811SShuah Khan { 2031a61f6811SShuah Khan if (dev->is_audio_only) 2032a61f6811SShuah Khan return 0; 2033a61f6811SShuah Khan 2034a61f6811SShuah Khan if (!dev->has_video) 2035a61f6811SShuah Khan return 0; 2036a61f6811SShuah Khan 2037a61f6811SShuah Khan em28xx_info("Resuming video extension"); 2038a61f6811SShuah Khan /* what do we do here */ 2039a61f6811SShuah Khan return 0; 2040a61f6811SShuah Khan } 2041a61f6811SShuah Khan 20420c0d06caSMauro Carvalho Chehab /* 20430c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 20440c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 20450c0d06caSMauro Carvalho Chehab * calls and ioctls 20460c0d06caSMauro Carvalho Chehab */ 20470c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 20480c0d06caSMauro Carvalho Chehab { 20490c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 20500c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 205195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20520c0d06caSMauro Carvalho Chehab int errCode; 20530c0d06caSMauro Carvalho Chehab 20548139a4d5SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 20550c0d06caSMauro Carvalho Chehab 2056d3829fadSDevin Heitmueller vb2_fop_release(filp); 205798c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 20580c0d06caSMauro Carvalho Chehab 20598139a4d5SFrank Schaefer if (v4l2->users == 1) { 206047677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 206147677e51SMauro Carvalho Chehab if (dev->disconnected) 206201c28193SMauro Carvalho Chehab goto exit; 20630c0d06caSMauro Carvalho Chehab 20640c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 206595d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 20660c0d06caSMauro Carvalho Chehab 20670c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 20680c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 20690c0d06caSMauro Carvalho Chehab 20700c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 20710c0d06caSMauro Carvalho Chehab dev->alt = 0; 20720c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 20730c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 20740c0d06caSMauro Carvalho Chehab if (errCode < 0) { 20750c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 20760c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 20770c0d06caSMauro Carvalho Chehab } 20780c0d06caSMauro Carvalho Chehab } 20790c0d06caSMauro Carvalho Chehab 208001c28193SMauro Carvalho Chehab exit: 20818139a4d5SFrank Schaefer v4l2->users--; 208295d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 20830c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 208447677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 208547677e51SMauro Carvalho Chehab 20860c0d06caSMauro Carvalho Chehab return 0; 20870c0d06caSMauro Carvalho Chehab } 20880c0d06caSMauro Carvalho Chehab 20890c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 20900c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20910c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20920c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2093d3829fadSDevin Heitmueller .read = vb2_fop_read, 2094d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2095d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 20960c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20970c0d06caSMauro Carvalho Chehab }; 20980c0d06caSMauro Carvalho Chehab 20990c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 21000c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 21010c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 21020c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 21030c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 21040c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 21050c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 21062a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2107aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 21080c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 21090c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 21100c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 21110c0d06caSMauro Carvalho Chehab 2112d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2113d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2114d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2115d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2116d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2117d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2118d3829fadSDevin Heitmueller 21190c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 21200c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 21210c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 21220c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 21230c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 21240c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 21250c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 21260c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2127d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2128d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 21290c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 21300c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 21310c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21320c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 213350fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 213450fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21350c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 213696b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 21370c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21380c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21390c0d06caSMauro Carvalho Chehab #endif 21400c0d06caSMauro Carvalho Chehab }; 21410c0d06caSMauro Carvalho Chehab 21420c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 21430c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 21440c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2145ef74a0b9SFrank Schaefer .release = video_device_release, 21460c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 21470c0d06caSMauro Carvalho Chehab }; 21480c0d06caSMauro Carvalho Chehab 21490c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 21500c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 21510c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 21520c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 21530c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 21540c0d06caSMauro Carvalho Chehab }; 21550c0d06caSMauro Carvalho Chehab 21560c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2157a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 21580c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 21590c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 21600c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21610c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 216250fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 216350fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21640c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2165430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 21660c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21670c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21680c0d06caSMauro Carvalho Chehab #endif 21690c0d06caSMauro Carvalho Chehab }; 21700c0d06caSMauro Carvalho Chehab 21710c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 21720c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 21730c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2174ef74a0b9SFrank Schaefer .release = video_device_release, 21750c0d06caSMauro Carvalho Chehab }; 21760c0d06caSMauro Carvalho Chehab 2177b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2178b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2179b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2180b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2181b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2182b64f8e9aSMauro Carvalho Chehab 2183b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2184b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2185b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2186b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2187b64f8e9aSMauro Carvalho Chehab }; 2188b64f8e9aSMauro Carvalho Chehab 2189b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2190b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2191b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2192b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2193b64f8e9aSMauro Carvalho Chehab }; 2194b64f8e9aSMauro Carvalho Chehab 21950c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 21960c0d06caSMauro Carvalho Chehab 21970c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 21980c0d06caSMauro Carvalho Chehab const struct video_device *template, 21990c0d06caSMauro Carvalho Chehab const char *type_name) 22000c0d06caSMauro Carvalho Chehab { 22010c0d06caSMauro Carvalho Chehab struct video_device *vfd; 22020c0d06caSMauro Carvalho Chehab 22030c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 22040c0d06caSMauro Carvalho Chehab if (NULL == vfd) 22050c0d06caSMauro Carvalho Chehab return NULL; 22060c0d06caSMauro Carvalho Chehab 22070c0d06caSMauro Carvalho Chehab *vfd = *template; 220895d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 22090c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 22100c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 221169a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 2212d8c95c08SHans Verkuil if (dev->board.is_webcam) 2213d8c95c08SHans Verkuil vfd->tvnorms = 0; 22140c0d06caSMauro Carvalho Chehab 22150c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 22160c0d06caSMauro Carvalho Chehab dev->name, type_name); 22170c0d06caSMauro Carvalho Chehab 22180c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 22190c0d06caSMauro Carvalho Chehab return vfd; 22200c0d06caSMauro Carvalho Chehab } 22210c0d06caSMauro Carvalho Chehab 22223319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 22230560f337SMauro Carvalho Chehab { 22243854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 22253854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 22260560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 22270560f337SMauro Carvalho Chehab struct v4l2_frequency f; 22280560f337SMauro Carvalho Chehab 22290560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 22300560f337SMauro Carvalho Chehab 22310560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 22320560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 22330560f337SMauro Carvalho Chehab 22340560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 22350560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 22360560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 22370560f337SMauro Carvalho Chehab 223895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 223995d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22400560f337SMauro Carvalho Chehab } 22410560f337SMauro Carvalho Chehab 22420560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 22430560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 22443319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 22450560f337SMauro Carvalho Chehab 224695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 224795d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22480560f337SMauro Carvalho Chehab } 22490560f337SMauro Carvalho Chehab 22506867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 22510560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 22520560f337SMauro Carvalho Chehab 22530560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 22546867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 22550560f337SMauro Carvalho Chehab 225695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 225795d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 22580560f337SMauro Carvalho Chehab } 22590560f337SMauro Carvalho Chehab 22600560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 22610560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 22620560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 22630560f337SMauro Carvalho Chehab 22640560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 22650560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 22660560f337SMauro Carvalho Chehab 22670560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 22680560f337SMauro Carvalho Chehab 22690560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 22700560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 22710560f337SMauro Carvalho Chehab 227295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 22730560f337SMauro Carvalho Chehab } 22740560f337SMauro Carvalho Chehab 22750560f337SMauro Carvalho Chehab /* configure tuner */ 22760560f337SMauro Carvalho Chehab f.tuner = 0; 22770560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 22780560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 22793854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 228095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 22810560f337SMauro Carvalho Chehab } 22820560f337SMauro Carvalho Chehab 228301c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 22840c0d06caSMauro Carvalho Chehab { 22850c0d06caSMauro Carvalho Chehab u8 val; 22860c0d06caSMauro Carvalho Chehab int ret; 22870c0d06caSMauro Carvalho Chehab unsigned int maxw; 2288abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 228995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2290b64f8e9aSMauro Carvalho Chehab 2291822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2292822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2293822b8deaSMauro Carvalho Chehab return 0; 2294822b8deaSMauro Carvalho Chehab } 2295822b8deaSMauro Carvalho Chehab 229601c28193SMauro Carvalho Chehab if (!dev->has_video) { 2297b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2298b64f8e9aSMauro Carvalho Chehab return 0; 2299b64f8e9aSMauro Carvalho Chehab } 23000c0d06caSMauro Carvalho Chehab 23019634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 23020c0d06caSMauro Carvalho Chehab 230301c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 230401c28193SMauro Carvalho Chehab 230595d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 230695d2608bSFrank Schaefer if (v4l2 == NULL) { 230795d2608bSFrank Schaefer em28xx_info("em28xx_v4l: memory allocation failed\n"); 230895d2608bSFrank Schaefer mutex_unlock(&dev->lock); 230995d2608bSFrank Schaefer return -ENOMEM; 231095d2608bSFrank Schaefer } 231195d2608bSFrank Schaefer kref_init(&v4l2->ref); 2312abc1308fSFrank Schaefer v4l2->dev = dev; 231395d2608bSFrank Schaefer dev->v4l2 = v4l2; 231495d2608bSFrank Schaefer 231595d2608bSFrank Schaefer ret = v4l2_device_register(&dev->udev->dev, &v4l2->v4l2_dev); 2316b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2317b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2318b64f8e9aSMauro Carvalho Chehab goto err; 2319b64f8e9aSMauro Carvalho Chehab } 2320b64f8e9aSMauro Carvalho Chehab 2321abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2322b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 232395d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2324b64f8e9aSMauro Carvalho Chehab 232558159171SFrank Schaefer if (dev->board.is_webcam) 232658159171SFrank Schaefer v4l2->progressive = 1; 232758159171SFrank Schaefer 2328b64f8e9aSMauro Carvalho Chehab /* 2329b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2330b64f8e9aSMauro Carvalho Chehab */ 23319297285eSFrank Schaefer v4l2->vinmode = 0x10; 23329297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2333b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2334b64f8e9aSMauro Carvalho Chehab 2335b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2336b64f8e9aSMauro Carvalho Chehab 2337b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 233895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 233995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2340b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2341b64f8e9aSMauro Carvalho Chehab 2342b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 234395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2345b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2346b64f8e9aSMauro Carvalho Chehab 2347b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 234895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2350b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2351b64f8e9aSMauro Carvalho Chehab 2352b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 235395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 235495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2355b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2356b64f8e9aSMauro Carvalho Chehab 2357b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2358b64f8e9aSMauro Carvalho Chehab 2359b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 23603319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 23616867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2362b64f8e9aSMauro Carvalho Chehab 2363b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 236495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 236595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2366b64f8e9aSMauro Carvalho Chehab "tuner", dev->board.radio_addr, NULL); 2367b64f8e9aSMauro Carvalho Chehab 2368b64f8e9aSMauro Carvalho Chehab if (has_demod) 236995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2370b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2371b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 23723319e6f8SFrank Schaefer if (tuner_addr == 0) { 2373b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2374b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2375b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2376b64f8e9aSMauro Carvalho Chehab 237795d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2378b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2379b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(type)); 2380b64f8e9aSMauro Carvalho Chehab 2381b64f8e9aSMauro Carvalho Chehab if (sd) 23823319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2383b64f8e9aSMauro Carvalho Chehab } else { 238495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 238595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 23863319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2387b64f8e9aSMauro Carvalho Chehab } 2388b64f8e9aSMauro Carvalho Chehab 23893319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 23903319e6f8SFrank Schaefer } 23913319e6f8SFrank Schaefer 2392d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2393b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2394b64f8e9aSMauro Carvalho Chehab 2395b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2396b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2397b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2398b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2399b64f8e9aSMauro Carvalho Chehab __func__, ret); 2400b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2401b64f8e9aSMauro Carvalho Chehab } 2402b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2403b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2404b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2405b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2406b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2407b64f8e9aSMauro Carvalho Chehab } else { 2408b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2409b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2410b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2411b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2412b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2413b64f8e9aSMauro Carvalho Chehab } 2414b64f8e9aSMauro Carvalho Chehab 2415b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2416b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2417b64f8e9aSMauro Carvalho Chehab 2418b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2419b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2420b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2421b64f8e9aSMauro Carvalho Chehab 2422b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2423b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2424b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2425b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2426b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2427b64f8e9aSMauro Carvalho Chehab __func__, ret); 2428b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2429b64f8e9aSMauro Carvalho Chehab } 2430b64f8e9aSMauro Carvalho Chehab msleep(3); 2431b64f8e9aSMauro Carvalho Chehab 2432b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2433b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2434b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2435b64f8e9aSMauro Carvalho Chehab __func__, ret); 2436b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2437b64f8e9aSMauro Carvalho Chehab } 2438b64f8e9aSMauro Carvalho Chehab msleep(3); 2439b64f8e9aSMauro Carvalho Chehab } 2440b64f8e9aSMauro Carvalho Chehab 24410c0d06caSMauro Carvalho Chehab /* set default norm */ 244252faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 244352faaf78SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, v4l2->norm); 244458159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 24450c0d06caSMauro Carvalho Chehab 24460c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 244706e20672SFrank Schaefer v4l2->format = &format[0]; 24480c0d06caSMauro Carvalho Chehab 24490c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 24500c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 24510c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 24520c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 24530c0d06caSMauro Carvalho Chehab maxw /= 2; 24540c0d06caSMauro Carvalho Chehab 24550c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 24560c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 24570c0d06caSMauro Carvalho Chehab 24580c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 24590c0d06caSMauro Carvalho Chehab 24600c0d06caSMauro Carvalho Chehab /* Audio defaults */ 24610c0d06caSMauro Carvalho Chehab dev->mute = 1; 24620c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 24630c0d06caSMauro Carvalho Chehab 24640c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 24650c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 24660c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 24670c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 24680c0d06caSMauro Carvalho Chehab 24690c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 24700c0d06caSMauro Carvalho Chehab 24718f8b113aSFrank Schaefer /* Add image controls */ 24728f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 24738f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2474ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2475ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24768f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 24778f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2478ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2479ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24808f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 24818f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2482ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2483ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24848f8b113aSFrank Schaefer V4L2_CID_SATURATION, 24858f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2486ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2487ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24888f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 24898f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2490ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2491ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24928f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 24938f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2494ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2495ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24968f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 24978f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 24988f8b113aSFrank Schaefer 24998f8b113aSFrank Schaefer /* Reset image controls */ 25008f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2501ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2502ad298055SFrank Schaefer ret = hdl->error; 2503b64f8e9aSMauro Carvalho Chehab if (ret) 2504b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25058f8b113aSFrank Schaefer 25060c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2507ef74a0b9SFrank Schaefer v4l2->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 2508ef74a0b9SFrank Schaefer if (!v4l2->vdev) { 25090c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2510b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2511b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25120c0d06caSMauro Carvalho Chehab } 251327a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 251427a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 251527a36df6SFrank Schaefer v4l2->vdev->queue = &v4l2->vb_vidq; 251627a36df6SFrank Schaefer v4l2->vdev->queue->lock = &v4l2->vb_queue_lock; 25170c0d06caSMauro Carvalho Chehab 25186e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 25196e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2520ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_QUERYSTD); 2521ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_STD); 2522ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_STD); 25233bc85cceSFrank Schaefer } else { 2524ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 25256e46dabaSFrank Schaefer } 252666df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2527ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_TUNER); 2528ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_TUNER); 2529ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_FREQUENCY); 2530ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_FREQUENCY); 253166df67b7SFrank Schaefer } 2532c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2533ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_AUDIO); 2534ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_AUDIO); 2535c2dcef83SFrank Schaefer } 25366e46dabaSFrank Schaefer 25370c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2538ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vdev, VFL_TYPE_GRABBER, 25390c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 25400c0d06caSMauro Carvalho Chehab if (ret) { 25410c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 25420c0d06caSMauro Carvalho Chehab ret); 2543b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25440c0d06caSMauro Carvalho Chehab } 25450c0d06caSMauro Carvalho Chehab 25460c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 25470c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2548ef74a0b9SFrank Schaefer v4l2->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 25490c0d06caSMauro Carvalho Chehab "vbi"); 25500c0d06caSMauro Carvalho Chehab 255127a36df6SFrank Schaefer v4l2->vbi_dev->queue = &v4l2->vb_vbiq; 255227a36df6SFrank Schaefer v4l2->vbi_dev->queue->lock = &v4l2->vb_vbi_queue_lock; 2553d3829fadSDevin Heitmueller 255466df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2555ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 255666df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2557ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_TUNER); 2558ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_TUNER); 2559ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2560ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 256166df67b7SFrank Schaefer } 2562c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2563ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_AUDIO); 2564ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_AUDIO); 2565c2dcef83SFrank Schaefer } 256666df67b7SFrank Schaefer 25670c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2568ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vbi_dev, VFL_TYPE_VBI, 25690c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 25700c0d06caSMauro Carvalho Chehab if (ret < 0) { 25710c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2572b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25730c0d06caSMauro Carvalho Chehab } 25740c0d06caSMauro Carvalho Chehab } 25750c0d06caSMauro Carvalho Chehab 25760c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2577ef74a0b9SFrank Schaefer v4l2->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 25780c0d06caSMauro Carvalho Chehab "radio"); 2579ef74a0b9SFrank Schaefer if (!v4l2->radio_dev) { 25800c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2581b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2582b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25830c0d06caSMauro Carvalho Chehab } 2584ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->radio_dev, VFL_TYPE_RADIO, 25850c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 25860c0d06caSMauro Carvalho Chehab if (ret < 0) { 25870c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2588b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25890c0d06caSMauro Carvalho Chehab } 25900c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 2591ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 25920c0d06caSMauro Carvalho Chehab } 25930c0d06caSMauro Carvalho Chehab 25940c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 2595ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 25960c0d06caSMauro Carvalho Chehab 2597ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 25980c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 2599ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 26000c0d06caSMauro Carvalho Chehab 2601b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 260295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2603b64f8e9aSMauro Carvalho Chehab 2604b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2605b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2606b64f8e9aSMauro Carvalho Chehab 26079634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 26089634614fSMauro Carvalho Chehab 260947677e51SMauro Carvalho Chehab kref_get(&dev->ref); 261047677e51SMauro Carvalho Chehab 261101c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 26120c0d06caSMauro Carvalho Chehab return 0; 2613b64f8e9aSMauro Carvalho Chehab 2614b64f8e9aSMauro Carvalho Chehab unregister_dev: 2615abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 261695d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2617b64f8e9aSMauro Carvalho Chehab err: 261895d2608bSFrank Schaefer dev->v4l2 = NULL; 261995d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 262001c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2621b64f8e9aSMauro Carvalho Chehab return ret; 26220c0d06caSMauro Carvalho Chehab } 262301c28193SMauro Carvalho Chehab 262401c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 262501c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 262601c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 262701c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 262801c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2629a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2630a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 263101c28193SMauro Carvalho Chehab }; 263201c28193SMauro Carvalho Chehab 263301c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 263401c28193SMauro Carvalho Chehab { 263501c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 263601c28193SMauro Carvalho Chehab } 263701c28193SMauro Carvalho Chehab 263801c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 263901c28193SMauro Carvalho Chehab { 264001c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 264101c28193SMauro Carvalho Chehab } 264201c28193SMauro Carvalho Chehab 264301c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 264401c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2645