10c0d06caSMauro Carvalho Chehab /* 20c0d06caSMauro Carvalho Chehab em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB 30c0d06caSMauro Carvalho Chehab video capture devices 40c0d06caSMauro Carvalho Chehab 50c0d06caSMauro Carvalho Chehab Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> 60c0d06caSMauro Carvalho Chehab Markus Rechberger <mrechberger@gmail.com> 70c0d06caSMauro Carvalho Chehab Mauro Carvalho Chehab <mchehab@infradead.org> 80c0d06caSMauro Carvalho Chehab Sascha Sommer <saschasommer@freenet.de> 90fa4a402SFrank Schaefer Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com> 100c0d06caSMauro Carvalho Chehab 110c0d06caSMauro Carvalho Chehab Some parts based on SN9C10x PC Camera Controllers GPL driver made 120c0d06caSMauro Carvalho Chehab by Luca Risolia <luca.risolia@studio.unibo.it> 130c0d06caSMauro Carvalho Chehab 140c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 150c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 160c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 170c0d06caSMauro Carvalho Chehab (at your option) any later version. 180c0d06caSMauro Carvalho Chehab 190c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 200c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 210c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 220c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 230c0d06caSMauro Carvalho Chehab 240c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 250c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 260c0d06caSMauro Carvalho Chehab Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 270c0d06caSMauro Carvalho Chehab */ 280c0d06caSMauro Carvalho Chehab 290c0d06caSMauro Carvalho Chehab #include <linux/init.h> 300c0d06caSMauro Carvalho Chehab #include <linux/list.h> 310c0d06caSMauro Carvalho Chehab #include <linux/module.h> 320c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 330c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 340c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 350c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 360c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 370c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 380c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 390c0d06caSMauro Carvalho Chehab 400c0d06caSMauro Carvalho Chehab #include "em28xx.h" 4101c28193SMauro Carvalho Chehab #include "em28xx-v4l.h" 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 430c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4450fdf40fSHans Verkuil #include <media/v4l2-event.h> 4525dd1652SFrank Schaefer #include <media/v4l2-clk.h> 460c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 470c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 480c0d06caSMauro Carvalho Chehab 490c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 500c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 510c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 520c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 530c0d06caSMauro Carvalho Chehab 540560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 550560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 560560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 570560f337SMauro Carvalho Chehab 580560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 590560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 600560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 610560f337SMauro Carvalho Chehab 620560f337SMauro Carvalho Chehab static int alt; 630560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 640560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 650560f337SMauro Carvalho Chehab 660c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 670c0d06caSMauro Carvalho Chehab if (video_debug) \ 680c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 690c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 700c0d06caSMauro Carvalho Chehab 710c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 720c0d06caSMauro Carvalho Chehab do {\ 730c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 740c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 750c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 760c0d06caSMauro Carvalho Chehab } \ 770c0d06caSMauro Carvalho Chehab } while (0) 780c0d06caSMauro Carvalho Chehab 790c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 80d8992b09SMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC " - v4l2 interface"); 810c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 820c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 830c0d06caSMauro Carvalho Chehab 84e507e0e5SFrank Schaefer 85e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 86e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 87e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 88e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 89e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 90e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 91e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 92e507e0e5SFrank Schaefer 93e507e0e5SFrank Schaefer 94d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 95d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 96d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 970c0d06caSMauro Carvalho Chehab 980c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 990c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 1000c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 1010c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 1020c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 1030c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 1040c0d06caSMauro Carvalho Chehab 1050c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1060c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1070c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1080c0d06caSMauro Carvalho Chehab 1090c0d06caSMauro Carvalho Chehab /* supported video standards */ 1100c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1110c0d06caSMauro Carvalho Chehab { 1120c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1130c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1140c0d06caSMauro Carvalho Chehab .depth = 16, 1150c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1160c0d06caSMauro Carvalho Chehab }, { 1170c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1180c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1190c0d06caSMauro Carvalho Chehab .depth = 16, 1200c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1210c0d06caSMauro Carvalho Chehab }, { 1220c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1230c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1240c0d06caSMauro Carvalho Chehab .depth = 8, 1250c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1260c0d06caSMauro Carvalho Chehab }, { 1270c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1280c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1290c0d06caSMauro Carvalho Chehab .depth = 8, 1300c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1310c0d06caSMauro Carvalho Chehab }, { 1320c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1330c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1340c0d06caSMauro Carvalho Chehab .depth = 8, 1350c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1360c0d06caSMauro Carvalho Chehab }, { 1370c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1380c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1390c0d06caSMauro Carvalho Chehab .depth = 12, 1400c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1410c0d06caSMauro Carvalho Chehab }, 1420c0d06caSMauro Carvalho Chehab }; 1430c0d06caSMauro Carvalho Chehab 14425c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 14525c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 14625c61e4cSFrank Schaefer { 14725c61e4cSFrank Schaefer if (dev->board.is_webcam) 14825c61e4cSFrank Schaefer return dev->sensor_xres; 14925c61e4cSFrank Schaefer 15025c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15125c61e4cSFrank Schaefer return 640; 15225c61e4cSFrank Schaefer 15325c61e4cSFrank Schaefer return 720; 15425c61e4cSFrank Schaefer } 15525c61e4cSFrank Schaefer 15625c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 15725c61e4cSFrank Schaefer { 15852faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15952faaf78SFrank Schaefer 16025c61e4cSFrank Schaefer if (dev->board.is_webcam) 16125c61e4cSFrank Schaefer return dev->sensor_yres; 16225c61e4cSFrank Schaefer 16325c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16425c61e4cSFrank Schaefer return 480; 16525c61e4cSFrank Schaefer 16652faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 16725c61e4cSFrank Schaefer } 16825c61e4cSFrank Schaefer 16901c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1700560f337SMauro Carvalho Chehab { 1710560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1720560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1730560f337SMauro Carvalho Chehab return 0; 1740560f337SMauro Carvalho Chehab 1750560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1760560f337SMauro Carvalho Chehab return 0; 1770560f337SMauro Carvalho Chehab 1780560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1790560f337SMauro Carvalho Chehab 1800560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1810560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1820560f337SMauro Carvalho Chehab return 1; 1830560f337SMauro Carvalho Chehab 1840560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1850560f337SMauro Carvalho Chehab return 0; 1860560f337SMauro Carvalho Chehab } 1870560f337SMauro Carvalho Chehab 1880560f337SMauro Carvalho Chehab /* 1890560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1900560f337SMauro Carvalho Chehab * configure i2c attached devices 1910560f337SMauro Carvalho Chehab */ 19201c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1930560f337SMauro Carvalho Chehab { 19495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 19595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1970560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 19895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_stream, 0); 1990560f337SMauro Carvalho Chehab } 2000560f337SMauro Carvalho Chehab 20101c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2020560f337SMauro Carvalho Chehab { 2030560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2090560f337SMauro Carvalho Chehab 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2160560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2170560f337SMauro Carvalho Chehab } 2180560f337SMauro Carvalho Chehab 21901c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2200560f337SMauro Carvalho Chehab { 2210560f337SMauro Carvalho Chehab int ret; 2220560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 223753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2240560f337SMauro Carvalho Chehab 22506e20672SFrank Schaefer fmt = v4l2->format->reg; 2260560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2270560f337SMauro Carvalho Chehab fmt |= 0x20; 2280560f337SMauro Carvalho Chehab /* 2290560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2300560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2310560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2320560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2330560f337SMauro Carvalho Chehab * 2340560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2350560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2360560f337SMauro Carvalho Chehab */ 2370560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2380560f337SMauro Carvalho Chehab if (ret < 0) 2390560f337SMauro Carvalho Chehab return ret; 2400560f337SMauro Carvalho Chehab 2419297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2420560f337SMauro Carvalho Chehab if (ret < 0) 2430560f337SMauro Carvalho Chehab return ret; 2440560f337SMauro Carvalho Chehab 2459297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2460560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2470560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2480560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 249753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 250753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2520560f337SMauro Carvalho Chehab /* NTSC */ 2530560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25452faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2550560f337SMauro Carvalho Chehab /* PAL */ 2560560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2570560f337SMauro Carvalho Chehab } 2580560f337SMauro Carvalho Chehab } 2590560f337SMauro Carvalho Chehab 2600560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2610560f337SMauro Carvalho Chehab } 2620560f337SMauro Carvalho Chehab 2630560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2640560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2650560f337SMauro Carvalho Chehab { 2660560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2670560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2680560f337SMauro Carvalho Chehab 2690560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2700560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2720560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2730560f337SMauro Carvalho Chehab } 2740560f337SMauro Carvalho Chehab 2750560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2760560f337SMauro Carvalho Chehab u16 width, u16 height) 2770560f337SMauro Carvalho Chehab { 2780560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2790560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2800560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2810560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2820560f337SMauro Carvalho Chehab 2830560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2840560f337SMauro Carvalho Chehab hstart, vstart, 2850560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2860560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2870560f337SMauro Carvalho Chehab 2880560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2930560f337SMauro Carvalho Chehab 2940560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2950560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2960560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2970560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2990560f337SMauro Carvalho Chehab } 3000560f337SMauro Carvalho Chehab } 3010560f337SMauro Carvalho Chehab 3020560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3030560f337SMauro Carvalho Chehab { 304cba8e9b3SFrank Schaefer u8 mode = 0x00; 3050560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3060560f337SMauro Carvalho Chehab 3070560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3080560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3090560f337SMauro Carvalho Chehab } else { 3100560f337SMauro Carvalho Chehab u8 buf[2]; 3110560f337SMauro Carvalho Chehab 3120560f337SMauro Carvalho Chehab buf[0] = h; 3130560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3140560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3150560f337SMauro Carvalho Chehab 3160560f337SMauro Carvalho Chehab buf[0] = v; 3170560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3180560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3190560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3200560f337SMauro Carvalho Chehab to work correctly */ 3210560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3220560f337SMauro Carvalho Chehab } 323cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3240560f337SMauro Carvalho Chehab } 3250560f337SMauro Carvalho Chehab 3260560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32701c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3280560f337SMauro Carvalho Chehab { 329753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 330753aee77SFrank Schaefer int width = norm_maxw(dev); 331753aee77SFrank Schaefer int height = norm_maxh(dev); 3320560f337SMauro Carvalho Chehab 3330560f337SMauro Carvalho Chehab /* Properly setup VBI */ 334753aee77SFrank Schaefer v4l2->vbi_width = 720; 33552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 336753aee77SFrank Schaefer v4l2->vbi_height = 12; 3370560f337SMauro Carvalho Chehab else 338753aee77SFrank Schaefer v4l2->vbi_height = 18; 3390560f337SMauro Carvalho Chehab 3400560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3410560f337SMauro Carvalho Chehab 3420560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3430560f337SMauro Carvalho Chehab 3440560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3450560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3460560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3470560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3480560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3490560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3500560f337SMauro Carvalho Chehab region */ 3510560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3520560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3530560f337SMauro Carvalho Chehab else 3540560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3550560f337SMauro Carvalho Chehab 356753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3570560f337SMauro Carvalho Chehab } 3580560f337SMauro Carvalho Chehab 3590560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36001c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3610560f337SMauro Carvalho Chehab { 362753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 3630560f337SMauro Carvalho Chehab int errCode; 3640560f337SMauro Carvalho Chehab int i; 365753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3660560f337SMauro Carvalho Chehab 3670560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3680560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3690560f337SMauro Carvalho Chehab dev->alt = 0; 3700560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3710560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3720560f337SMauro Carvalho Chehab dev->alt = alt; 3730560f337SMauro Carvalho Chehab goto set_alt; 3740560f337SMauro Carvalho Chehab } 3750560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3760560f337SMauro Carvalho Chehab goto set_alt; 3770560f337SMauro Carvalho Chehab 3780560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3790560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3800560f337SMauro Carvalho Chehab green screen will be received. 3810560f337SMauro Carvalho Chehab */ 382753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3830560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3840560f337SMauro Carvalho Chehab 3850560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3860560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3870560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3880560f337SMauro Carvalho Chehab dev->alt = i; 3890560f337SMauro Carvalho Chehab break; 3900560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3910560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3920560f337SMauro Carvalho Chehab */ 3930560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3940560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3950560f337SMauro Carvalho Chehab dev->alt = i; 3960560f337SMauro Carvalho Chehab } 3970560f337SMauro Carvalho Chehab 3980560f337SMauro Carvalho Chehab set_alt: 3990560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4000560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4010560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4020560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4030560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4040560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4050560f337SMauro Carvalho Chehab } else { /* isoc */ 4060560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4070560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4080560f337SMauro Carvalho Chehab dev->max_pkt_size = 4090560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4100560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4110560f337SMauro Carvalho Chehab } 4120560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4130560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 414961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 4150560f337SMauro Carvalho Chehab if (errCode < 0) { 4160560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 4170560f337SMauro Carvalho Chehab dev->alt, errCode); 4180560f337SMauro Carvalho Chehab return errCode; 4190560f337SMauro Carvalho Chehab } 4200560f337SMauro Carvalho Chehab return 0; 4210560f337SMauro Carvalho Chehab } 4220560f337SMauro Carvalho Chehab 4230c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4240c0d06caSMauro Carvalho Chehab DMA and thread functions 4250c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4260c0d06caSMauro Carvalho Chehab 4270c0d06caSMauro Carvalho Chehab /* 428948a49aaSFrank Schaefer * Finish the current buffer 4290c0d06caSMauro Carvalho Chehab */ 430948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4320c0d06caSMauro Carvalho Chehab { 433d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 434d3829fadSDevin Heitmueller 435d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 436d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 437d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 438d3829fadSDevin Heitmueller 439d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4400c0d06caSMauro Carvalho Chehab } 4410c0d06caSMauro Carvalho Chehab 4420c0d06caSMauro Carvalho Chehab /* 44336016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4440c0d06caSMauro Carvalho Chehab */ 4450c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4460c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 44736016a35SFrank Schaefer unsigned char *usb_buf, 4484078d625SFrank Schaefer unsigned long len) 4490c0d06caSMauro Carvalho Chehab { 45058159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4510c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4520c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45358159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4540c0d06caSMauro Carvalho Chehab 455d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 456d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4570c0d06caSMauro Carvalho Chehab 45836016a35SFrank Schaefer startread = usb_buf; 4590c0d06caSMauro Carvalho Chehab remain = len; 4600c0d06caSMauro Carvalho Chehab 46158159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46236016a35SFrank Schaefer fieldstart = buf->vb_buf; 463c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46436016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4650c0d06caSMauro Carvalho Chehab 4668732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4678732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4680c0d06caSMauro Carvalho Chehab 46958159171SFrank Schaefer if (v4l2->progressive) 4700c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4710c0d06caSMauro Carvalho Chehab else 4720c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4730c0d06caSMauro Carvalho Chehab 4740c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4750c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4760c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4770c0d06caSMauro Carvalho Chehab 478d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4790c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 4800c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 481d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 482d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48336016a35SFrank Schaefer (char *)startwrite; 4840c0d06caSMauro Carvalho Chehab lencopy = remain; 4850c0d06caSMauro Carvalho Chehab } 4860c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4870c0d06caSMauro Carvalho Chehab return; 4880c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4890c0d06caSMauro Carvalho Chehab 4900c0d06caSMauro Carvalho Chehab remain -= lencopy; 4910c0d06caSMauro Carvalho Chehab 4920c0d06caSMauro Carvalho Chehab while (remain > 0) { 49358159171SFrank Schaefer if (v4l2->progressive) 494c02ec71bSFrank Schaefer startwrite += lencopy; 495c02ec71bSFrank Schaefer else 4960c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 4970c0d06caSMauro Carvalho Chehab startread += lencopy; 4980c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 4990c0d06caSMauro Carvalho Chehab lencopy = remain; 5000c0d06caSMauro Carvalho Chehab else 5010c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5020c0d06caSMauro Carvalho Chehab 50336016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 504d3829fadSDevin Heitmueller buf->length) { 5050c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 5060c0d06caSMauro Carvalho Chehab "(2)\n", 5070c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 508d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 509d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5100c0d06caSMauro Carvalho Chehab (char *)startwrite; 5110c0d06caSMauro Carvalho Chehab } 5120c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5130c0d06caSMauro Carvalho Chehab break; 5140c0d06caSMauro Carvalho Chehab 5150c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5160c0d06caSMauro Carvalho Chehab 5170c0d06caSMauro Carvalho Chehab remain -= lencopy; 5180c0d06caSMauro Carvalho Chehab } 5190c0d06caSMauro Carvalho Chehab 5208732533bSFrank Schaefer buf->pos += len; 5210c0d06caSMauro Carvalho Chehab } 5220c0d06caSMauro Carvalho Chehab 52336016a35SFrank Schaefer /* 52436016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52536016a35SFrank Schaefer */ 5260c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5270c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 52836016a35SFrank Schaefer unsigned char *usb_buf, 5294078d625SFrank Schaefer unsigned long len) 5300c0d06caSMauro Carvalho Chehab { 53136016a35SFrank Schaefer unsigned int offset; 5320c0d06caSMauro Carvalho Chehab 533d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 534d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5350c0d06caSMauro Carvalho Chehab 5368732533bSFrank Schaefer offset = buf->pos; 5370c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 53836016a35SFrank Schaefer if (buf->top_field == 0) 539753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5400c0d06caSMauro Carvalho Chehab 54136016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5428732533bSFrank Schaefer buf->pos += len; 5430c0d06caSMauro Carvalho Chehab } 5440c0d06caSMauro Carvalho Chehab 5450c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5460c0d06caSMauro Carvalho Chehab int packet, int status) 5470c0d06caSMauro Carvalho Chehab { 5480c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5490c0d06caSMauro Carvalho Chehab 5500c0d06caSMauro Carvalho Chehab switch (status) { 5510c0d06caSMauro Carvalho Chehab case -ENOENT: 5520c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5530c0d06caSMauro Carvalho Chehab break; 5540c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5550c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5560c0d06caSMauro Carvalho Chehab break; 5570c0d06caSMauro Carvalho Chehab case -ENOSR: 5580c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5590c0d06caSMauro Carvalho Chehab break; 5600c0d06caSMauro Carvalho Chehab case -EPIPE: 5610c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5620c0d06caSMauro Carvalho Chehab break; 5630c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5640c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5650c0d06caSMauro Carvalho Chehab break; 5660c0d06caSMauro Carvalho Chehab case -EPROTO: 5670c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5680c0d06caSMauro Carvalho Chehab break; 5690c0d06caSMauro Carvalho Chehab case -EILSEQ: 5700c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5710c0d06caSMauro Carvalho Chehab break; 5720c0d06caSMauro Carvalho Chehab case -ETIME: 5730c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5740c0d06caSMauro Carvalho Chehab break; 5750c0d06caSMauro Carvalho Chehab } 5760c0d06caSMauro Carvalho Chehab if (packet < 0) { 5770c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5780c0d06caSMauro Carvalho Chehab } else { 5790c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5800c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5810c0d06caSMauro Carvalho Chehab } 5820c0d06caSMauro Carvalho Chehab } 5830c0d06caSMauro Carvalho Chehab 5840c0d06caSMauro Carvalho Chehab /* 58524a6d849SFrank Schaefer * get the next available buffer from dma queue 5860c0d06caSMauro Carvalho Chehab */ 58724a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 58824a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5890c0d06caSMauro Carvalho Chehab { 59024a6d849SFrank Schaefer struct em28xx_buffer *buf; 5910c0d06caSMauro Carvalho Chehab 5920c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5930c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59424a6d849SFrank Schaefer return NULL; 5950c0d06caSMauro Carvalho Chehab } 5960c0d06caSMauro Carvalho Chehab 5970c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 598d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 5990c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 600d3829fadSDevin Heitmueller list_del(&buf->list); 6018732533bSFrank Schaefer buf->pos = 0; 602d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6030c0d06caSMauro Carvalho Chehab 60424a6d849SFrank Schaefer return buf; 6050c0d06caSMauro Carvalho Chehab } 6060c0d06caSMauro Carvalho Chehab 607e04c00d9SFrank Schaefer /* 608e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 609e04c00d9SFrank Schaefer */ 610e04c00d9SFrank Schaefer static struct em28xx_buffer * 611e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 612e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 613e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 614e04c00d9SFrank Schaefer { 61558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 61658159171SFrank Schaefer 61758159171SFrank Schaefer if (v4l2->progressive || dev->top_field) { /* Brand new frame */ 618e04c00d9SFrank Schaefer if (buf != NULL) 619e04c00d9SFrank Schaefer finish_buffer(dev, buf); 620e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 621e04c00d9SFrank Schaefer } 622e04c00d9SFrank Schaefer if (buf != NULL) { 623e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 624e04c00d9SFrank Schaefer buf->pos = 0; 625e04c00d9SFrank Schaefer } 626e04c00d9SFrank Schaefer 627e04c00d9SFrank Schaefer return buf; 628e04c00d9SFrank Schaefer } 629e04c00d9SFrank Schaefer 630227b7c90SFrank Schaefer /* 631227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 632227b7c90SFrank Schaefer */ 633227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 634227b7c90SFrank Schaefer unsigned char *data_pkt, 635227b7c90SFrank Schaefer unsigned int data_len) 636227b7c90SFrank Schaefer { 637753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 638227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 639227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 640227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 641227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 642227b7c90SFrank Schaefer 643227b7c90SFrank Schaefer /* capture type 0 = vbi start 644227b7c90SFrank Schaefer capture type 1 = vbi in progress 645227b7c90SFrank Schaefer capture type 2 = video start 646227b7c90SFrank Schaefer capture type 3 = video in progress */ 647227b7c90SFrank Schaefer if (data_len >= 4) { 648227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 649227b7c90SFrank Schaefer * never split across packets */ 650227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 651227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 652227b7c90SFrank Schaefer /* Continuation */ 653227b7c90SFrank Schaefer data_pkt += 4; 654227b7c90SFrank Schaefer data_len -= 4; 655227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 656227b7c90SFrank Schaefer /* Field start (VBI mode) */ 657227b7c90SFrank Schaefer dev->capture_type = 0; 658227b7c90SFrank Schaefer dev->vbi_read = 0; 659227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 660227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 661227b7c90SFrank Schaefer data_pkt += 4; 662227b7c90SFrank Schaefer data_len -= 4; 663227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 664227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 665227b7c90SFrank Schaefer dev->capture_type = 2; 666227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 667227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 668227b7c90SFrank Schaefer data_pkt += 4; 669227b7c90SFrank Schaefer data_len -= 4; 670227b7c90SFrank Schaefer } 671227b7c90SFrank Schaefer } 672227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 673227b7c90SFrank Schaefer * have no continuation header */ 674227b7c90SFrank Schaefer 675227b7c90SFrank Schaefer if (dev->capture_type == 0) { 676227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 677227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 678227b7c90SFrank Schaefer dev->capture_type = 1; 679227b7c90SFrank Schaefer } 680227b7c90SFrank Schaefer 681227b7c90SFrank Schaefer if (dev->capture_type == 1) { 682753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 683227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 684227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 685227b7c90SFrank Schaefer 686227b7c90SFrank Schaefer /* Copy VBI data */ 687227b7c90SFrank Schaefer if (vbi_buf != NULL) 688227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 689227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 690227b7c90SFrank Schaefer 691227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 692227b7c90SFrank Schaefer /* Continue with copying video data */ 693227b7c90SFrank Schaefer dev->capture_type = 2; 694227b7c90SFrank Schaefer data_pkt += vbi_data_len; 695227b7c90SFrank Schaefer data_len -= vbi_data_len; 696227b7c90SFrank Schaefer } 697227b7c90SFrank Schaefer } 698227b7c90SFrank Schaefer 699227b7c90SFrank Schaefer if (dev->capture_type == 2) { 700227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 701227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 702227b7c90SFrank Schaefer dev->capture_type = 3; 703227b7c90SFrank Schaefer } 704227b7c90SFrank Schaefer 705227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 706227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 707227b7c90SFrank Schaefer } 708227b7c90SFrank Schaefer 709e507e0e5SFrank Schaefer /* 710e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 711e507e0e5SFrank Schaefer */ 712e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 713e507e0e5SFrank Schaefer unsigned char *data_pkt, 714e507e0e5SFrank Schaefer unsigned int data_len) 715e507e0e5SFrank Schaefer { 716e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 717e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 718e507e0e5SFrank Schaefer bool frame_end = 0; 719e507e0e5SFrank Schaefer 720e507e0e5SFrank Schaefer /* Check for header */ 721e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 722e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 723e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 724e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 725e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 726e507e0e5SFrank Schaefer dev->top_field = !(data_pkt[1] & 727e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 728e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 729e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 730e507e0e5SFrank Schaefer data_pkt += 2; 731e507e0e5SFrank Schaefer data_len -= 2; 732e507e0e5SFrank Schaefer } 733e507e0e5SFrank Schaefer 734e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 735e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 736e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 737e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 738e507e0e5SFrank Schaefer } 739e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 740e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 741e507e0e5SFrank Schaefer * first frame. 742e507e0e5SFrank Schaefer */ 743e507e0e5SFrank Schaefer } 744e507e0e5SFrank Schaefer 745e507e0e5SFrank Schaefer /* Copy data */ 746e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 747e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 748e507e0e5SFrank Schaefer 749e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 750e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 751e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 752e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 753e507e0e5SFrank Schaefer } 754e507e0e5SFrank Schaefer 755e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 756e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 757e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 758e507e0e5SFrank Schaefer * header like with the other em28xx devices. 759e507e0e5SFrank Schaefer */ 760e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 761e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 762e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 763e507e0e5SFrank Schaefer } 764e507e0e5SFrank Schaefer 765960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7660fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7670c0d06caSMauro Carvalho Chehab { 768227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 769227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 770227b7c90SFrank Schaefer unsigned int usb_data_len; 7710c0d06caSMauro Carvalho Chehab 7720c0d06caSMauro Carvalho Chehab if (!dev) 7730c0d06caSMauro Carvalho Chehab return 0; 7740c0d06caSMauro Carvalho Chehab 7752665c299SFrank Schaefer if (dev->disconnected) 7760c0d06caSMauro Carvalho Chehab return 0; 7770c0d06caSMauro Carvalho Chehab 7781653cb0cSFrank Schaefer if (urb->status < 0) 7790c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7800c0d06caSMauro Carvalho Chehab 7814601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7824601cc39SFrank Schaefer 7834601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7844601cc39SFrank Schaefer num_packets = 1; 7854601cc39SFrank Schaefer else /* isoc */ 7864601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7870c0d06caSMauro Carvalho Chehab 7884601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7894601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 790227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7914601cc39SFrank Schaefer 792227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7934601cc39SFrank Schaefer } else { /* isoc */ 7944601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7954601cc39SFrank Schaefer print_err_status(dev, i, 7964601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 7970c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 7980c0d06caSMauro Carvalho Chehab continue; 7990c0d06caSMauro Carvalho Chehab } 8000c0d06caSMauro Carvalho Chehab 801227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 802227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8030c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8040c0d06caSMauro Carvalho Chehab continue; 8050c0d06caSMauro Carvalho Chehab } 8060c0d06caSMauro Carvalho Chehab 807227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8084601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8094601cc39SFrank Schaefer } 8104601cc39SFrank Schaefer 811227b7c90SFrank Schaefer if (usb_data_len == 0) { 8124601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8134601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8144601cc39SFrank Schaefer continue; 8154601cc39SFrank Schaefer } 8160c0d06caSMauro Carvalho Chehab 817e507e0e5SFrank Schaefer if (dev->is_em25xx) 818e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 819e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 820e507e0e5SFrank Schaefer else 821e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 822e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 823e507e0e5SFrank Schaefer 8240c0d06caSMauro Carvalho Chehab } 825227b7c90SFrank Schaefer return 1; 8260c0d06caSMauro Carvalho Chehab } 8270c0d06caSMauro Carvalho Chehab 8280c0d06caSMauro Carvalho Chehab 829d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 830d3829fadSDevin Heitmueller { 831d3829fadSDevin Heitmueller switch (f_type) { 832d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 833d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 834d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 835d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 836d3829fadSDevin Heitmueller default: 837d3829fadSDevin Heitmueller BUG(); 838d3829fadSDevin Heitmueller return 0; 839d3829fadSDevin Heitmueller } 840d3829fadSDevin Heitmueller } 841d3829fadSDevin Heitmueller 842d3829fadSDevin Heitmueller /* Usage lock check functions */ 843d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 844d3829fadSDevin Heitmueller { 845d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 846d3829fadSDevin Heitmueller 847d3829fadSDevin Heitmueller /* is it free? */ 848d3829fadSDevin Heitmueller if (dev->resources & res_type) { 849d3829fadSDevin Heitmueller /* no, someone else uses it */ 850d3829fadSDevin Heitmueller return -EBUSY; 851d3829fadSDevin Heitmueller } 852d3829fadSDevin Heitmueller 853d3829fadSDevin Heitmueller /* it's free, grab it */ 854d3829fadSDevin Heitmueller dev->resources |= res_type; 855d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 856d3829fadSDevin Heitmueller return 0; 857d3829fadSDevin Heitmueller } 858d3829fadSDevin Heitmueller 859d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 860d3829fadSDevin Heitmueller { 861d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 862d3829fadSDevin Heitmueller 863d3829fadSDevin Heitmueller dev->resources &= ~res_type; 864d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 865d3829fadSDevin Heitmueller } 866d3829fadSDevin Heitmueller 8670c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 868d3829fadSDevin Heitmueller Videobuf2 operations 8690c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8700c0d06caSMauro Carvalho Chehab 871d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 872d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 873d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8740c0d06caSMauro Carvalho Chehab { 875d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 876753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 877d3829fadSDevin Heitmueller unsigned long size; 8780c0d06caSMauro Carvalho Chehab 879d3829fadSDevin Heitmueller if (fmt) 880d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 881d3829fadSDevin Heitmueller else 882753aee77SFrank Schaefer size = 88306e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 8840c0d06caSMauro Carvalho Chehab 885d3829fadSDevin Heitmueller if (size == 0) 886d3829fadSDevin Heitmueller return -EINVAL; 8870c0d06caSMauro Carvalho Chehab 888d3829fadSDevin Heitmueller if (0 == *nbuffers) 889d3829fadSDevin Heitmueller *nbuffers = 32; 8900c0d06caSMauro Carvalho Chehab 891d3829fadSDevin Heitmueller *nplanes = 1; 892d3829fadSDevin Heitmueller sizes[0] = size; 8930c0d06caSMauro Carvalho Chehab 8940c0d06caSMauro Carvalho Chehab return 0; 8950c0d06caSMauro Carvalho Chehab } 8960c0d06caSMauro Carvalho Chehab 8970c0d06caSMauro Carvalho Chehab static int 898d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 8990c0d06caSMauro Carvalho Chehab { 900d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 901753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 9020c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 903d3829fadSDevin Heitmueller unsigned long size; 9040c0d06caSMauro Carvalho Chehab 905d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 9060c0d06caSMauro Carvalho Chehab 90706e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 908d3829fadSDevin Heitmueller 909d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 910d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 911d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 9120c0d06caSMauro Carvalho Chehab return -EINVAL; 913d3829fadSDevin Heitmueller } 914d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 9150c0d06caSMauro Carvalho Chehab 916d3829fadSDevin Heitmueller return 0; 9170c0d06caSMauro Carvalho Chehab } 9180c0d06caSMauro Carvalho Chehab 919d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 920d3829fadSDevin Heitmueller { 921d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 922d3829fadSDevin Heitmueller struct v4l2_frequency f; 923d3829fadSDevin Heitmueller int rc = 0; 9240c0d06caSMauro Carvalho Chehab 925d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 926d3829fadSDevin Heitmueller 927d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 928d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 929d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 930d3829fadSDevin Heitmueller if (rc) 931d3829fadSDevin Heitmueller return rc; 932d3829fadSDevin Heitmueller 933032f1ddfSFrank Schaefer if (dev->streaming_users == 0) { 934d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 935d3829fadSDevin Heitmueller 936d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 937d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 938d3829fadSDevin Heitmueller 939d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 940d3829fadSDevin Heitmueller some i2c device 941d3829fadSDevin Heitmueller */ 942d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 943d3829fadSDevin Heitmueller 9440455eebfSFrank Schaefer dev->capture_type = -1; 945c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 946c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9470c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9480c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 949c647a91aSFrank Schaefer dev->packet_multiplier, 9500fa4a402SFrank Schaefer em28xx_urb_data_copy); 9510c0d06caSMauro Carvalho Chehab if (rc < 0) 952032f1ddfSFrank Schaefer return rc; 953d3829fadSDevin Heitmueller 954d3829fadSDevin Heitmueller /* 955d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 956d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 957d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 958d3829fadSDevin Heitmueller */ 959d3829fadSDevin Heitmueller 960d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 961d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 962d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 963d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 964d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 965d3829fadSDevin Heitmueller else 966d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 96795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 96895d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 9690c0d06caSMauro Carvalho Chehab } 9700c0d06caSMauro Carvalho Chehab 971032f1ddfSFrank Schaefer dev->streaming_users++; 972032f1ddfSFrank Schaefer 9730c0d06caSMauro Carvalho Chehab return rc; 9740c0d06caSMauro Carvalho Chehab } 9750c0d06caSMauro Carvalho Chehab 976e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 9770c0d06caSMauro Carvalho Chehab { 978d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9790c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 980d3829fadSDevin Heitmueller unsigned long flags = 0; 9810c0d06caSMauro Carvalho Chehab 982d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9830c0d06caSMauro Carvalho Chehab 984d3829fadSDevin Heitmueller res_free(dev, vq->type); 985d3829fadSDevin Heitmueller 986d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 987d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 988d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9890c0d06caSMauro Carvalho Chehab } 9900c0d06caSMauro Carvalho Chehab 991d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 992d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 993d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 994d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 995d3829fadSDevin Heitmueller list_del(&buf->list); 996d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 997d3829fadSDevin Heitmueller } 998d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 999d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1000d3829fadSDevin Heitmueller } 1001d3829fadSDevin Heitmueller 1002e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 10030c0d06caSMauro Carvalho Chehab { 1004d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1005d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1006d3829fadSDevin Heitmueller unsigned long flags = 0; 10070c0d06caSMauro Carvalho Chehab 1008d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 10090c0d06caSMauro Carvalho Chehab 1010d3829fadSDevin Heitmueller res_free(dev, vq->type); 1011d3829fadSDevin Heitmueller 1012d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 1013d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1014d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 10150c0d06caSMauro Carvalho Chehab } 10160c0d06caSMauro Carvalho Chehab 1017d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1018d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1019d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1020d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1021d3829fadSDevin Heitmueller list_del(&buf->list); 1022d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 1023d3829fadSDevin Heitmueller } 1024d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 1025d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1026d3829fadSDevin Heitmueller } 1027d3829fadSDevin Heitmueller 1028d3829fadSDevin Heitmueller static void 1029d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1030d3829fadSDevin Heitmueller { 1031d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1032d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 1033d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1034d3829fadSDevin Heitmueller unsigned long flags = 0; 1035d3829fadSDevin Heitmueller 1036d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1037d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1038d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1039d3829fadSDevin Heitmueller 1040d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1041d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1042d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1043d3829fadSDevin Heitmueller } 1044d3829fadSDevin Heitmueller 1045d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1046d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10470c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10480c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1049d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1050d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1051d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1052d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10530c0d06caSMauro Carvalho Chehab }; 10540c0d06caSMauro Carvalho Chehab 105501c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1056d3829fadSDevin Heitmueller { 1057d3829fadSDevin Heitmueller int rc; 1058d3829fadSDevin Heitmueller struct vb2_queue *q; 105927a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1060d3829fadSDevin Heitmueller 1061d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 106227a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1063d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1064ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1065ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1066d3829fadSDevin Heitmueller q->drv_priv = dev; 1067d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1068d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1069d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1070d3829fadSDevin Heitmueller 1071d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1072d3829fadSDevin Heitmueller if (rc < 0) 1073d3829fadSDevin Heitmueller return rc; 1074d3829fadSDevin Heitmueller 1075d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 107627a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1077d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1078d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1079ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1080d3829fadSDevin Heitmueller q->drv_priv = dev; 1081d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1082d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1083d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1084d3829fadSDevin Heitmueller 1085d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1086d3829fadSDevin Heitmueller if (rc < 0) 1087d3829fadSDevin Heitmueller return rc; 1088d3829fadSDevin Heitmueller 1089d3829fadSDevin Heitmueller return 0; 1090d3829fadSDevin Heitmueller } 1091d3829fadSDevin Heitmueller 10920c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 10930c0d06caSMauro Carvalho Chehab 10940c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 10950c0d06caSMauro Carvalho Chehab { 109695d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 10970c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 10980c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 10990c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 11000c0d06caSMauro Carvalho Chehab 11010c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11020c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11030c0d06caSMauro Carvalho Chehab 110495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 11050c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 11060c0d06caSMauro Carvalho Chehab 11070c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 11080c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 110995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 11100c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 11110c0d06caSMauro Carvalho Chehab } 11120c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 111395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11140c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 11150c0d06caSMauro Carvalho Chehab } 11160c0d06caSMauro Carvalho Chehab 11170c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 111895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 11190c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 11200c0d06caSMauro Carvalho Chehab } 11210c0d06caSMauro Carvalho Chehab 11220c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 11230c0d06caSMauro Carvalho Chehab } 11240c0d06caSMauro Carvalho Chehab 112501c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 11260c0d06caSMauro Carvalho Chehab { 1127081b945eSHans Verkuil struct em28xx *dev = priv; 11280c0d06caSMauro Carvalho Chehab 11290c0d06caSMauro Carvalho Chehab /* 1130081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1131081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1132081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1133081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 11340c0d06caSMauro Carvalho Chehab */ 11350c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 11360c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1137081b945eSHans Verkuil dev->mute = ctrl->val; 1138081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11390c0d06caSMauro Carvalho Chehab break; 11400c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1141081b945eSHans Verkuil dev->volume = ctrl->val; 1142081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1143081b945eSHans Verkuil break; 1144081b945eSHans Verkuil } 1145081b945eSHans Verkuil } 1146081b945eSHans Verkuil 1147081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1148081b945eSHans Verkuil { 1149abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1150abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1151abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 11528f8b113aSFrank Schaefer int ret = -EINVAL; 1153081b945eSHans Verkuil 1154081b945eSHans Verkuil switch (ctrl->id) { 1155081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1156081b945eSHans Verkuil dev->mute = ctrl->val; 11578f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1158081b945eSHans Verkuil break; 1159081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1160081b945eSHans Verkuil dev->volume = ctrl->val; 11618f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11628f8b113aSFrank Schaefer break; 11638f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11648f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11658f8b113aSFrank Schaefer break; 11668f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11678f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11688f8b113aSFrank Schaefer break; 11698f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11708f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11718f8b113aSFrank Schaefer break; 11728f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11738f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11748f8b113aSFrank Schaefer break; 11758f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11768f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11778f8b113aSFrank Schaefer break; 11788f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11798f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11800c0d06caSMauro Carvalho Chehab break; 11810c0d06caSMauro Carvalho Chehab } 11820c0d06caSMauro Carvalho Chehab 11838f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 11840c0d06caSMauro Carvalho Chehab } 11850c0d06caSMauro Carvalho Chehab 11868068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1187081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1188081b945eSHans Verkuil }; 1189081b945eSHans Verkuil 11906b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 11910c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 11920c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 11930c0d06caSMauro Carvalho Chehab { 11940c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 11950c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 11960c0d06caSMauro Carvalho Chehab 11970c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 119881685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 119981685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 12000c0d06caSMauro Carvalho Chehab 12010c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 120281685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 120381685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 12040c0d06caSMauro Carvalho Chehab } 12050c0d06caSMauro Carvalho Chehab 1206b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1207b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1208b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1209b8374138SFrank Schaefer { 1210b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1211b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1212b8374138SFrank Schaefer 1213b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1214b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1215b8374138SFrank Schaefer } 1216b8374138SFrank Schaefer 12170c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 12180c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 12190c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 12200c0d06caSMauro Carvalho Chehab 12210c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 12220c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12230c0d06caSMauro Carvalho Chehab { 12240c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12250c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1226753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12270c0d06caSMauro Carvalho Chehab 1228753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1229753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 123006e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 123106e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1232753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 12330c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12340c0d06caSMauro Carvalho Chehab 12350c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 123658159171SFrank Schaefer if (v4l2->progressive) 12370c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12380c0d06caSMauro Carvalho Chehab else 123958159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 12400c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12410c0d06caSMauro Carvalho Chehab return 0; 12420c0d06caSMauro Carvalho Chehab } 12430c0d06caSMauro Carvalho Chehab 12440c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12450c0d06caSMauro Carvalho Chehab { 12460c0d06caSMauro Carvalho Chehab unsigned int i; 12470c0d06caSMauro Carvalho Chehab 12480c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12490c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12500c0d06caSMauro Carvalho Chehab return &format[i]; 12510c0d06caSMauro Carvalho Chehab 12520c0d06caSMauro Carvalho Chehab return NULL; 12530c0d06caSMauro Carvalho Chehab } 12540c0d06caSMauro Carvalho Chehab 12550c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12560c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12570c0d06caSMauro Carvalho Chehab { 12580c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12590c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 126058159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 12610c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12620c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12630c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12640c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12650c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12660c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12670c0d06caSMauro Carvalho Chehab 12680c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12690c0d06caSMauro Carvalho Chehab if (!fmt) { 12700c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12710c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12720c0d06caSMauro Carvalho Chehab return -EINVAL; 12730c0d06caSMauro Carvalho Chehab } 12740c0d06caSMauro Carvalho Chehab 12750c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12760c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12770c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12780c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1279d3829fadSDevin Heitmueller /* 1280d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1281d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1282d3829fadSDevin Heitmueller * to 50% 1283d3829fadSDevin Heitmueller */ 12840c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 12850c0d06caSMauro Carvalho Chehab width /= 2; 12860c0d06caSMauro Carvalho Chehab } else { 12870c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 12880c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 12890c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 12900c0d06caSMauro Carvalho Chehab 1, 0); 12910c0d06caSMauro Carvalho Chehab } 12920c0d06caSMauro Carvalho Chehab 12936b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 129446f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 12950c0d06caSMauro Carvalho Chehab 12960c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 12970c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 12980c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1299e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 13000c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 13010c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 130258159171SFrank Schaefer if (v4l2->progressive) 13030c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 13040c0d06caSMauro Carvalho Chehab else 130558159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 13060c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 130751dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 13080c0d06caSMauro Carvalho Chehab 13090c0d06caSMauro Carvalho Chehab return 0; 13100c0d06caSMauro Carvalho Chehab } 13110c0d06caSMauro Carvalho Chehab 13120c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 13130c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 13140c0d06caSMauro Carvalho Chehab { 13150c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1316753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13170c0d06caSMauro Carvalho Chehab 13180c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 13190c0d06caSMauro Carvalho Chehab if (!fmt) 13200c0d06caSMauro Carvalho Chehab return -EINVAL; 13210c0d06caSMauro Carvalho Chehab 132206e20672SFrank Schaefer v4l2->format = fmt; 1323753aee77SFrank Schaefer v4l2->width = width; 1324753aee77SFrank Schaefer v4l2->height = height; 13250c0d06caSMauro Carvalho Chehab 13260c0d06caSMauro Carvalho Chehab /* set new image size */ 1327753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1328753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13290c0d06caSMauro Carvalho Chehab 13300c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13310c0d06caSMauro Carvalho Chehab 13320c0d06caSMauro Carvalho Chehab return 0; 13330c0d06caSMauro Carvalho Chehab } 13340c0d06caSMauro Carvalho Chehab 13350c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 13360c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13370c0d06caSMauro Carvalho Chehab { 1338d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 13390c0d06caSMauro Carvalho Chehab 1340d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1341d3829fadSDevin Heitmueller return -EBUSY; 13420c0d06caSMauro Carvalho Chehab 13430c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13440c0d06caSMauro Carvalho Chehab 13450c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13460c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13470c0d06caSMauro Carvalho Chehab } 13480c0d06caSMauro Carvalho Chehab 13490c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13500c0d06caSMauro Carvalho Chehab { 13510c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13520c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13530c0d06caSMauro Carvalho Chehab 135452faaf78SFrank Schaefer *norm = dev->v4l2->norm; 13550c0d06caSMauro Carvalho Chehab 13560c0d06caSMauro Carvalho Chehab return 0; 13570c0d06caSMauro Carvalho Chehab } 13580c0d06caSMauro Carvalho Chehab 13590c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13600c0d06caSMauro Carvalho Chehab { 13610c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13620c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13630c0d06caSMauro Carvalho Chehab 136495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 13650c0d06caSMauro Carvalho Chehab 13660c0d06caSMauro Carvalho Chehab return 0; 13670c0d06caSMauro Carvalho Chehab } 13680c0d06caSMauro Carvalho Chehab 1369314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13700c0d06caSMauro Carvalho Chehab { 13710c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13720c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1373753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13740c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13750c0d06caSMauro Carvalho Chehab 137652faaf78SFrank Schaefer if (norm == v4l2->norm) 1377d8c95c08SHans Verkuil return 0; 13780c0d06caSMauro Carvalho Chehab 1379d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1380d8c95c08SHans Verkuil return -EBUSY; 1381d8c95c08SHans Verkuil 138252faaf78SFrank Schaefer v4l2->norm = norm; 13830c0d06caSMauro Carvalho Chehab 13840c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1385d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1386314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 13870c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 13880c0d06caSMauro Carvalho Chehab 13890c0d06caSMauro Carvalho Chehab /* set new image size */ 1390753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1391753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1392753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1393753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 13940c0d06caSMauro Carvalho Chehab 13950c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 139652faaf78SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, v4l2->norm); 13970c0d06caSMauro Carvalho Chehab 13980c0d06caSMauro Carvalho Chehab return 0; 13990c0d06caSMauro Carvalho Chehab } 14000c0d06caSMauro Carvalho Chehab 14010c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 14020c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14030c0d06caSMauro Carvalho Chehab { 14040c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14050c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 140652faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14070c0d06caSMauro Carvalho Chehab int rc = 0; 14080c0d06caSMauro Carvalho Chehab 140986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 14100c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 141152faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 14120c0d06caSMauro Carvalho Chehab video, g_parm, p); 14130c0d06caSMauro Carvalho Chehab else 141452faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 14150c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 14160c0d06caSMauro Carvalho Chehab 14170c0d06caSMauro Carvalho Chehab return rc; 14180c0d06caSMauro Carvalho Chehab } 14190c0d06caSMauro Carvalho Chehab 14200c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 14210c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 14220c0d06caSMauro Carvalho Chehab { 14230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14250c0d06caSMauro Carvalho Chehab 142686ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 142795d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 142895d2608bSFrank Schaefer 0, video, s_parm, p); 14290c0d06caSMauro Carvalho Chehab } 14300c0d06caSMauro Carvalho Chehab 14310c0d06caSMauro Carvalho Chehab static const char *iname[] = { 14320c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 14330c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 14340c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 14350c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 14360c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 14370c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 14380c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 14390c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 14400c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 14410c0d06caSMauro Carvalho Chehab }; 14420c0d06caSMauro Carvalho Chehab 14430c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 14440c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 14450c0d06caSMauro Carvalho Chehab { 14460c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14470c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14480c0d06caSMauro Carvalho Chehab unsigned int n; 14490c0d06caSMauro Carvalho Chehab 14500c0d06caSMauro Carvalho Chehab n = i->index; 14510c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14520c0d06caSMauro Carvalho Chehab return -EINVAL; 14530c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14540c0d06caSMauro Carvalho Chehab return -EINVAL; 14550c0d06caSMauro Carvalho Chehab 14560c0d06caSMauro Carvalho Chehab i->index = n; 14570c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14580c0d06caSMauro Carvalho Chehab 14590c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14600c0d06caSMauro Carvalho Chehab 14610c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14620c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14630c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14640c0d06caSMauro Carvalho Chehab 1465ef74a0b9SFrank Schaefer i->std = dev->v4l2->vdev->tvnorms; 1466d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1467d8c95c08SHans Verkuil if (dev->board.is_webcam) 1468d8c95c08SHans Verkuil i->capabilities = 0; 14690c0d06caSMauro Carvalho Chehab 14700c0d06caSMauro Carvalho Chehab return 0; 14710c0d06caSMauro Carvalho Chehab } 14720c0d06caSMauro Carvalho Chehab 14730c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14740c0d06caSMauro Carvalho Chehab { 14750c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14760c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14770c0d06caSMauro Carvalho Chehab 14780c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14790c0d06caSMauro Carvalho Chehab 14800c0d06caSMauro Carvalho Chehab return 0; 14810c0d06caSMauro Carvalho Chehab } 14820c0d06caSMauro Carvalho Chehab 14830c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 14840c0d06caSMauro Carvalho Chehab { 14850c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14860c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14870c0d06caSMauro Carvalho Chehab 14880c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 14890c0d06caSMauro Carvalho Chehab return -EINVAL; 14900c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14910c0d06caSMauro Carvalho Chehab return -EINVAL; 14920c0d06caSMauro Carvalho Chehab 14930c0d06caSMauro Carvalho Chehab video_mux(dev, i); 14940c0d06caSMauro Carvalho Chehab return 0; 14950c0d06caSMauro Carvalho Chehab } 14960c0d06caSMauro Carvalho Chehab 14970c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 14980c0d06caSMauro Carvalho Chehab { 14990c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15000c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15010c0d06caSMauro Carvalho Chehab 15020c0d06caSMauro Carvalho Chehab switch (a->index) { 15030c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 15040c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 15050c0d06caSMauro Carvalho Chehab break; 15060c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 15070c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 15080c0d06caSMauro Carvalho Chehab break; 15090c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 15100c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 15110c0d06caSMauro Carvalho Chehab break; 15120c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 15130c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 15140c0d06caSMauro Carvalho Chehab break; 15150c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 15160c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 15170c0d06caSMauro Carvalho Chehab break; 15180c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 15190c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 15200c0d06caSMauro Carvalho Chehab break; 15210c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 15220c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 15230c0d06caSMauro Carvalho Chehab break; 15240c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 15250c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 15260c0d06caSMauro Carvalho Chehab break; 15270c0d06caSMauro Carvalho Chehab default: 15280c0d06caSMauro Carvalho Chehab return -EINVAL; 15290c0d06caSMauro Carvalho Chehab } 15300c0d06caSMauro Carvalho Chehab 15310c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 15320c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 15330c0d06caSMauro Carvalho Chehab 15340c0d06caSMauro Carvalho Chehab return 0; 15350c0d06caSMauro Carvalho Chehab } 15360c0d06caSMauro Carvalho Chehab 15370e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 15380c0d06caSMauro Carvalho Chehab { 15390c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15400c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 15430c0d06caSMauro Carvalho Chehab return -EINVAL; 15440c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 15450c0d06caSMauro Carvalho Chehab return -EINVAL; 15460c0d06caSMauro Carvalho Chehab 15470c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15480c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15490c0d06caSMauro Carvalho Chehab 15500c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15510c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15520c0d06caSMauro Carvalho Chehab 15530c0d06caSMauro Carvalho Chehab return 0; 15540c0d06caSMauro Carvalho Chehab } 15550c0d06caSMauro Carvalho Chehab 15560c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15570c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15580c0d06caSMauro Carvalho Chehab { 15590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15610c0d06caSMauro Carvalho Chehab 15620c0d06caSMauro Carvalho Chehab if (0 != t->index) 15630c0d06caSMauro Carvalho Chehab return -EINVAL; 15640c0d06caSMauro Carvalho Chehab 15650c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15660c0d06caSMauro Carvalho Chehab 156795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 15680c0d06caSMauro Carvalho Chehab return 0; 15690c0d06caSMauro Carvalho Chehab } 15700c0d06caSMauro Carvalho Chehab 15710c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15722f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15730c0d06caSMauro Carvalho Chehab { 15740c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15750c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15760c0d06caSMauro Carvalho Chehab 15770c0d06caSMauro Carvalho Chehab if (0 != t->index) 15780c0d06caSMauro Carvalho Chehab return -EINVAL; 15790c0d06caSMauro Carvalho Chehab 158095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 15810c0d06caSMauro Carvalho Chehab return 0; 15820c0d06caSMauro Carvalho Chehab } 15830c0d06caSMauro Carvalho Chehab 15840c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15850c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15860c0d06caSMauro Carvalho Chehab { 15870c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15880c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15890c0d06caSMauro Carvalho Chehab 159020deebfeSHans Verkuil if (0 != f->tuner) 159120deebfeSHans Verkuil return -EINVAL; 159220deebfeSHans Verkuil 15930c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 15940c0d06caSMauro Carvalho Chehab return 0; 15950c0d06caSMauro Carvalho Chehab } 15960c0d06caSMauro Carvalho Chehab 15970c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1598b530a447SHans Verkuil const struct v4l2_frequency *f) 15990c0d06caSMauro Carvalho Chehab { 1600b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 16010c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16020c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 160395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 16060c0d06caSMauro Carvalho Chehab return -EINVAL; 16070c0d06caSMauro Carvalho Chehab 160895d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 160995d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 1610b530a447SHans Verkuil dev->ctl_freq = new_freq.frequency; 16110c0d06caSMauro Carvalho Chehab 16120c0d06caSMauro Carvalho Chehab return 0; 16130c0d06caSMauro Carvalho Chehab } 16140c0d06caSMauro Carvalho Chehab 1615cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 161696b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 161796b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 16183b2d17b4SHans Verkuil { 16193b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 16203b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 16213b2d17b4SHans Verkuil 16223b2d17b4SHans Verkuil if (chip->match.addr > 1) 16233b2d17b4SHans Verkuil return -EINVAL; 16243b2d17b4SHans Verkuil if (chip->match.addr == 1) 16253b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 16263b2d17b4SHans Verkuil else 162795d2608bSFrank Schaefer strlcpy(chip->name, 162895d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 16293b2d17b4SHans Verkuil return 0; 16303b2d17b4SHans Verkuil } 16313b2d17b4SHans Verkuil 163235deba32SFrank Schaefer static int em28xx_reg_len(int reg) 163335deba32SFrank Schaefer { 163435deba32SFrank Schaefer switch (reg) { 163535deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 163635deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 163735deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 163835deba32SFrank Schaefer return 2; 163935deba32SFrank Schaefer default: 164035deba32SFrank Schaefer return 1; 164135deba32SFrank Schaefer } 164235deba32SFrank Schaefer } 16430c0d06caSMauro Carvalho Chehab 16440c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16450c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16460c0d06caSMauro Carvalho Chehab { 16470c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16480c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16490c0d06caSMauro Carvalho Chehab int ret; 16500c0d06caSMauro Carvalho Chehab 16513b2d17b4SHans Verkuil if (reg->match.addr > 1) 16523b2d17b4SHans Verkuil return -EINVAL; 1653abca2056SHans Verkuil if (reg->match.addr) { 16540c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16550c0d06caSMauro Carvalho Chehab if (ret < 0) 16560c0d06caSMauro Carvalho Chehab return ret; 16570c0d06caSMauro Carvalho Chehab 16580c0d06caSMauro Carvalho Chehab reg->val = ret; 16590c0d06caSMauro Carvalho Chehab reg->size = 1; 16600c0d06caSMauro Carvalho Chehab return 0; 16610c0d06caSMauro Carvalho Chehab } 16620c0d06caSMauro Carvalho Chehab 16630c0d06caSMauro Carvalho Chehab /* Match host */ 16640c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16650c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16660c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16670c0d06caSMauro Carvalho Chehab 16680c0d06caSMauro Carvalho Chehab if (ret < 0) 16690c0d06caSMauro Carvalho Chehab return ret; 16700c0d06caSMauro Carvalho Chehab 16710c0d06caSMauro Carvalho Chehab reg->val = ret; 16720c0d06caSMauro Carvalho Chehab } else { 16730c0d06caSMauro Carvalho Chehab __le16 val = 0; 167401c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16750c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16760c0d06caSMauro Carvalho Chehab if (ret < 0) 16770c0d06caSMauro Carvalho Chehab return ret; 16780c0d06caSMauro Carvalho Chehab 16790c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16800c0d06caSMauro Carvalho Chehab } 16810c0d06caSMauro Carvalho Chehab 16820c0d06caSMauro Carvalho Chehab return 0; 16830c0d06caSMauro Carvalho Chehab } 16840c0d06caSMauro Carvalho Chehab 16850c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1686977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16870c0d06caSMauro Carvalho Chehab { 16880c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16890c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16900c0d06caSMauro Carvalho Chehab __le16 buf; 16910c0d06caSMauro Carvalho Chehab 16923b2d17b4SHans Verkuil if (reg->match.addr > 1) 16933b2d17b4SHans Verkuil return -EINVAL; 1694abca2056SHans Verkuil if (reg->match.addr) 16950c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16960c0d06caSMauro Carvalho Chehab 16970c0d06caSMauro Carvalho Chehab /* Match host */ 16980c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 16990c0d06caSMauro Carvalho Chehab 17000c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 17010c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 17020c0d06caSMauro Carvalho Chehab } 17030c0d06caSMauro Carvalho Chehab #endif 17040c0d06caSMauro Carvalho Chehab 17050c0d06caSMauro Carvalho Chehab 17060c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 17070c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 17080c0d06caSMauro Carvalho Chehab { 1709a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 17100c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17110c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1712ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17130c0d06caSMauro Carvalho Chehab 17140c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 17150c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 17160c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 17170c0d06caSMauro Carvalho Chehab 1718a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1719a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1720a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1721a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1722a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1723a9d79fe5SHans Verkuil else 17241d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 17250c0d06caSMauro Carvalho Chehab 17260c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1727a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 17280c0d06caSMauro Carvalho Chehab 17290c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1730a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 17310c0d06caSMauro Carvalho Chehab 1732a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1733a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1734ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 17351d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1736ef74a0b9SFrank Schaefer if (v4l2->radio_dev) 1737a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 17380c0d06caSMauro Carvalho Chehab return 0; 17390c0d06caSMauro Carvalho Chehab } 17400c0d06caSMauro Carvalho Chehab 17410c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 17420c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 17430c0d06caSMauro Carvalho Chehab { 17440c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 17450c0d06caSMauro Carvalho Chehab return -EINVAL; 17460c0d06caSMauro Carvalho Chehab 17470c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 17480c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 17490c0d06caSMauro Carvalho Chehab 17500c0d06caSMauro Carvalho Chehab return 0; 17510c0d06caSMauro Carvalho Chehab } 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17540c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17550c0d06caSMauro Carvalho Chehab { 17560c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17570c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17580c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17590c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17600c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17610c0d06caSMauro Carvalho Chehab 17620c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17630c0d06caSMauro Carvalho Chehab if (!fmt) { 17640c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17650c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17660c0d06caSMauro Carvalho Chehab return -EINVAL; 17670c0d06caSMauro Carvalho Chehab } 17680c0d06caSMauro Carvalho Chehab 17690c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17700c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17710c0d06caSMauro Carvalho Chehab return -EINVAL; 17720c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17730c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17740c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17750c0d06caSMauro Carvalho Chehab return 0; 17760c0d06caSMauro Carvalho Chehab } 17770c0d06caSMauro Carvalho Chehab 17780c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17790c0d06caSMauro Carvalho Chehab return -EINVAL; 17800c0d06caSMauro Carvalho Chehab 17810c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17820c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17836c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17846c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17856c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17860c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17876c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17886c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17890c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17900c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17910c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 17920c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 17930c0d06caSMauro Carvalho Chehab return 0; 17940c0d06caSMauro Carvalho Chehab } 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 17970c0d06caSMauro Carvalho Chehab 17980c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 17990c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 18000c0d06caSMauro Carvalho Chehab { 18010c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18020c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 1803753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18040c0d06caSMauro Carvalho Chehab 1805753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 18060c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 18070c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 18080c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 18090c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1810753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1811753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 18122a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 18130c0d06caSMauro Carvalho Chehab 18140c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 181552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 18160c0d06caSMauro Carvalho Chehab /* NTSC */ 18170c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 18180c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 181952faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 18200c0d06caSMauro Carvalho Chehab /* PAL */ 18210c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 18220c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 18230c0d06caSMauro Carvalho Chehab } 18240c0d06caSMauro Carvalho Chehab 18250c0d06caSMauro Carvalho Chehab return 0; 18260c0d06caSMauro Carvalho Chehab } 18270c0d06caSMauro Carvalho Chehab 18280c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18290c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 18300c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18310c0d06caSMauro Carvalho Chehab 18320c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 18330c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18340c0d06caSMauro Carvalho Chehab { 18350c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18360c0d06caSMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 18380c0d06caSMauro Carvalho Chehab return -EINVAL; 18390c0d06caSMauro Carvalho Chehab 18400c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 18410c0d06caSMauro Carvalho Chehab 184295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18430c0d06caSMauro Carvalho Chehab 18440c0d06caSMauro Carvalho Chehab return 0; 18450c0d06caSMauro Carvalho Chehab } 18460c0d06caSMauro Carvalho Chehab 18470c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18482f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18490c0d06caSMauro Carvalho Chehab { 18500c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab if (0 != t->index) 18530c0d06caSMauro Carvalho Chehab return -EINVAL; 18540c0d06caSMauro Carvalho Chehab 185595d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18560c0d06caSMauro Carvalho Chehab 18570c0d06caSMauro Carvalho Chehab return 0; 18580c0d06caSMauro Carvalho Chehab } 18590c0d06caSMauro Carvalho Chehab 18600c0d06caSMauro Carvalho Chehab /* 186195d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 186295d2608bSFrank Schaefer * 186395d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 186495d2608bSFrank Schaefer * 186595d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 186695d2608bSFrank Schaefer */ 186795d2608bSFrank Schaefer void em28xx_free_v4l2(struct kref *ref) 186895d2608bSFrank Schaefer { 186995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 187095d2608bSFrank Schaefer 1871abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 187295d2608bSFrank Schaefer kfree(v4l2); 187395d2608bSFrank Schaefer } 187495d2608bSFrank Schaefer 187595d2608bSFrank Schaefer /* 18760c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18770c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18780c0d06caSMauro Carvalho Chehab */ 18790c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18800c0d06caSMauro Carvalho Chehab { 18810c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18820c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 188395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18840c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18850c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 18860c0d06caSMauro Carvalho Chehab 18870c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18880c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18890c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18900c0d06caSMauro Carvalho Chehab break; 18910c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 18920c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 18930c0d06caSMauro Carvalho Chehab break; 18944e170240SFrank Schaefer case VFL_TYPE_RADIO: 18954e170240SFrank Schaefer break; 18964e170240SFrank Schaefer default: 18974e170240SFrank Schaefer return -EINVAL; 18980c0d06caSMauro Carvalho Chehab } 18990c0d06caSMauro Carvalho Chehab 19000c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 19010c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 19020c0d06caSMauro Carvalho Chehab dev->users); 19030c0d06caSMauro Carvalho Chehab 19040c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19050c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19060c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 19070c0d06caSMauro Carvalho Chehab if (!fh) { 19080c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 19090c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19100c0d06caSMauro Carvalho Chehab return -ENOMEM; 19110c0d06caSMauro Carvalho Chehab } 191269a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 19130c0d06caSMauro Carvalho Chehab fh->dev = dev; 19140c0d06caSMauro Carvalho Chehab fh->type = fh_type; 19150c0d06caSMauro Carvalho Chehab filp->private_data = fh; 19160c0d06caSMauro Carvalho Chehab 19174e170240SFrank Schaefer if (dev->users == 0) { 19180c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 19194e170240SFrank Schaefer 19204e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 19210c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 19220c0d06caSMauro Carvalho Chehab 19234e170240SFrank Schaefer /* 19244e170240SFrank Schaefer * Needed, since GPIO might have disabled power 19254e170240SFrank Schaefer * of some i2c devices 19260c0d06caSMauro Carvalho Chehab */ 19270c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 19280c0d06caSMauro Carvalho Chehab } 1929d3829fadSDevin Heitmueller 1930d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 19310c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 193295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 19330c0d06caSMauro Carvalho Chehab } 19340c0d06caSMauro Carvalho Chehab 193547677e51SMauro Carvalho Chehab kref_get(&dev->ref); 193695d2608bSFrank Schaefer kref_get(&v4l2->ref); 19370c0d06caSMauro Carvalho Chehab dev->users++; 19380c0d06caSMauro Carvalho Chehab 19390c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 194069a61642SHans Verkuil v4l2_fh_add(&fh->fh); 19410c0d06caSMauro Carvalho Chehab 1942d3829fadSDevin Heitmueller return 0; 19430c0d06caSMauro Carvalho Chehab } 19440c0d06caSMauro Carvalho Chehab 19450c0d06caSMauro Carvalho Chehab /* 194601c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 19470c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 19480c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 19490c0d06caSMauro Carvalho Chehab */ 195001c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 19510c0d06caSMauro Carvalho Chehab { 195295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 195395d2608bSFrank Schaefer 1954822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 1955822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 1956822b8deaSMauro Carvalho Chehab return 0; 1957822b8deaSMauro Carvalho Chehab } 1958822b8deaSMauro Carvalho Chehab 195901c28193SMauro Carvalho Chehab if (!dev->has_video) { 196001c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 196101c28193SMauro Carvalho Chehab return 0; 196201c28193SMauro Carvalho Chehab } 19630c0d06caSMauro Carvalho Chehab 196495d2608bSFrank Schaefer if (v4l2 == NULL) 196595d2608bSFrank Schaefer return 0; 196695d2608bSFrank Schaefer 1967aa929ad7SMauro Carvalho Chehab em28xx_info("Closing video extension"); 1968aa929ad7SMauro Carvalho Chehab 1969ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 1970ebbfbc20SMauro Carvalho Chehab 197195d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 19725ad10de6SFrank Schaefer 197323e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 197423e8642cSFrank Schaefer 1975ef74a0b9SFrank Schaefer if (v4l2->radio_dev) { 1976e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 1977ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 1978ef74a0b9SFrank Schaefer video_unregister_device(v4l2->radio_dev); 19790c0d06caSMauro Carvalho Chehab } 1980ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) { 19810c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1982ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 1983ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vbi_dev); 19840c0d06caSMauro Carvalho Chehab } 1985ef74a0b9SFrank Schaefer if (v4l2->vdev) { 19860c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 1987ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 1988ef74a0b9SFrank Schaefer video_unregister_device(v4l2->vdev); 19890c0d06caSMauro Carvalho Chehab } 199001c28193SMauro Carvalho Chehab 1991abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 199295d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 1993103f18a2SFrank Schaefer 19942c52a2fcSFrank Schaefer if (v4l2->clk) { 19952c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 19962c52a2fcSFrank Schaefer v4l2->clk = NULL; 199725dd1652SFrank Schaefer } 199825dd1652SFrank Schaefer 199995d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 200095d2608bSFrank Schaefer 2001ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 200295d2608bSFrank Schaefer 200347677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 20045ad10de6SFrank Schaefer 200501c28193SMauro Carvalho Chehab return 0; 20060c0d06caSMauro Carvalho Chehab } 20070c0d06caSMauro Carvalho Chehab 2008a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2009a61f6811SShuah Khan { 2010a61f6811SShuah Khan if (dev->is_audio_only) 2011a61f6811SShuah Khan return 0; 2012a61f6811SShuah Khan 2013a61f6811SShuah Khan if (!dev->has_video) 2014a61f6811SShuah Khan return 0; 2015a61f6811SShuah Khan 2016a61f6811SShuah Khan em28xx_info("Suspending video extension"); 2017a61f6811SShuah Khan em28xx_stop_urbs(dev); 2018a61f6811SShuah Khan return 0; 2019a61f6811SShuah Khan } 2020a61f6811SShuah Khan 2021a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2022a61f6811SShuah Khan { 2023a61f6811SShuah Khan if (dev->is_audio_only) 2024a61f6811SShuah Khan return 0; 2025a61f6811SShuah Khan 2026a61f6811SShuah Khan if (!dev->has_video) 2027a61f6811SShuah Khan return 0; 2028a61f6811SShuah Khan 2029a61f6811SShuah Khan em28xx_info("Resuming video extension"); 2030a61f6811SShuah Khan /* what do we do here */ 2031a61f6811SShuah Khan return 0; 2032a61f6811SShuah Khan } 2033a61f6811SShuah Khan 20340c0d06caSMauro Carvalho Chehab /* 20350c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 20360c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 20370c0d06caSMauro Carvalho Chehab * calls and ioctls 20380c0d06caSMauro Carvalho Chehab */ 20390c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 20400c0d06caSMauro Carvalho Chehab { 20410c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 20420c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 204395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20440c0d06caSMauro Carvalho Chehab int errCode; 20450c0d06caSMauro Carvalho Chehab 20460c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 20470c0d06caSMauro Carvalho Chehab 2048d3829fadSDevin Heitmueller vb2_fop_release(filp); 204998c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 20500c0d06caSMauro Carvalho Chehab 20510c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 205247677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 205347677e51SMauro Carvalho Chehab if (dev->disconnected) 205401c28193SMauro Carvalho Chehab goto exit; 20550c0d06caSMauro Carvalho Chehab 20560c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 205795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 20580c0d06caSMauro Carvalho Chehab 20590c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 20600c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 20610c0d06caSMauro Carvalho Chehab 20620c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 20630c0d06caSMauro Carvalho Chehab dev->alt = 0; 20640c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 20650c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 20660c0d06caSMauro Carvalho Chehab if (errCode < 0) { 20670c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 20680c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 20690c0d06caSMauro Carvalho Chehab } 20700c0d06caSMauro Carvalho Chehab } 20710c0d06caSMauro Carvalho Chehab 207201c28193SMauro Carvalho Chehab exit: 207395d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 20740c0d06caSMauro Carvalho Chehab dev->users--; 20750c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 207647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 207747677e51SMauro Carvalho Chehab 20780c0d06caSMauro Carvalho Chehab return 0; 20790c0d06caSMauro Carvalho Chehab } 20800c0d06caSMauro Carvalho Chehab 20810c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 20820c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20830c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20840c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2085d3829fadSDevin Heitmueller .read = vb2_fop_read, 2086d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2087d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 20880c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20890c0d06caSMauro Carvalho Chehab }; 20900c0d06caSMauro Carvalho Chehab 20910c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 20920c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 20930c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 20940c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 20950c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 20960c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 20970c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20982a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2099aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 21000c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 21010c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 21020c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 21030c0d06caSMauro Carvalho Chehab 2104d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2105d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2106d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2107d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2108d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2109d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2110d3829fadSDevin Heitmueller 21110c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 21120c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 21130c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 21140c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 21150c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 21160c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 21170c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 21180c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2119d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2120d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 21210c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 21220c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 21230c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21240c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 212550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 212650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21270c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 212896b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 21290c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21300c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21310c0d06caSMauro Carvalho Chehab #endif 21320c0d06caSMauro Carvalho Chehab }; 21330c0d06caSMauro Carvalho Chehab 21340c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 21350c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 21360c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2137ef74a0b9SFrank Schaefer .release = video_device_release, 21380c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 21390c0d06caSMauro Carvalho Chehab }; 21400c0d06caSMauro Carvalho Chehab 21410c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 21420c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 21430c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 21440c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 21450c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 21460c0d06caSMauro Carvalho Chehab }; 21470c0d06caSMauro Carvalho Chehab 21480c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2149a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 21500c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 21510c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 21520c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 21530c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 215450fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 215550fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 21560c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2157430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 21580c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 21590c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 21600c0d06caSMauro Carvalho Chehab #endif 21610c0d06caSMauro Carvalho Chehab }; 21620c0d06caSMauro Carvalho Chehab 21630c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 21640c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 21650c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2166ef74a0b9SFrank Schaefer .release = video_device_release, 21670c0d06caSMauro Carvalho Chehab }; 21680c0d06caSMauro Carvalho Chehab 2169b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2170b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2171b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2172b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2173b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2174b64f8e9aSMauro Carvalho Chehab 2175b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2176b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2177b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2178b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2179b64f8e9aSMauro Carvalho Chehab }; 2180b64f8e9aSMauro Carvalho Chehab 2181b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2182b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2183b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2184b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2185b64f8e9aSMauro Carvalho Chehab }; 2186b64f8e9aSMauro Carvalho Chehab 21870c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 21880c0d06caSMauro Carvalho Chehab 21890c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 21900c0d06caSMauro Carvalho Chehab const struct video_device *template, 21910c0d06caSMauro Carvalho Chehab const char *type_name) 21920c0d06caSMauro Carvalho Chehab { 21930c0d06caSMauro Carvalho Chehab struct video_device *vfd; 21940c0d06caSMauro Carvalho Chehab 21950c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 21960c0d06caSMauro Carvalho Chehab if (NULL == vfd) 21970c0d06caSMauro Carvalho Chehab return NULL; 21980c0d06caSMauro Carvalho Chehab 21990c0d06caSMauro Carvalho Chehab *vfd = *template; 220095d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 22010c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 22020c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 220369a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 2204d8c95c08SHans Verkuil if (dev->board.is_webcam) 2205d8c95c08SHans Verkuil vfd->tvnorms = 0; 22060c0d06caSMauro Carvalho Chehab 22070c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 22080c0d06caSMauro Carvalho Chehab dev->name, type_name); 22090c0d06caSMauro Carvalho Chehab 22100c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 22110c0d06caSMauro Carvalho Chehab return vfd; 22120c0d06caSMauro Carvalho Chehab } 22130c0d06caSMauro Carvalho Chehab 221401c28193SMauro Carvalho Chehab static void em28xx_tuner_setup(struct em28xx *dev) 22150560f337SMauro Carvalho Chehab { 221695d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 22170560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 22180560f337SMauro Carvalho Chehab struct v4l2_frequency f; 22190560f337SMauro Carvalho Chehab 22200560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_ABSENT) 22210560f337SMauro Carvalho Chehab return; 22220560f337SMauro Carvalho Chehab 22230560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 22240560f337SMauro Carvalho Chehab 22250560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 22260560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 22270560f337SMauro Carvalho Chehab 22280560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 22290560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 22300560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 22310560f337SMauro Carvalho Chehab 223295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 223395d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22340560f337SMauro Carvalho Chehab } 22350560f337SMauro Carvalho Chehab 22360560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 22370560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 22380560f337SMauro Carvalho Chehab tun_setup.addr = dev->tuner_addr; 22390560f337SMauro Carvalho Chehab 224095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 224195d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 22420560f337SMauro Carvalho Chehab } 22430560f337SMauro Carvalho Chehab 22440560f337SMauro Carvalho Chehab if (dev->tda9887_conf) { 22450560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 22460560f337SMauro Carvalho Chehab 22470560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 22480560f337SMauro Carvalho Chehab tda9887_cfg.priv = &dev->tda9887_conf; 22490560f337SMauro Carvalho Chehab 225095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 225195d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 22520560f337SMauro Carvalho Chehab } 22530560f337SMauro Carvalho Chehab 22540560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 22550560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 22560560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 22570560f337SMauro Carvalho Chehab 22580560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 22590560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 22600560f337SMauro Carvalho Chehab 22610560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 22620560f337SMauro Carvalho Chehab 22630560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 22640560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 22650560f337SMauro Carvalho Chehab 226695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 22670560f337SMauro Carvalho Chehab } 22680560f337SMauro Carvalho Chehab 22690560f337SMauro Carvalho Chehab /* configure tuner */ 22700560f337SMauro Carvalho Chehab f.tuner = 0; 22710560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 22720560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 22730560f337SMauro Carvalho Chehab dev->ctl_freq = f.frequency; 227495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 22750560f337SMauro Carvalho Chehab } 22760560f337SMauro Carvalho Chehab 227701c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 22780c0d06caSMauro Carvalho Chehab { 22790c0d06caSMauro Carvalho Chehab u8 val; 22800c0d06caSMauro Carvalho Chehab int ret; 22810c0d06caSMauro Carvalho Chehab unsigned int maxw; 2282abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 228395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2284b64f8e9aSMauro Carvalho Chehab 2285822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2286822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2287822b8deaSMauro Carvalho Chehab return 0; 2288822b8deaSMauro Carvalho Chehab } 2289822b8deaSMauro Carvalho Chehab 229001c28193SMauro Carvalho Chehab if (!dev->has_video) { 2291b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2292b64f8e9aSMauro Carvalho Chehab return 0; 2293b64f8e9aSMauro Carvalho Chehab } 22940c0d06caSMauro Carvalho Chehab 22959634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 22960c0d06caSMauro Carvalho Chehab 229701c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 229801c28193SMauro Carvalho Chehab 229995d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 230095d2608bSFrank Schaefer if (v4l2 == NULL) { 230195d2608bSFrank Schaefer em28xx_info("em28xx_v4l: memory allocation failed\n"); 230295d2608bSFrank Schaefer mutex_unlock(&dev->lock); 230395d2608bSFrank Schaefer return -ENOMEM; 230495d2608bSFrank Schaefer } 230595d2608bSFrank Schaefer kref_init(&v4l2->ref); 2306abc1308fSFrank Schaefer v4l2->dev = dev; 230795d2608bSFrank Schaefer dev->v4l2 = v4l2; 230895d2608bSFrank Schaefer 230995d2608bSFrank Schaefer ret = v4l2_device_register(&dev->udev->dev, &v4l2->v4l2_dev); 2310b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2311b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2312b64f8e9aSMauro Carvalho Chehab goto err; 2313b64f8e9aSMauro Carvalho Chehab } 2314b64f8e9aSMauro Carvalho Chehab 2315abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2316b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 231795d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2318b64f8e9aSMauro Carvalho Chehab 231958159171SFrank Schaefer if (dev->board.is_webcam) 232058159171SFrank Schaefer v4l2->progressive = 1; 232158159171SFrank Schaefer 2322b64f8e9aSMauro Carvalho Chehab /* 2323b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2324b64f8e9aSMauro Carvalho Chehab */ 23259297285eSFrank Schaefer v4l2->vinmode = 0x10; 23269297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2327b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2328b64f8e9aSMauro Carvalho Chehab 2329b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2330b64f8e9aSMauro Carvalho Chehab 2331b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 233295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 233395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2334b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2335b64f8e9aSMauro Carvalho Chehab 2336b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 233795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 233895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2339b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2340b64f8e9aSMauro Carvalho Chehab 2341b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 234295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2344b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2345b64f8e9aSMauro Carvalho Chehab 2346b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 234795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 234895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2349b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2350b64f8e9aSMauro Carvalho Chehab 2351b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2352b64f8e9aSMauro Carvalho Chehab 2353b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 2354b64f8e9aSMauro Carvalho Chehab int has_demod = (dev->tda9887_conf & TDA9887_PRESENT); 2355b64f8e9aSMauro Carvalho Chehab 2356b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 235795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 235895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2359b64f8e9aSMauro Carvalho Chehab "tuner", dev->board.radio_addr, NULL); 2360b64f8e9aSMauro Carvalho Chehab 2361b64f8e9aSMauro Carvalho Chehab if (has_demod) 236295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2363b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2364b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 2365b64f8e9aSMauro Carvalho Chehab if (dev->tuner_addr == 0) { 2366b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2367b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2368b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2369b64f8e9aSMauro Carvalho Chehab 237095d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2371b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2372b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(type)); 2373b64f8e9aSMauro Carvalho Chehab 2374b64f8e9aSMauro Carvalho Chehab if (sd) 2375b64f8e9aSMauro Carvalho Chehab dev->tuner_addr = v4l2_i2c_subdev_addr(sd); 2376b64f8e9aSMauro Carvalho Chehab } else { 237795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 237895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2379b64f8e9aSMauro Carvalho Chehab "tuner", dev->tuner_addr, NULL); 2380b64f8e9aSMauro Carvalho Chehab } 2381b64f8e9aSMauro Carvalho Chehab } 2382b64f8e9aSMauro Carvalho Chehab 2383b64f8e9aSMauro Carvalho Chehab em28xx_tuner_setup(dev); 2384d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2385b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2386b64f8e9aSMauro Carvalho Chehab 2387b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2388b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2389b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2390b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2391b64f8e9aSMauro Carvalho Chehab __func__, ret); 2392b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2393b64f8e9aSMauro Carvalho Chehab } 2394b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2395b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2396b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2397b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2398b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2399b64f8e9aSMauro Carvalho Chehab } else { 2400b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2401b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2402b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2403b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2404b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2405b64f8e9aSMauro Carvalho Chehab } 2406b64f8e9aSMauro Carvalho Chehab 2407b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2408b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2409b64f8e9aSMauro Carvalho Chehab 2410b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2411b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2412b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2413b64f8e9aSMauro Carvalho Chehab 2414b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2415b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2416b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2417b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2418b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2419b64f8e9aSMauro Carvalho Chehab __func__, ret); 2420b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2421b64f8e9aSMauro Carvalho Chehab } 2422b64f8e9aSMauro Carvalho Chehab msleep(3); 2423b64f8e9aSMauro Carvalho Chehab 2424b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2425b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2426b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) 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 24330c0d06caSMauro Carvalho Chehab /* set default norm */ 243452faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 243552faaf78SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_std, v4l2->norm); 243658159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 24370c0d06caSMauro Carvalho Chehab 24380c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 243906e20672SFrank Schaefer v4l2->format = &format[0]; 24400c0d06caSMauro Carvalho Chehab 24410c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 24420c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 24430c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 24440c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 24450c0d06caSMauro Carvalho Chehab maxw /= 2; 24460c0d06caSMauro Carvalho Chehab 24470c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 24480c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 24490c0d06caSMauro Carvalho Chehab 24500c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 24510c0d06caSMauro Carvalho Chehab 24520c0d06caSMauro Carvalho Chehab /* Audio defaults */ 24530c0d06caSMauro Carvalho Chehab dev->mute = 1; 24540c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 24550c0d06caSMauro Carvalho Chehab 24560c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 24570c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 24580c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 24590c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 24600c0d06caSMauro Carvalho Chehab 24610c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 24620c0d06caSMauro Carvalho Chehab 24638f8b113aSFrank Schaefer /* Add image controls */ 24648f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 24658f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2466ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2467ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24688f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 24698f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2470ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2471ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24728f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 24738f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2474ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2475ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24768f8b113aSFrank Schaefer V4L2_CID_SATURATION, 24778f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2478ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2479ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24808f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 24818f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2482ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2483ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24848f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 24858f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2486ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2487ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 24888f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 24898f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 24908f8b113aSFrank Schaefer 24918f8b113aSFrank Schaefer /* Reset image controls */ 24928f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2493ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2494ad298055SFrank Schaefer ret = hdl->error; 2495b64f8e9aSMauro Carvalho Chehab if (ret) 2496b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24978f8b113aSFrank Schaefer 24980c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2499ef74a0b9SFrank Schaefer v4l2->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 2500ef74a0b9SFrank Schaefer if (!v4l2->vdev) { 25010c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2502b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2503b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25040c0d06caSMauro Carvalho Chehab } 250527a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 250627a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 250727a36df6SFrank Schaefer v4l2->vdev->queue = &v4l2->vb_vidq; 250827a36df6SFrank Schaefer v4l2->vdev->queue->lock = &v4l2->vb_queue_lock; 25090c0d06caSMauro Carvalho Chehab 25106e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 25116e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2512ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_QUERYSTD); 2513ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_STD); 2514ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_STD); 25153bc85cceSFrank Schaefer } else { 2516ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 25176e46dabaSFrank Schaefer } 251866df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2519ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_TUNER); 2520ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_TUNER); 2521ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_FREQUENCY); 2522ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_FREQUENCY); 252366df67b7SFrank Schaefer } 2524c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2525ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_G_AUDIO); 2526ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_AUDIO); 2527c2dcef83SFrank Schaefer } 25286e46dabaSFrank Schaefer 25290c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2530ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vdev, VFL_TYPE_GRABBER, 25310c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 25320c0d06caSMauro Carvalho Chehab if (ret) { 25330c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 25340c0d06caSMauro Carvalho Chehab ret); 2535b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25360c0d06caSMauro Carvalho Chehab } 25370c0d06caSMauro Carvalho Chehab 25380c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 25390c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2540ef74a0b9SFrank Schaefer v4l2->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 25410c0d06caSMauro Carvalho Chehab "vbi"); 25420c0d06caSMauro Carvalho Chehab 254327a36df6SFrank Schaefer v4l2->vbi_dev->queue = &v4l2->vb_vbiq; 254427a36df6SFrank Schaefer v4l2->vbi_dev->queue->lock = &v4l2->vb_vbi_queue_lock; 2545d3829fadSDevin Heitmueller 254666df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2547ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vdev, VIDIOC_S_PARM); 254866df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2549ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_TUNER); 2550ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_TUNER); 2551ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2552ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 255366df67b7SFrank Schaefer } 2554c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2555ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_G_AUDIO); 2556ef74a0b9SFrank Schaefer v4l2_disable_ioctl(v4l2->vbi_dev, VIDIOC_S_AUDIO); 2557c2dcef83SFrank Schaefer } 255866df67b7SFrank Schaefer 25590c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2560ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->vbi_dev, VFL_TYPE_VBI, 25610c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 25620c0d06caSMauro Carvalho Chehab if (ret < 0) { 25630c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2564b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25650c0d06caSMauro Carvalho Chehab } 25660c0d06caSMauro Carvalho Chehab } 25670c0d06caSMauro Carvalho Chehab 25680c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2569ef74a0b9SFrank Schaefer v4l2->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 25700c0d06caSMauro Carvalho Chehab "radio"); 2571ef74a0b9SFrank Schaefer if (!v4l2->radio_dev) { 25720c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2573b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2574b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25750c0d06caSMauro Carvalho Chehab } 2576ef74a0b9SFrank Schaefer ret = video_register_device(v4l2->radio_dev, VFL_TYPE_RADIO, 25770c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 25780c0d06caSMauro Carvalho Chehab if (ret < 0) { 25790c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2580b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 25810c0d06caSMauro Carvalho Chehab } 25820c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 2583ef74a0b9SFrank Schaefer video_device_node_name(v4l2->radio_dev)); 25840c0d06caSMauro Carvalho Chehab } 25850c0d06caSMauro Carvalho Chehab 25860c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 2587ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vdev)); 25880c0d06caSMauro Carvalho Chehab 2589ef74a0b9SFrank Schaefer if (v4l2->vbi_dev) 25900c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 2591ef74a0b9SFrank Schaefer video_device_node_name(v4l2->vbi_dev)); 25920c0d06caSMauro Carvalho Chehab 2593b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 259495d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2595b64f8e9aSMauro Carvalho Chehab 2596b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2597b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2598b64f8e9aSMauro Carvalho Chehab 25999634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 26009634614fSMauro Carvalho Chehab 260147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 260247677e51SMauro Carvalho Chehab 260301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 26040c0d06caSMauro Carvalho Chehab return 0; 2605b64f8e9aSMauro Carvalho Chehab 2606b64f8e9aSMauro Carvalho Chehab unregister_dev: 2607abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 260895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2609b64f8e9aSMauro Carvalho Chehab err: 261095d2608bSFrank Schaefer dev->v4l2 = NULL; 261195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 261201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2613b64f8e9aSMauro Carvalho Chehab return ret; 26140c0d06caSMauro Carvalho Chehab } 261501c28193SMauro Carvalho Chehab 261601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 261701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 261801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 261901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 262001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2621a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2622a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 262301c28193SMauro Carvalho Chehab }; 262401c28193SMauro Carvalho Chehab 262501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 262601c28193SMauro Carvalho Chehab { 262701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 262801c28193SMauro Carvalho Chehab } 262901c28193SMauro Carvalho Chehab 263001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 263101c28193SMauro Carvalho Chehab { 263201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 263301c28193SMauro Carvalho Chehab } 263401c28193SMauro Carvalho Chehab 263501c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 263601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2637