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 14401c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1450560f337SMauro Carvalho Chehab { 1460560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1470560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1480560f337SMauro Carvalho Chehab return 0; 1490560f337SMauro Carvalho Chehab 1500560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1510560f337SMauro Carvalho Chehab return 0; 1520560f337SMauro Carvalho Chehab 1530560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1540560f337SMauro Carvalho Chehab 1550560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1560560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1570560f337SMauro Carvalho Chehab return 1; 1580560f337SMauro Carvalho Chehab 1590560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1600560f337SMauro Carvalho Chehab return 0; 1610560f337SMauro Carvalho Chehab } 1620560f337SMauro Carvalho Chehab 1630560f337SMauro Carvalho Chehab /* 1640560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1650560f337SMauro Carvalho Chehab * configure i2c attached devices 1660560f337SMauro Carvalho Chehab */ 16701c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1680560f337SMauro Carvalho Chehab { 1690560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, reset, 0); 1700560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 1710560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 1720560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_stream, 0); 1730560f337SMauro Carvalho Chehab } 1740560f337SMauro Carvalho Chehab 17501c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 1760560f337SMauro Carvalho Chehab { 1770560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 1780560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 1790560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 1800560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 1810560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 1820560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 1830560f337SMauro Carvalho Chehab 1840560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 1850560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 1860560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 1870560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 1880560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 1890560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 1900560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 1910560f337SMauro Carvalho Chehab } 1920560f337SMauro Carvalho Chehab 19301c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 1940560f337SMauro Carvalho Chehab { 1950560f337SMauro Carvalho Chehab int ret; 1960560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 1970560f337SMauro Carvalho Chehab 1980560f337SMauro Carvalho Chehab fmt = dev->format->reg; 1990560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2000560f337SMauro Carvalho Chehab fmt |= 0x20; 2010560f337SMauro Carvalho Chehab /* 2020560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2030560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2040560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2050560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2060560f337SMauro Carvalho Chehab * 2070560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2080560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2090560f337SMauro Carvalho Chehab */ 2100560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2110560f337SMauro Carvalho Chehab if (ret < 0) 2120560f337SMauro Carvalho Chehab return ret; 2130560f337SMauro Carvalho Chehab 2140560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, dev->vinmode); 2150560f337SMauro Carvalho Chehab if (ret < 0) 2160560f337SMauro Carvalho Chehab return ret; 2170560f337SMauro Carvalho Chehab 2180560f337SMauro Carvalho Chehab vinctrl = dev->vinctl; 2190560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2200560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2210560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 2220560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, dev->vbi_width/4); 2230560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, dev->vbi_height); 2240560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 2250560f337SMauro Carvalho Chehab /* NTSC */ 2260560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 2270560f337SMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 2280560f337SMauro Carvalho Chehab /* PAL */ 2290560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2300560f337SMauro Carvalho Chehab } 2310560f337SMauro Carvalho Chehab } 2320560f337SMauro Carvalho Chehab 2330560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2340560f337SMauro Carvalho Chehab } 2350560f337SMauro Carvalho Chehab 2360560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2370560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2380560f337SMauro Carvalho Chehab { 2390560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2400560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2410560f337SMauro Carvalho Chehab 2420560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2430560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2440560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2450560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2460560f337SMauro Carvalho Chehab } 2470560f337SMauro Carvalho Chehab 2480560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2490560f337SMauro Carvalho Chehab u16 width, u16 height) 2500560f337SMauro Carvalho Chehab { 2510560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2520560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2530560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2540560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2550560f337SMauro Carvalho Chehab 2560560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2570560f337SMauro Carvalho Chehab hstart, vstart, 2580560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2590560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2600560f337SMauro Carvalho Chehab 2610560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2620560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2630560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2640560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2650560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2660560f337SMauro Carvalho Chehab 2670560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2680560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2690560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2700560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2710560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2720560f337SMauro Carvalho Chehab } 2730560f337SMauro Carvalho Chehab } 2740560f337SMauro Carvalho Chehab 2750560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 2760560f337SMauro Carvalho Chehab { 2770560f337SMauro Carvalho Chehab u8 mode; 2780560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 2790560f337SMauro Carvalho Chehab 2800560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 2810560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 2820560f337SMauro Carvalho Chehab } else { 2830560f337SMauro Carvalho Chehab u8 buf[2]; 2840560f337SMauro Carvalho Chehab 2850560f337SMauro Carvalho Chehab buf[0] = h; 2860560f337SMauro Carvalho Chehab buf[1] = h >> 8; 2870560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 2880560f337SMauro Carvalho Chehab 2890560f337SMauro Carvalho Chehab buf[0] = v; 2900560f337SMauro Carvalho Chehab buf[1] = v >> 8; 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 2920560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 2930560f337SMauro Carvalho Chehab to work correctly */ 2940560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 2950560f337SMauro Carvalho Chehab } 2960560f337SMauro Carvalho Chehab return em28xx_write_reg_bits(dev, EM28XX_R26_COMPR, mode, 0x30); 2970560f337SMauro Carvalho Chehab } 2980560f337SMauro Carvalho Chehab 2990560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 30001c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3010560f337SMauro Carvalho Chehab { 3020560f337SMauro Carvalho Chehab int width, height; 3030560f337SMauro Carvalho Chehab width = norm_maxw(dev); 3040560f337SMauro Carvalho Chehab height = norm_maxh(dev); 3050560f337SMauro Carvalho Chehab 3060560f337SMauro Carvalho Chehab /* Properly setup VBI */ 3070560f337SMauro Carvalho Chehab dev->vbi_width = 720; 3080560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) 3090560f337SMauro Carvalho Chehab dev->vbi_height = 12; 3100560f337SMauro Carvalho Chehab else 3110560f337SMauro Carvalho Chehab dev->vbi_height = 18; 3120560f337SMauro Carvalho Chehab 3130560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3140560f337SMauro Carvalho Chehab 3150560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3160560f337SMauro Carvalho Chehab 3170560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3180560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3190560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3200560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3210560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3220560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3230560f337SMauro Carvalho Chehab region */ 3240560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3250560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3260560f337SMauro Carvalho Chehab else 3270560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3280560f337SMauro Carvalho Chehab 3290560f337SMauro Carvalho Chehab return em28xx_scaler_set(dev, dev->hscale, dev->vscale); 3300560f337SMauro Carvalho Chehab } 3310560f337SMauro Carvalho Chehab 3320560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 33301c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3340560f337SMauro Carvalho Chehab { 3350560f337SMauro Carvalho Chehab int errCode; 3360560f337SMauro Carvalho Chehab int i; 3370560f337SMauro Carvalho Chehab unsigned int min_pkt_size = dev->width * 2 + 4; 3380560f337SMauro Carvalho Chehab 3390560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3400560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3410560f337SMauro Carvalho Chehab dev->alt = 0; 3420560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3430560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3440560f337SMauro Carvalho Chehab dev->alt = alt; 3450560f337SMauro Carvalho Chehab goto set_alt; 3460560f337SMauro Carvalho Chehab } 3470560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3480560f337SMauro Carvalho Chehab goto set_alt; 3490560f337SMauro Carvalho Chehab 3500560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3510560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3520560f337SMauro Carvalho Chehab green screen will be received. 3530560f337SMauro Carvalho Chehab */ 3540560f337SMauro Carvalho Chehab if (dev->width * 2 * dev->height > 720 * 240 * 2) 3550560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3560560f337SMauro Carvalho Chehab 3570560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3580560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3590560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3600560f337SMauro Carvalho Chehab dev->alt = i; 3610560f337SMauro Carvalho Chehab break; 3620560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3630560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3640560f337SMauro Carvalho Chehab */ 3650560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3660560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3670560f337SMauro Carvalho Chehab dev->alt = i; 3680560f337SMauro Carvalho Chehab } 3690560f337SMauro Carvalho Chehab 3700560f337SMauro Carvalho Chehab set_alt: 3710560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 3720560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 3730560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 3740560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 3750560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 3760560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 3770560f337SMauro Carvalho Chehab } else { /* isoc */ 3780560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 3790560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 3800560f337SMauro Carvalho Chehab dev->max_pkt_size = 3810560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 3820560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 3830560f337SMauro Carvalho Chehab } 3840560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 3850560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 386961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 3870560f337SMauro Carvalho Chehab if (errCode < 0) { 3880560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 3890560f337SMauro Carvalho Chehab dev->alt, errCode); 3900560f337SMauro Carvalho Chehab return errCode; 3910560f337SMauro Carvalho Chehab } 3920560f337SMauro Carvalho Chehab return 0; 3930560f337SMauro Carvalho Chehab } 3940560f337SMauro Carvalho Chehab 3950c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 3960c0d06caSMauro Carvalho Chehab DMA and thread functions 3970c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 3980c0d06caSMauro Carvalho Chehab 3990c0d06caSMauro Carvalho Chehab /* 400948a49aaSFrank Schaefer * Finish the current buffer 4010c0d06caSMauro Carvalho Chehab */ 402948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4030c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4040c0d06caSMauro Carvalho Chehab { 405d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 406d3829fadSDevin Heitmueller 407d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 408d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 409d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 410d3829fadSDevin Heitmueller 411d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4120c0d06caSMauro Carvalho Chehab } 4130c0d06caSMauro Carvalho Chehab 4140c0d06caSMauro Carvalho Chehab /* 41536016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4160c0d06caSMauro Carvalho Chehab */ 4170c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4180c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 41936016a35SFrank Schaefer unsigned char *usb_buf, 4204078d625SFrank Schaefer unsigned long len) 4210c0d06caSMauro Carvalho Chehab { 4220c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4230c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 4240c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 4250c0d06caSMauro Carvalho Chehab 426d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 427d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4280c0d06caSMauro Carvalho Chehab 42936016a35SFrank Schaefer startread = usb_buf; 4300c0d06caSMauro Carvalho Chehab remain = len; 4310c0d06caSMauro Carvalho Chehab 432c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 43336016a35SFrank Schaefer fieldstart = buf->vb_buf; 434c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 43536016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4360c0d06caSMauro Carvalho Chehab 4378732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4388732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4390c0d06caSMauro Carvalho Chehab 4400c0d06caSMauro Carvalho Chehab if (dev->progressive) 4410c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4420c0d06caSMauro Carvalho Chehab else 4430c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4440c0d06caSMauro Carvalho Chehab 4450c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4460c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4470c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4480c0d06caSMauro Carvalho Chehab 449d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4500c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 4510c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 452d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 453d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 45436016a35SFrank Schaefer (char *)startwrite; 4550c0d06caSMauro Carvalho Chehab lencopy = remain; 4560c0d06caSMauro Carvalho Chehab } 4570c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4580c0d06caSMauro Carvalho Chehab return; 4590c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4600c0d06caSMauro Carvalho Chehab 4610c0d06caSMauro Carvalho Chehab remain -= lencopy; 4620c0d06caSMauro Carvalho Chehab 4630c0d06caSMauro Carvalho Chehab while (remain > 0) { 464c02ec71bSFrank Schaefer if (dev->progressive) 465c02ec71bSFrank Schaefer startwrite += lencopy; 466c02ec71bSFrank Schaefer else 4670c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 4680c0d06caSMauro Carvalho Chehab startread += lencopy; 4690c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 4700c0d06caSMauro Carvalho Chehab lencopy = remain; 4710c0d06caSMauro Carvalho Chehab else 4720c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 4730c0d06caSMauro Carvalho Chehab 47436016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 475d3829fadSDevin Heitmueller buf->length) { 4760c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 4770c0d06caSMauro Carvalho Chehab "(2)\n", 4780c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 479d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 480d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 4810c0d06caSMauro Carvalho Chehab (char *)startwrite; 4820c0d06caSMauro Carvalho Chehab } 4830c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4840c0d06caSMauro Carvalho Chehab break; 4850c0d06caSMauro Carvalho Chehab 4860c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4870c0d06caSMauro Carvalho Chehab 4880c0d06caSMauro Carvalho Chehab remain -= lencopy; 4890c0d06caSMauro Carvalho Chehab } 4900c0d06caSMauro Carvalho Chehab 4918732533bSFrank Schaefer buf->pos += len; 4920c0d06caSMauro Carvalho Chehab } 4930c0d06caSMauro Carvalho Chehab 49436016a35SFrank Schaefer /* 49536016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 49636016a35SFrank Schaefer */ 4970c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 4980c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 49936016a35SFrank Schaefer unsigned char *usb_buf, 5004078d625SFrank Schaefer unsigned long len) 5010c0d06caSMauro Carvalho Chehab { 50236016a35SFrank Schaefer unsigned int offset; 5030c0d06caSMauro Carvalho Chehab 504d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 505d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5060c0d06caSMauro Carvalho Chehab 5078732533bSFrank Schaefer offset = buf->pos; 5080c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 50936016a35SFrank Schaefer if (buf->top_field == 0) 51036016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 5110c0d06caSMauro Carvalho Chehab 51236016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5138732533bSFrank Schaefer buf->pos += len; 5140c0d06caSMauro Carvalho Chehab } 5150c0d06caSMauro Carvalho Chehab 5160c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5170c0d06caSMauro Carvalho Chehab int packet, int status) 5180c0d06caSMauro Carvalho Chehab { 5190c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5200c0d06caSMauro Carvalho Chehab 5210c0d06caSMauro Carvalho Chehab switch (status) { 5220c0d06caSMauro Carvalho Chehab case -ENOENT: 5230c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5240c0d06caSMauro Carvalho Chehab break; 5250c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5260c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5270c0d06caSMauro Carvalho Chehab break; 5280c0d06caSMauro Carvalho Chehab case -ENOSR: 5290c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5300c0d06caSMauro Carvalho Chehab break; 5310c0d06caSMauro Carvalho Chehab case -EPIPE: 5320c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5330c0d06caSMauro Carvalho Chehab break; 5340c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5350c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5360c0d06caSMauro Carvalho Chehab break; 5370c0d06caSMauro Carvalho Chehab case -EPROTO: 5380c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5390c0d06caSMauro Carvalho Chehab break; 5400c0d06caSMauro Carvalho Chehab case -EILSEQ: 5410c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5420c0d06caSMauro Carvalho Chehab break; 5430c0d06caSMauro Carvalho Chehab case -ETIME: 5440c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5450c0d06caSMauro Carvalho Chehab break; 5460c0d06caSMauro Carvalho Chehab } 5470c0d06caSMauro Carvalho Chehab if (packet < 0) { 5480c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5490c0d06caSMauro Carvalho Chehab } else { 5500c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5510c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5520c0d06caSMauro Carvalho Chehab } 5530c0d06caSMauro Carvalho Chehab } 5540c0d06caSMauro Carvalho Chehab 5550c0d06caSMauro Carvalho Chehab /* 55624a6d849SFrank Schaefer * get the next available buffer from dma queue 5570c0d06caSMauro Carvalho Chehab */ 55824a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 55924a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5600c0d06caSMauro Carvalho Chehab { 56124a6d849SFrank Schaefer struct em28xx_buffer *buf; 5620c0d06caSMauro Carvalho Chehab 5630c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5640c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 56524a6d849SFrank Schaefer return NULL; 5660c0d06caSMauro Carvalho Chehab } 5670c0d06caSMauro Carvalho Chehab 5680c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 569d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 5700c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 571d3829fadSDevin Heitmueller list_del(&buf->list); 5728732533bSFrank Schaefer buf->pos = 0; 573d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 5740c0d06caSMauro Carvalho Chehab 57524a6d849SFrank Schaefer return buf; 5760c0d06caSMauro Carvalho Chehab } 5770c0d06caSMauro Carvalho Chehab 578e04c00d9SFrank Schaefer /* 579e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 580e04c00d9SFrank Schaefer */ 581e04c00d9SFrank Schaefer static struct em28xx_buffer * 582e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 583e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 584e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 585e04c00d9SFrank Schaefer { 586e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 587e04c00d9SFrank Schaefer if (buf != NULL) 588e04c00d9SFrank Schaefer finish_buffer(dev, buf); 589e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 590e04c00d9SFrank Schaefer } 591e04c00d9SFrank Schaefer if (buf != NULL) { 592e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 593e04c00d9SFrank Schaefer buf->pos = 0; 594e04c00d9SFrank Schaefer } 595e04c00d9SFrank Schaefer 596e04c00d9SFrank Schaefer return buf; 597e04c00d9SFrank Schaefer } 598e04c00d9SFrank Schaefer 599227b7c90SFrank Schaefer /* 600227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 601227b7c90SFrank Schaefer */ 602227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 603227b7c90SFrank Schaefer unsigned char *data_pkt, 604227b7c90SFrank Schaefer unsigned int data_len) 605227b7c90SFrank Schaefer { 606227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 607227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 608227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 609227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 610227b7c90SFrank Schaefer 611227b7c90SFrank Schaefer /* capture type 0 = vbi start 612227b7c90SFrank Schaefer capture type 1 = vbi in progress 613227b7c90SFrank Schaefer capture type 2 = video start 614227b7c90SFrank Schaefer capture type 3 = video in progress */ 615227b7c90SFrank Schaefer if (data_len >= 4) { 616227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 617227b7c90SFrank Schaefer * never split across packets */ 618227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 619227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 620227b7c90SFrank Schaefer /* Continuation */ 621227b7c90SFrank Schaefer data_pkt += 4; 622227b7c90SFrank Schaefer data_len -= 4; 623227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 624227b7c90SFrank Schaefer /* Field start (VBI mode) */ 625227b7c90SFrank Schaefer dev->capture_type = 0; 626227b7c90SFrank Schaefer dev->vbi_read = 0; 627227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 628227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 629227b7c90SFrank Schaefer data_pkt += 4; 630227b7c90SFrank Schaefer data_len -= 4; 631227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 632227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 633227b7c90SFrank Schaefer dev->capture_type = 2; 634227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 635227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 636227b7c90SFrank Schaefer data_pkt += 4; 637227b7c90SFrank Schaefer data_len -= 4; 638227b7c90SFrank Schaefer } 639227b7c90SFrank Schaefer } 640227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 641227b7c90SFrank Schaefer * have no continuation header */ 642227b7c90SFrank Schaefer 643227b7c90SFrank Schaefer if (dev->capture_type == 0) { 644227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 645227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 646227b7c90SFrank Schaefer dev->capture_type = 1; 647227b7c90SFrank Schaefer } 648227b7c90SFrank Schaefer 649227b7c90SFrank Schaefer if (dev->capture_type == 1) { 650227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 651227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 652227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 653227b7c90SFrank Schaefer 654227b7c90SFrank Schaefer /* Copy VBI data */ 655227b7c90SFrank Schaefer if (vbi_buf != NULL) 656227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 657227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 658227b7c90SFrank Schaefer 659227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 660227b7c90SFrank Schaefer /* Continue with copying video data */ 661227b7c90SFrank Schaefer dev->capture_type = 2; 662227b7c90SFrank Schaefer data_pkt += vbi_data_len; 663227b7c90SFrank Schaefer data_len -= vbi_data_len; 664227b7c90SFrank Schaefer } 665227b7c90SFrank Schaefer } 666227b7c90SFrank Schaefer 667227b7c90SFrank Schaefer if (dev->capture_type == 2) { 668227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 669227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 670227b7c90SFrank Schaefer dev->capture_type = 3; 671227b7c90SFrank Schaefer } 672227b7c90SFrank Schaefer 673227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 674227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 675227b7c90SFrank Schaefer } 676227b7c90SFrank Schaefer 677e507e0e5SFrank Schaefer /* 678e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 679e507e0e5SFrank Schaefer */ 680e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 681e507e0e5SFrank Schaefer unsigned char *data_pkt, 682e507e0e5SFrank Schaefer unsigned int data_len) 683e507e0e5SFrank Schaefer { 684e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 685e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 686e507e0e5SFrank Schaefer bool frame_end = 0; 687e507e0e5SFrank Schaefer 688e507e0e5SFrank Schaefer /* Check for header */ 689e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 690e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 691e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 692e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 693e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 694e507e0e5SFrank Schaefer dev->top_field = !(data_pkt[1] & 695e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 696e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 697e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 698e507e0e5SFrank Schaefer data_pkt += 2; 699e507e0e5SFrank Schaefer data_len -= 2; 700e507e0e5SFrank Schaefer } 701e507e0e5SFrank Schaefer 702e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 703e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 704e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 705e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 706e507e0e5SFrank Schaefer } 707e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 708e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 709e507e0e5SFrank Schaefer * first frame. 710e507e0e5SFrank Schaefer */ 711e507e0e5SFrank Schaefer } 712e507e0e5SFrank Schaefer 713e507e0e5SFrank Schaefer /* Copy data */ 714e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 715e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 716e507e0e5SFrank Schaefer 717e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 718e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 719e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 720e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 721e507e0e5SFrank Schaefer } 722e507e0e5SFrank Schaefer 723e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 724e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 725e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 726e507e0e5SFrank Schaefer * header like with the other em28xx devices. 727e507e0e5SFrank Schaefer */ 728e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 729e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 730e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 731e507e0e5SFrank Schaefer } 732e507e0e5SFrank Schaefer 733960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7340fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7350c0d06caSMauro Carvalho Chehab { 736227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 737227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 738227b7c90SFrank Schaefer unsigned int usb_data_len; 7390c0d06caSMauro Carvalho Chehab 7400c0d06caSMauro Carvalho Chehab if (!dev) 7410c0d06caSMauro Carvalho Chehab return 0; 7420c0d06caSMauro Carvalho Chehab 7432665c299SFrank Schaefer if (dev->disconnected) 7440c0d06caSMauro Carvalho Chehab return 0; 7450c0d06caSMauro Carvalho Chehab 7461653cb0cSFrank Schaefer if (urb->status < 0) 7470c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7480c0d06caSMauro Carvalho Chehab 7494601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7504601cc39SFrank Schaefer 7514601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7524601cc39SFrank Schaefer num_packets = 1; 7534601cc39SFrank Schaefer else /* isoc */ 7544601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7550c0d06caSMauro Carvalho Chehab 7564601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7574601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 758227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7594601cc39SFrank Schaefer 760227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7614601cc39SFrank Schaefer } else { /* isoc */ 7624601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7634601cc39SFrank Schaefer print_err_status(dev, i, 7644601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 7650c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 7660c0d06caSMauro Carvalho Chehab continue; 7670c0d06caSMauro Carvalho Chehab } 7680c0d06caSMauro Carvalho Chehab 769227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 770227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 7710c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 7720c0d06caSMauro Carvalho Chehab continue; 7730c0d06caSMauro Carvalho Chehab } 7740c0d06caSMauro Carvalho Chehab 775227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 7764601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 7774601cc39SFrank Schaefer } 7784601cc39SFrank Schaefer 779227b7c90SFrank Schaefer if (usb_data_len == 0) { 7804601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 7814601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 7824601cc39SFrank Schaefer continue; 7834601cc39SFrank Schaefer } 7840c0d06caSMauro Carvalho Chehab 785e507e0e5SFrank Schaefer if (dev->is_em25xx) 786e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 787e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 788e507e0e5SFrank Schaefer else 789e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 790e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 791e507e0e5SFrank Schaefer 7920c0d06caSMauro Carvalho Chehab } 793227b7c90SFrank Schaefer return 1; 7940c0d06caSMauro Carvalho Chehab } 7950c0d06caSMauro Carvalho Chehab 7960c0d06caSMauro Carvalho Chehab 797d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 798d3829fadSDevin Heitmueller { 799d3829fadSDevin Heitmueller switch (f_type) { 800d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 801d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 802d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 803d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 804d3829fadSDevin Heitmueller default: 805d3829fadSDevin Heitmueller BUG(); 806d3829fadSDevin Heitmueller return 0; 807d3829fadSDevin Heitmueller } 808d3829fadSDevin Heitmueller } 809d3829fadSDevin Heitmueller 810d3829fadSDevin Heitmueller /* Usage lock check functions */ 811d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 812d3829fadSDevin Heitmueller { 813d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 814d3829fadSDevin Heitmueller 815d3829fadSDevin Heitmueller /* is it free? */ 816d3829fadSDevin Heitmueller if (dev->resources & res_type) { 817d3829fadSDevin Heitmueller /* no, someone else uses it */ 818d3829fadSDevin Heitmueller return -EBUSY; 819d3829fadSDevin Heitmueller } 820d3829fadSDevin Heitmueller 821d3829fadSDevin Heitmueller /* it's free, grab it */ 822d3829fadSDevin Heitmueller dev->resources |= res_type; 823d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 824d3829fadSDevin Heitmueller return 0; 825d3829fadSDevin Heitmueller } 826d3829fadSDevin Heitmueller 827d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 828d3829fadSDevin Heitmueller { 829d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 830d3829fadSDevin Heitmueller 831d3829fadSDevin Heitmueller dev->resources &= ~res_type; 832d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 833d3829fadSDevin Heitmueller } 834d3829fadSDevin Heitmueller 8350c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 836d3829fadSDevin Heitmueller Videobuf2 operations 8370c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8380c0d06caSMauro Carvalho Chehab 839d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 840d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 841d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8420c0d06caSMauro Carvalho Chehab { 843d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 844d3829fadSDevin Heitmueller unsigned long size; 8450c0d06caSMauro Carvalho Chehab 846d3829fadSDevin Heitmueller if (fmt) 847d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 848d3829fadSDevin Heitmueller else 849d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 8500c0d06caSMauro Carvalho Chehab 851d3829fadSDevin Heitmueller if (size == 0) 852d3829fadSDevin Heitmueller return -EINVAL; 8530c0d06caSMauro Carvalho Chehab 854d3829fadSDevin Heitmueller if (0 == *nbuffers) 855d3829fadSDevin Heitmueller *nbuffers = 32; 8560c0d06caSMauro Carvalho Chehab 857d3829fadSDevin Heitmueller *nplanes = 1; 858d3829fadSDevin Heitmueller sizes[0] = size; 8590c0d06caSMauro Carvalho Chehab 8600c0d06caSMauro Carvalho Chehab return 0; 8610c0d06caSMauro Carvalho Chehab } 8620c0d06caSMauro Carvalho Chehab 8630c0d06caSMauro Carvalho Chehab static int 864d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 8650c0d06caSMauro Carvalho Chehab { 866d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 8670c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 868d3829fadSDevin Heitmueller unsigned long size; 8690c0d06caSMauro Carvalho Chehab 870d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 8710c0d06caSMauro Carvalho Chehab 872d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 873d3829fadSDevin Heitmueller 874d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 875d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 876d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 8770c0d06caSMauro Carvalho Chehab return -EINVAL; 878d3829fadSDevin Heitmueller } 879d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 8800c0d06caSMauro Carvalho Chehab 881d3829fadSDevin Heitmueller return 0; 8820c0d06caSMauro Carvalho Chehab } 8830c0d06caSMauro Carvalho Chehab 884d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 885d3829fadSDevin Heitmueller { 886d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 887d3829fadSDevin Heitmueller struct v4l2_frequency f; 888d3829fadSDevin Heitmueller int rc = 0; 8890c0d06caSMauro Carvalho Chehab 890d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 891d3829fadSDevin Heitmueller 892d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 893d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 894d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 895d3829fadSDevin Heitmueller if (rc) 896d3829fadSDevin Heitmueller return rc; 897d3829fadSDevin Heitmueller 898032f1ddfSFrank Schaefer if (dev->streaming_users == 0) { 899d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 900d3829fadSDevin Heitmueller 901d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 902d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 903d3829fadSDevin Heitmueller 904d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 905d3829fadSDevin Heitmueller some i2c device 906d3829fadSDevin Heitmueller */ 907d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 908d3829fadSDevin Heitmueller 9090455eebfSFrank Schaefer dev->capture_type = -1; 910c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 911c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9120c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9130c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 914c647a91aSFrank Schaefer dev->packet_multiplier, 9150fa4a402SFrank Schaefer em28xx_urb_data_copy); 9160c0d06caSMauro Carvalho Chehab if (rc < 0) 917032f1ddfSFrank Schaefer return rc; 918d3829fadSDevin Heitmueller 919d3829fadSDevin Heitmueller /* 920d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 921d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 922d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 923d3829fadSDevin Heitmueller */ 924d3829fadSDevin Heitmueller 925d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 926d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 927d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 928d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 929d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 930d3829fadSDevin Heitmueller else 931d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 932d3829fadSDevin Heitmueller v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 9330c0d06caSMauro Carvalho Chehab } 9340c0d06caSMauro Carvalho Chehab 935032f1ddfSFrank Schaefer dev->streaming_users++; 936032f1ddfSFrank Schaefer 9370c0d06caSMauro Carvalho Chehab return rc; 9380c0d06caSMauro Carvalho Chehab } 9390c0d06caSMauro Carvalho Chehab 940e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 9410c0d06caSMauro Carvalho Chehab { 942d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9430c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 944d3829fadSDevin Heitmueller unsigned long flags = 0; 9450c0d06caSMauro Carvalho Chehab 946d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9470c0d06caSMauro Carvalho Chehab 948d3829fadSDevin Heitmueller res_free(dev, vq->type); 949d3829fadSDevin Heitmueller 950d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 951d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 952d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9530c0d06caSMauro Carvalho Chehab } 9540c0d06caSMauro Carvalho Chehab 955d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 956d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 957d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 958d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 959d3829fadSDevin Heitmueller list_del(&buf->list); 960d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 961d3829fadSDevin Heitmueller } 962d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 963d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 964d3829fadSDevin Heitmueller } 965d3829fadSDevin Heitmueller 966e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 9670c0d06caSMauro Carvalho Chehab { 968d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 969d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 970d3829fadSDevin Heitmueller unsigned long flags = 0; 9710c0d06caSMauro Carvalho Chehab 972d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9730c0d06caSMauro Carvalho Chehab 974d3829fadSDevin Heitmueller res_free(dev, vq->type); 975d3829fadSDevin Heitmueller 976d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 977d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 978d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9790c0d06caSMauro Carvalho Chehab } 9800c0d06caSMauro Carvalho Chehab 981d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 982d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 983d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 984d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 985d3829fadSDevin Heitmueller list_del(&buf->list); 986d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 987d3829fadSDevin Heitmueller } 988d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 989d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 990d3829fadSDevin Heitmueller } 991d3829fadSDevin Heitmueller 992d3829fadSDevin Heitmueller static void 993d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 994d3829fadSDevin Heitmueller { 995d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 996d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 997d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 998d3829fadSDevin Heitmueller unsigned long flags = 0; 999d3829fadSDevin Heitmueller 1000d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1001d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1002d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1003d3829fadSDevin Heitmueller 1004d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1005d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1006d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1007d3829fadSDevin Heitmueller } 1008d3829fadSDevin Heitmueller 1009d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1010d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10110c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10120c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1013d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1014d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1015d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1016d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10170c0d06caSMauro Carvalho Chehab }; 10180c0d06caSMauro Carvalho Chehab 101901c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1020d3829fadSDevin Heitmueller { 1021d3829fadSDevin Heitmueller int rc; 1022d3829fadSDevin Heitmueller struct vb2_queue *q; 1023d3829fadSDevin Heitmueller 1024d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 1025d3829fadSDevin Heitmueller q = &dev->vb_vidq; 1026d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1027ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1028ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1029d3829fadSDevin Heitmueller q->drv_priv = dev; 1030d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1031d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1032d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1033d3829fadSDevin Heitmueller 1034d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1035d3829fadSDevin Heitmueller if (rc < 0) 1036d3829fadSDevin Heitmueller return rc; 1037d3829fadSDevin Heitmueller 1038d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 1039d3829fadSDevin Heitmueller q = &dev->vb_vbiq; 1040d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1041d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1042ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1043d3829fadSDevin Heitmueller q->drv_priv = dev; 1044d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1045d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1046d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1047d3829fadSDevin Heitmueller 1048d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1049d3829fadSDevin Heitmueller if (rc < 0) 1050d3829fadSDevin Heitmueller return rc; 1051d3829fadSDevin Heitmueller 1052d3829fadSDevin Heitmueller return 0; 1053d3829fadSDevin Heitmueller } 1054d3829fadSDevin Heitmueller 10550c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 10560c0d06caSMauro Carvalho Chehab 10570c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 10580c0d06caSMauro Carvalho Chehab { 10590c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 10600c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 10610c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 10620c0d06caSMauro Carvalho Chehab 10630c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 10640c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 10650c0d06caSMauro Carvalho Chehab 10660c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 10670c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 10680c0d06caSMauro Carvalho Chehab 10690c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 10700c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 10710c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 10720c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 10730c0d06caSMauro Carvalho Chehab } 10740c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 10750c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 10760c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 10770c0d06caSMauro Carvalho Chehab } 10780c0d06caSMauro Carvalho Chehab 10790c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 10800c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 10810c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 10820c0d06caSMauro Carvalho Chehab } 10830c0d06caSMauro Carvalho Chehab 10840c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 10850c0d06caSMauro Carvalho Chehab } 10860c0d06caSMauro Carvalho Chehab 108701c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 10880c0d06caSMauro Carvalho Chehab { 1089081b945eSHans Verkuil struct em28xx *dev = priv; 10900c0d06caSMauro Carvalho Chehab 10910c0d06caSMauro Carvalho Chehab /* 1092081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1093081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1094081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1095081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 10960c0d06caSMauro Carvalho Chehab */ 10970c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 10980c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1099081b945eSHans Verkuil dev->mute = ctrl->val; 1100081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11010c0d06caSMauro Carvalho Chehab break; 11020c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1103081b945eSHans Verkuil dev->volume = ctrl->val; 1104081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1105081b945eSHans Verkuil break; 1106081b945eSHans Verkuil } 1107081b945eSHans Verkuil } 1108081b945eSHans Verkuil 1109081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1110081b945eSHans Verkuil { 1111081b945eSHans Verkuil struct em28xx *dev = container_of(ctrl->handler, struct em28xx, ctrl_handler); 11128f8b113aSFrank Schaefer int ret = -EINVAL; 1113081b945eSHans Verkuil 1114081b945eSHans Verkuil switch (ctrl->id) { 1115081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1116081b945eSHans Verkuil dev->mute = ctrl->val; 11178f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1118081b945eSHans Verkuil break; 1119081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1120081b945eSHans Verkuil dev->volume = ctrl->val; 11218f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11228f8b113aSFrank Schaefer break; 11238f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11248f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11258f8b113aSFrank Schaefer break; 11268f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11278f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11288f8b113aSFrank Schaefer break; 11298f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11308f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11318f8b113aSFrank Schaefer break; 11328f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11338f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11348f8b113aSFrank Schaefer break; 11358f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11368f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11378f8b113aSFrank Schaefer break; 11388f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11398f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11400c0d06caSMauro Carvalho Chehab break; 11410c0d06caSMauro Carvalho Chehab } 11420c0d06caSMauro Carvalho Chehab 11438f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 11440c0d06caSMauro Carvalho Chehab } 11450c0d06caSMauro Carvalho Chehab 11468068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1147081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1148081b945eSHans Verkuil }; 1149081b945eSHans Verkuil 11506b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 11510c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 11520c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 11530c0d06caSMauro Carvalho Chehab { 11540c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 11550c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 11560c0d06caSMauro Carvalho Chehab 11570c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 115881685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 115981685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 11600c0d06caSMauro Carvalho Chehab 11610c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 116281685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 116381685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 11640c0d06caSMauro Carvalho Chehab } 11650c0d06caSMauro Carvalho Chehab 1166b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1167b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1168b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1169b8374138SFrank Schaefer { 1170b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1171b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1172b8374138SFrank Schaefer 1173b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1174b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1175b8374138SFrank Schaefer } 1176b8374138SFrank Schaefer 11770c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 11780c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 11790c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 11800c0d06caSMauro Carvalho Chehab 11810c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 11820c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 11830c0d06caSMauro Carvalho Chehab { 11840c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11850c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11860c0d06caSMauro Carvalho Chehab 11870c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 11880c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 11890c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 11900c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 11910c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 11920c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 11930c0d06caSMauro Carvalho Chehab 11940c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 11950c0d06caSMauro Carvalho Chehab if (dev->progressive) 11960c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 11970c0d06caSMauro Carvalho Chehab else 11980c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 11990c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12000c0d06caSMauro Carvalho Chehab return 0; 12010c0d06caSMauro Carvalho Chehab } 12020c0d06caSMauro Carvalho Chehab 12030c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12040c0d06caSMauro Carvalho Chehab { 12050c0d06caSMauro Carvalho Chehab unsigned int i; 12060c0d06caSMauro Carvalho Chehab 12070c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12080c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12090c0d06caSMauro Carvalho Chehab return &format[i]; 12100c0d06caSMauro Carvalho Chehab 12110c0d06caSMauro Carvalho Chehab return NULL; 12120c0d06caSMauro Carvalho Chehab } 12130c0d06caSMauro Carvalho Chehab 12140c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12150c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12160c0d06caSMauro Carvalho Chehab { 12170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12190c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12200c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12210c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12220c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12230c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12240c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12250c0d06caSMauro Carvalho Chehab 12260c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12270c0d06caSMauro Carvalho Chehab if (!fmt) { 12280c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12290c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12300c0d06caSMauro Carvalho Chehab return -EINVAL; 12310c0d06caSMauro Carvalho Chehab } 12320c0d06caSMauro Carvalho Chehab 12330c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12340c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12350c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12360c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1237d3829fadSDevin Heitmueller /* 1238d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1239d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1240d3829fadSDevin Heitmueller * to 50% 1241d3829fadSDevin Heitmueller */ 12420c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 12430c0d06caSMauro Carvalho Chehab width /= 2; 12440c0d06caSMauro Carvalho Chehab } else { 12450c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 12460c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 12470c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 12480c0d06caSMauro Carvalho Chehab 1, 0); 12490c0d06caSMauro Carvalho Chehab } 12500c0d06caSMauro Carvalho Chehab 12516b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 125246f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 12530c0d06caSMauro Carvalho Chehab 12540c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 12550c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 12560c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1257e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 12580c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 12590c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12600c0d06caSMauro Carvalho Chehab if (dev->progressive) 12610c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12620c0d06caSMauro Carvalho Chehab else 12630c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 12640c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 126551dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 12660c0d06caSMauro Carvalho Chehab 12670c0d06caSMauro Carvalho Chehab return 0; 12680c0d06caSMauro Carvalho Chehab } 12690c0d06caSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 12710c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 12720c0d06caSMauro Carvalho Chehab { 12730c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12740c0d06caSMauro Carvalho Chehab 12750c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 12760c0d06caSMauro Carvalho Chehab if (!fmt) 12770c0d06caSMauro Carvalho Chehab return -EINVAL; 12780c0d06caSMauro Carvalho Chehab 12790c0d06caSMauro Carvalho Chehab dev->format = fmt; 12800c0d06caSMauro Carvalho Chehab dev->width = width; 12810c0d06caSMauro Carvalho Chehab dev->height = height; 12820c0d06caSMauro Carvalho Chehab 12830c0d06caSMauro Carvalho Chehab /* set new image size */ 12846b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 12850c0d06caSMauro Carvalho Chehab 12860c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 12870c0d06caSMauro Carvalho Chehab 12880c0d06caSMauro Carvalho Chehab return 0; 12890c0d06caSMauro Carvalho Chehab } 12900c0d06caSMauro Carvalho Chehab 12910c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 12920c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12930c0d06caSMauro Carvalho Chehab { 1294d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 12950c0d06caSMauro Carvalho Chehab 1296d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1297d3829fadSDevin Heitmueller return -EBUSY; 12980c0d06caSMauro Carvalho Chehab 12990c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13000c0d06caSMauro Carvalho Chehab 13010c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13020c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13030c0d06caSMauro Carvalho Chehab } 13040c0d06caSMauro Carvalho Chehab 13050c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13060c0d06caSMauro Carvalho Chehab { 13070c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13080c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13090c0d06caSMauro Carvalho Chehab 13100c0d06caSMauro Carvalho Chehab *norm = dev->norm; 13110c0d06caSMauro Carvalho Chehab 13120c0d06caSMauro Carvalho Chehab return 0; 13130c0d06caSMauro Carvalho Chehab } 13140c0d06caSMauro Carvalho Chehab 13150c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13160c0d06caSMauro Carvalho Chehab { 13170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13190c0d06caSMauro Carvalho Chehab 13200c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 13210c0d06caSMauro Carvalho Chehab 13220c0d06caSMauro Carvalho Chehab return 0; 13230c0d06caSMauro Carvalho Chehab } 13240c0d06caSMauro Carvalho Chehab 1325314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13260c0d06caSMauro Carvalho Chehab { 13270c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13280c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13290c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13300c0d06caSMauro Carvalho Chehab 1331314527acSHans Verkuil if (norm == dev->norm) 1332d8c95c08SHans Verkuil return 0; 13330c0d06caSMauro Carvalho Chehab 1334d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1335d8c95c08SHans Verkuil return -EBUSY; 1336d8c95c08SHans Verkuil 1337314527acSHans Verkuil dev->norm = norm; 13380c0d06caSMauro Carvalho Chehab 13390c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1340d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1341314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 13420c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 13430c0d06caSMauro Carvalho Chehab 13440c0d06caSMauro Carvalho Chehab /* set new image size */ 13450c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 13460c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 13476b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 13480c0d06caSMauro Carvalho Chehab 13490c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13500c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 13510c0d06caSMauro Carvalho Chehab 13520c0d06caSMauro Carvalho Chehab return 0; 13530c0d06caSMauro Carvalho Chehab } 13540c0d06caSMauro Carvalho Chehab 13550c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 13560c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 13570c0d06caSMauro Carvalho Chehab { 13580c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13590c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13600c0d06caSMauro Carvalho Chehab int rc = 0; 13610c0d06caSMauro Carvalho Chehab 136286ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 13630c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 13640c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 13650c0d06caSMauro Carvalho Chehab video, g_parm, p); 13660c0d06caSMauro Carvalho Chehab else 13670c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 13680c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 13690c0d06caSMauro Carvalho Chehab 13700c0d06caSMauro Carvalho Chehab return rc; 13710c0d06caSMauro Carvalho Chehab } 13720c0d06caSMauro Carvalho Chehab 13730c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 13740c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 13750c0d06caSMauro Carvalho Chehab { 13760c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13770c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13780c0d06caSMauro Carvalho Chehab 137986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 13800c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 13810c0d06caSMauro Carvalho Chehab } 13820c0d06caSMauro Carvalho Chehab 13830c0d06caSMauro Carvalho Chehab static const char *iname[] = { 13840c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 13850c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 13860c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 13870c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 13880c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 13890c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 13900c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 13910c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 13920c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 13930c0d06caSMauro Carvalho Chehab }; 13940c0d06caSMauro Carvalho Chehab 13950c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 13960c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 13970c0d06caSMauro Carvalho Chehab { 13980c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13990c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14000c0d06caSMauro Carvalho Chehab unsigned int n; 14010c0d06caSMauro Carvalho Chehab 14020c0d06caSMauro Carvalho Chehab n = i->index; 14030c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14040c0d06caSMauro Carvalho Chehab return -EINVAL; 14050c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14060c0d06caSMauro Carvalho Chehab return -EINVAL; 14070c0d06caSMauro Carvalho Chehab 14080c0d06caSMauro Carvalho Chehab i->index = n; 14090c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14100c0d06caSMauro Carvalho Chehab 14110c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14120c0d06caSMauro Carvalho Chehab 14130c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14140c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14150c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14160c0d06caSMauro Carvalho Chehab 14170c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 1418d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1419d8c95c08SHans Verkuil if (dev->board.is_webcam) 1420d8c95c08SHans Verkuil i->capabilities = 0; 14210c0d06caSMauro Carvalho Chehab 14220c0d06caSMauro Carvalho Chehab return 0; 14230c0d06caSMauro Carvalho Chehab } 14240c0d06caSMauro Carvalho Chehab 14250c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14260c0d06caSMauro Carvalho Chehab { 14270c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14280c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14290c0d06caSMauro Carvalho Chehab 14300c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14310c0d06caSMauro Carvalho Chehab 14320c0d06caSMauro Carvalho Chehab return 0; 14330c0d06caSMauro Carvalho Chehab } 14340c0d06caSMauro Carvalho Chehab 14350c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 14360c0d06caSMauro Carvalho Chehab { 14370c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14380c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14390c0d06caSMauro Carvalho Chehab 14400c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 14410c0d06caSMauro Carvalho Chehab return -EINVAL; 14420c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14430c0d06caSMauro Carvalho Chehab return -EINVAL; 14440c0d06caSMauro Carvalho Chehab 14450c0d06caSMauro Carvalho Chehab video_mux(dev, i); 14460c0d06caSMauro Carvalho Chehab return 0; 14470c0d06caSMauro Carvalho Chehab } 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 14500c0d06caSMauro Carvalho Chehab { 14510c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14520c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14530c0d06caSMauro Carvalho Chehab 14540c0d06caSMauro Carvalho Chehab switch (a->index) { 14550c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 14560c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 14570c0d06caSMauro Carvalho Chehab break; 14580c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 14590c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 14600c0d06caSMauro Carvalho Chehab break; 14610c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 14620c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 14630c0d06caSMauro Carvalho Chehab break; 14640c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 14650c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 14660c0d06caSMauro Carvalho Chehab break; 14670c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 14680c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 14690c0d06caSMauro Carvalho Chehab break; 14700c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 14710c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 14720c0d06caSMauro Carvalho Chehab break; 14730c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 14740c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 14750c0d06caSMauro Carvalho Chehab break; 14760c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 14770c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 14780c0d06caSMauro Carvalho Chehab break; 14790c0d06caSMauro Carvalho Chehab default: 14800c0d06caSMauro Carvalho Chehab return -EINVAL; 14810c0d06caSMauro Carvalho Chehab } 14820c0d06caSMauro Carvalho Chehab 14830c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 14840c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 14850c0d06caSMauro Carvalho Chehab 14860c0d06caSMauro Carvalho Chehab return 0; 14870c0d06caSMauro Carvalho Chehab } 14880c0d06caSMauro Carvalho Chehab 14890e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 14900c0d06caSMauro Carvalho Chehab { 14910c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14920c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14930c0d06caSMauro Carvalho Chehab 14940c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 14950c0d06caSMauro Carvalho Chehab return -EINVAL; 14960c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 14970c0d06caSMauro Carvalho Chehab return -EINVAL; 14980c0d06caSMauro Carvalho Chehab 14990c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15000c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15010c0d06caSMauro Carvalho Chehab 15020c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15030c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab return 0; 15060c0d06caSMauro Carvalho Chehab } 15070c0d06caSMauro Carvalho Chehab 15080c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15090c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15100c0d06caSMauro Carvalho Chehab { 15110c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15120c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab if (0 != t->index) 15150c0d06caSMauro Carvalho Chehab return -EINVAL; 15160c0d06caSMauro Carvalho Chehab 15170c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15180c0d06caSMauro Carvalho Chehab 15190c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 15200c0d06caSMauro Carvalho Chehab return 0; 15210c0d06caSMauro Carvalho Chehab } 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15242f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15250c0d06caSMauro Carvalho Chehab { 15260c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15270c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab if (0 != t->index) 15300c0d06caSMauro Carvalho Chehab return -EINVAL; 15310c0d06caSMauro Carvalho Chehab 15320c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 15330c0d06caSMauro Carvalho Chehab return 0; 15340c0d06caSMauro Carvalho Chehab } 15350c0d06caSMauro Carvalho Chehab 15360c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15370c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15380c0d06caSMauro Carvalho Chehab { 15390c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15400c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15410c0d06caSMauro Carvalho Chehab 154220deebfeSHans Verkuil if (0 != f->tuner) 154320deebfeSHans Verkuil return -EINVAL; 154420deebfeSHans Verkuil 15450c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 15460c0d06caSMauro Carvalho Chehab return 0; 15470c0d06caSMauro Carvalho Chehab } 15480c0d06caSMauro Carvalho Chehab 15490c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1550b530a447SHans Verkuil const struct v4l2_frequency *f) 15510c0d06caSMauro Carvalho Chehab { 1552b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 15530c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15540c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15550c0d06caSMauro Carvalho Chehab 15560c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 15570c0d06caSMauro Carvalho Chehab return -EINVAL; 15580c0d06caSMauro Carvalho Chehab 15590c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 1560b530a447SHans Verkuil v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_frequency, &new_freq); 1561b530a447SHans Verkuil dev->ctl_freq = new_freq.frequency; 15620c0d06caSMauro Carvalho Chehab 15630c0d06caSMauro Carvalho Chehab return 0; 15640c0d06caSMauro Carvalho Chehab } 15650c0d06caSMauro Carvalho Chehab 1566cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 156796b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 156896b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 15693b2d17b4SHans Verkuil { 15703b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 15713b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 15723b2d17b4SHans Verkuil 15733b2d17b4SHans Verkuil if (chip->match.addr > 1) 15743b2d17b4SHans Verkuil return -EINVAL; 15753b2d17b4SHans Verkuil if (chip->match.addr == 1) 15763b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 15773b2d17b4SHans Verkuil else 15783b2d17b4SHans Verkuil strlcpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name)); 15793b2d17b4SHans Verkuil return 0; 15803b2d17b4SHans Verkuil } 15813b2d17b4SHans Verkuil 158235deba32SFrank Schaefer static int em28xx_reg_len(int reg) 158335deba32SFrank Schaefer { 158435deba32SFrank Schaefer switch (reg) { 158535deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 158635deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 158735deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 158835deba32SFrank Schaefer return 2; 158935deba32SFrank Schaefer default: 159035deba32SFrank Schaefer return 1; 159135deba32SFrank Schaefer } 159235deba32SFrank Schaefer } 15930c0d06caSMauro Carvalho Chehab 15940c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 15950c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 15960c0d06caSMauro Carvalho Chehab { 15970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15990c0d06caSMauro Carvalho Chehab int ret; 16000c0d06caSMauro Carvalho Chehab 16013b2d17b4SHans Verkuil if (reg->match.addr > 1) 16023b2d17b4SHans Verkuil return -EINVAL; 1603abca2056SHans Verkuil if (reg->match.addr) { 16040c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16050c0d06caSMauro Carvalho Chehab if (ret < 0) 16060c0d06caSMauro Carvalho Chehab return ret; 16070c0d06caSMauro Carvalho Chehab 16080c0d06caSMauro Carvalho Chehab reg->val = ret; 16090c0d06caSMauro Carvalho Chehab reg->size = 1; 16100c0d06caSMauro Carvalho Chehab return 0; 16110c0d06caSMauro Carvalho Chehab } 16120c0d06caSMauro Carvalho Chehab 16130c0d06caSMauro Carvalho Chehab /* Match host */ 16140c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16150c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16160c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16170c0d06caSMauro Carvalho Chehab 16180c0d06caSMauro Carvalho Chehab if (ret < 0) 16190c0d06caSMauro Carvalho Chehab return ret; 16200c0d06caSMauro Carvalho Chehab 16210c0d06caSMauro Carvalho Chehab reg->val = ret; 16220c0d06caSMauro Carvalho Chehab } else { 16230c0d06caSMauro Carvalho Chehab __le16 val = 0; 162401c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16250c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16260c0d06caSMauro Carvalho Chehab if (ret < 0) 16270c0d06caSMauro Carvalho Chehab return ret; 16280c0d06caSMauro Carvalho Chehab 16290c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16300c0d06caSMauro Carvalho Chehab } 16310c0d06caSMauro Carvalho Chehab 16320c0d06caSMauro Carvalho Chehab return 0; 16330c0d06caSMauro Carvalho Chehab } 16340c0d06caSMauro Carvalho Chehab 16350c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1636977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16370c0d06caSMauro Carvalho Chehab { 16380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16400c0d06caSMauro Carvalho Chehab __le16 buf; 16410c0d06caSMauro Carvalho Chehab 16423b2d17b4SHans Verkuil if (reg->match.addr > 1) 16433b2d17b4SHans Verkuil return -EINVAL; 1644abca2056SHans Verkuil if (reg->match.addr) 16450c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16460c0d06caSMauro Carvalho Chehab 16470c0d06caSMauro Carvalho Chehab /* Match host */ 16480c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 16490c0d06caSMauro Carvalho Chehab 16500c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 16510c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 16520c0d06caSMauro Carvalho Chehab } 16530c0d06caSMauro Carvalho Chehab #endif 16540c0d06caSMauro Carvalho Chehab 16550c0d06caSMauro Carvalho Chehab 16560c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 16570c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 16580c0d06caSMauro Carvalho Chehab { 1659a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 16600c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16610c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16620c0d06caSMauro Carvalho Chehab 16630c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 16640c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 16650c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 16660c0d06caSMauro Carvalho Chehab 1667a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1668a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1669a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1670a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1671a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1672a9d79fe5SHans Verkuil else 16731d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 16740c0d06caSMauro Carvalho Chehab 16750c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1676a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 16770c0d06caSMauro Carvalho Chehab 16780c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1679a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 16800c0d06caSMauro Carvalho Chehab 1681a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1682a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1683a9d79fe5SHans Verkuil if (dev->vbi_dev) 16841d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1685a9d79fe5SHans Verkuil if (dev->radio_dev) 1686a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 16870c0d06caSMauro Carvalho Chehab return 0; 16880c0d06caSMauro Carvalho Chehab } 16890c0d06caSMauro Carvalho Chehab 16900c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 16910c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 16920c0d06caSMauro Carvalho Chehab { 16930c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 16940c0d06caSMauro Carvalho Chehab return -EINVAL; 16950c0d06caSMauro Carvalho Chehab 16960c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 16970c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 16980c0d06caSMauro Carvalho Chehab 16990c0d06caSMauro Carvalho Chehab return 0; 17000c0d06caSMauro Carvalho Chehab } 17010c0d06caSMauro Carvalho Chehab 17020c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17030c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17040c0d06caSMauro Carvalho Chehab { 17050c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17060c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17070c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17080c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17090c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17100c0d06caSMauro Carvalho Chehab 17110c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17120c0d06caSMauro Carvalho Chehab if (!fmt) { 17130c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17140c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17150c0d06caSMauro Carvalho Chehab return -EINVAL; 17160c0d06caSMauro Carvalho Chehab } 17170c0d06caSMauro Carvalho Chehab 17180c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17190c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17200c0d06caSMauro Carvalho Chehab return -EINVAL; 17210c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17220c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17230c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17240c0d06caSMauro Carvalho Chehab return 0; 17250c0d06caSMauro Carvalho Chehab } 17260c0d06caSMauro Carvalho Chehab 17270c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17280c0d06caSMauro Carvalho Chehab return -EINVAL; 17290c0d06caSMauro Carvalho Chehab 17300c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17310c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17326c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17336c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17346c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17350c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17366c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17376c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17380c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17390c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17400c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 17410c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 17420c0d06caSMauro Carvalho Chehab return 0; 17430c0d06caSMauro Carvalho Chehab } 17440c0d06caSMauro Carvalho Chehab 17450c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 17460c0d06caSMauro Carvalho Chehab 17470c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 17480c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 17490c0d06caSMauro Carvalho Chehab { 17500c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17510c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 17540c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 17550c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 17560c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 17570c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 17580c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 17590c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 17602a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 17610c0d06caSMauro Carvalho Chehab 17620c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 17630c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 17640c0d06caSMauro Carvalho Chehab /* NTSC */ 17650c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 17660c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 17670c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 17680c0d06caSMauro Carvalho Chehab /* PAL */ 17690c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 17700c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 17710c0d06caSMauro Carvalho Chehab } 17720c0d06caSMauro Carvalho Chehab 17730c0d06caSMauro Carvalho Chehab return 0; 17740c0d06caSMauro Carvalho Chehab } 17750c0d06caSMauro Carvalho Chehab 17760c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 17770c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 17780c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 17790c0d06caSMauro Carvalho Chehab 17800c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 17810c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17820c0d06caSMauro Carvalho Chehab { 17830c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 17840c0d06caSMauro Carvalho Chehab 17850c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 17860c0d06caSMauro Carvalho Chehab return -EINVAL; 17870c0d06caSMauro Carvalho Chehab 17880c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 17890c0d06caSMauro Carvalho Chehab 17900c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 17910c0d06caSMauro Carvalho Chehab 17920c0d06caSMauro Carvalho Chehab return 0; 17930c0d06caSMauro Carvalho Chehab } 17940c0d06caSMauro Carvalho Chehab 17950c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 17962f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17970c0d06caSMauro Carvalho Chehab { 17980c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 17990c0d06caSMauro Carvalho Chehab 18000c0d06caSMauro Carvalho Chehab if (0 != t->index) 18010c0d06caSMauro Carvalho Chehab return -EINVAL; 18020c0d06caSMauro Carvalho Chehab 18030c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 18040c0d06caSMauro Carvalho Chehab 18050c0d06caSMauro Carvalho Chehab return 0; 18060c0d06caSMauro Carvalho Chehab } 18070c0d06caSMauro Carvalho Chehab 18080c0d06caSMauro Carvalho Chehab /* 18090c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18100c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18110c0d06caSMauro Carvalho Chehab */ 18120c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18130c0d06caSMauro Carvalho Chehab { 18140c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18150c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 18160c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 18180c0d06caSMauro Carvalho Chehab 18190c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18200c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18210c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18220c0d06caSMauro Carvalho Chehab break; 18230c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 18240c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 18250c0d06caSMauro Carvalho Chehab break; 18264e170240SFrank Schaefer case VFL_TYPE_RADIO: 18274e170240SFrank Schaefer break; 18284e170240SFrank Schaefer default: 18294e170240SFrank Schaefer return -EINVAL; 18300c0d06caSMauro Carvalho Chehab } 18310c0d06caSMauro Carvalho Chehab 18320c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 18330c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 18340c0d06caSMauro Carvalho Chehab dev->users); 18350c0d06caSMauro Carvalho Chehab 18360c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 18370c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 18380c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 18390c0d06caSMauro Carvalho Chehab if (!fh) { 18400c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 18410c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 18420c0d06caSMauro Carvalho Chehab return -ENOMEM; 18430c0d06caSMauro Carvalho Chehab } 184469a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 18450c0d06caSMauro Carvalho Chehab fh->dev = dev; 18460c0d06caSMauro Carvalho Chehab fh->type = fh_type; 18470c0d06caSMauro Carvalho Chehab filp->private_data = fh; 18480c0d06caSMauro Carvalho Chehab 18494e170240SFrank Schaefer if (dev->users == 0) { 18500c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 18514e170240SFrank Schaefer 18524e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 18530c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 18540c0d06caSMauro Carvalho Chehab 18554e170240SFrank Schaefer /* 18564e170240SFrank Schaefer * Needed, since GPIO might have disabled power 18574e170240SFrank Schaefer * of some i2c devices 18580c0d06caSMauro Carvalho Chehab */ 18590c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 18600c0d06caSMauro Carvalho Chehab } 1861d3829fadSDevin Heitmueller 1862d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 18630c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 18640c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 18650c0d06caSMauro Carvalho Chehab } 18660c0d06caSMauro Carvalho Chehab 186747677e51SMauro Carvalho Chehab kref_get(&dev->ref); 18680c0d06caSMauro Carvalho Chehab dev->users++; 18690c0d06caSMauro Carvalho Chehab 18700c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 187169a61642SHans Verkuil v4l2_fh_add(&fh->fh); 18720c0d06caSMauro Carvalho Chehab 1873d3829fadSDevin Heitmueller return 0; 18740c0d06caSMauro Carvalho Chehab } 18750c0d06caSMauro Carvalho Chehab 18760c0d06caSMauro Carvalho Chehab /* 187701c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 18780c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 18790c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 18800c0d06caSMauro Carvalho Chehab */ 188101c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 18820c0d06caSMauro Carvalho Chehab { 1883822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 1884822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 1885822b8deaSMauro Carvalho Chehab return 0; 1886822b8deaSMauro Carvalho Chehab } 1887822b8deaSMauro Carvalho Chehab 188801c28193SMauro Carvalho Chehab if (!dev->has_video) { 188901c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 189001c28193SMauro Carvalho Chehab return 0; 189101c28193SMauro Carvalho Chehab } 18920c0d06caSMauro Carvalho Chehab 1893aa929ad7SMauro Carvalho Chehab em28xx_info("Closing video extension"); 1894aa929ad7SMauro Carvalho Chehab 1895ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 1896ebbfbc20SMauro Carvalho Chehab 18975ad10de6SFrank Schaefer v4l2_device_disconnect(&dev->v4l2_dev); 18985ad10de6SFrank Schaefer 189923e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 190023e8642cSFrank Schaefer 19010c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 1902e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 1903e847022aSFrank Schaefer video_device_node_name(dev->radio_dev)); 19040c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 19050c0d06caSMauro Carvalho Chehab } 19060c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 19070c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 19080c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 19090c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 19100c0d06caSMauro Carvalho Chehab } 19110c0d06caSMauro Carvalho Chehab if (dev->vdev) { 19120c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 19130c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 19140c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 19150c0d06caSMauro Carvalho Chehab } 191601c28193SMauro Carvalho Chehab 1917103f18a2SFrank Schaefer v4l2_ctrl_handler_free(&dev->ctrl_handler); 1918103f18a2SFrank Schaefer v4l2_device_unregister(&dev->v4l2_dev); 1919103f18a2SFrank Schaefer 192025dd1652SFrank Schaefer if (dev->clk) { 192125dd1652SFrank Schaefer v4l2_clk_unregister_fixed(dev->clk); 192225dd1652SFrank Schaefer dev->clk = NULL; 192325dd1652SFrank Schaefer } 192425dd1652SFrank Schaefer 1925ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 192647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 19275ad10de6SFrank Schaefer 192801c28193SMauro Carvalho Chehab return 0; 19290c0d06caSMauro Carvalho Chehab } 19300c0d06caSMauro Carvalho Chehab 1931a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 1932a61f6811SShuah Khan { 1933a61f6811SShuah Khan if (dev->is_audio_only) 1934a61f6811SShuah Khan return 0; 1935a61f6811SShuah Khan 1936a61f6811SShuah Khan if (!dev->has_video) 1937a61f6811SShuah Khan return 0; 1938a61f6811SShuah Khan 1939a61f6811SShuah Khan em28xx_info("Suspending video extension"); 1940a61f6811SShuah Khan em28xx_stop_urbs(dev); 1941a61f6811SShuah Khan return 0; 1942a61f6811SShuah Khan } 1943a61f6811SShuah Khan 1944a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 1945a61f6811SShuah Khan { 1946a61f6811SShuah Khan if (dev->is_audio_only) 1947a61f6811SShuah Khan return 0; 1948a61f6811SShuah Khan 1949a61f6811SShuah Khan if (!dev->has_video) 1950a61f6811SShuah Khan return 0; 1951a61f6811SShuah Khan 1952a61f6811SShuah Khan em28xx_info("Resuming video extension"); 1953a61f6811SShuah Khan /* what do we do here */ 1954a61f6811SShuah Khan return 0; 1955a61f6811SShuah Khan } 1956a61f6811SShuah Khan 19570c0d06caSMauro Carvalho Chehab /* 19580c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 19590c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 19600c0d06caSMauro Carvalho Chehab * calls and ioctls 19610c0d06caSMauro Carvalho Chehab */ 19620c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 19630c0d06caSMauro Carvalho Chehab { 19640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 19650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19660c0d06caSMauro Carvalho Chehab int errCode; 19670c0d06caSMauro Carvalho Chehab 19680c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 19690c0d06caSMauro Carvalho Chehab 1970d3829fadSDevin Heitmueller vb2_fop_release(filp); 197198c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 19720c0d06caSMauro Carvalho Chehab 19730c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 197447677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 197547677e51SMauro Carvalho Chehab if (dev->disconnected) 197601c28193SMauro Carvalho Chehab goto exit; 19770c0d06caSMauro Carvalho Chehab 19780c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 19790c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 19800c0d06caSMauro Carvalho Chehab 19810c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 19820c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 19830c0d06caSMauro Carvalho Chehab 19840c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 19850c0d06caSMauro Carvalho Chehab dev->alt = 0; 19860c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 19870c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 19880c0d06caSMauro Carvalho Chehab if (errCode < 0) { 19890c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 19900c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 19910c0d06caSMauro Carvalho Chehab } 19920c0d06caSMauro Carvalho Chehab } 19930c0d06caSMauro Carvalho Chehab 199401c28193SMauro Carvalho Chehab exit: 19950c0d06caSMauro Carvalho Chehab dev->users--; 19960c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 199747677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 199847677e51SMauro Carvalho Chehab 19990c0d06caSMauro Carvalho Chehab return 0; 20000c0d06caSMauro Carvalho Chehab } 20010c0d06caSMauro Carvalho Chehab 2002e847022aSFrank Schaefer /* 2003e847022aSFrank Schaefer * em28xx_videodevice_release() 2004e847022aSFrank Schaefer * called when the last user of the video device exits and frees the memeory 2005e847022aSFrank Schaefer */ 2006e847022aSFrank Schaefer static void em28xx_videodevice_release(struct video_device *vdev) 2007e847022aSFrank Schaefer { 2008e847022aSFrank Schaefer struct em28xx *dev = video_get_drvdata(vdev); 2009e847022aSFrank Schaefer 2010e847022aSFrank Schaefer video_device_release(vdev); 2011e847022aSFrank Schaefer if (vdev == dev->vdev) 2012e847022aSFrank Schaefer dev->vdev = NULL; 2013e847022aSFrank Schaefer else if (vdev == dev->vbi_dev) 2014e847022aSFrank Schaefer dev->vbi_dev = NULL; 2015e847022aSFrank Schaefer else if (vdev == dev->radio_dev) 2016e847022aSFrank Schaefer dev->radio_dev = NULL; 2017e847022aSFrank Schaefer } 2018e847022aSFrank Schaefer 20190c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 20200c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20210c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20220c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2023d3829fadSDevin Heitmueller .read = vb2_fop_read, 2024d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2025d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 20260c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20270c0d06caSMauro Carvalho Chehab }; 20280c0d06caSMauro Carvalho Chehab 20290c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 20300c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 20310c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 20320c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 20330c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 20340c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 20350c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20362a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2037aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20380c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 20390c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 20400c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 20410c0d06caSMauro Carvalho Chehab 2042d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2043d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2044d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2045d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2046d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2047d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2048d3829fadSDevin Heitmueller 20490c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 20500c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 20510c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 20520c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 20530c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 20540c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 20550c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 20560c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2057d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2058d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 20590c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 20600c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 20610c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20620c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 206350fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 206450fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20650c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 206696b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 20670c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20680c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20690c0d06caSMauro Carvalho Chehab #endif 20700c0d06caSMauro Carvalho Chehab }; 20710c0d06caSMauro Carvalho Chehab 20720c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 20730c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 20740c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2075e847022aSFrank Schaefer .release = em28xx_videodevice_release, 20760c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 20770c0d06caSMauro Carvalho Chehab }; 20780c0d06caSMauro Carvalho Chehab 20790c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 20800c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20810c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20820c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 20830c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20840c0d06caSMauro Carvalho Chehab }; 20850c0d06caSMauro Carvalho Chehab 20860c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2087a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 20880c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 20890c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 20900c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20910c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 209250fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 209350fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20940c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2095430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 20960c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20970c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20980c0d06caSMauro Carvalho Chehab #endif 20990c0d06caSMauro Carvalho Chehab }; 21000c0d06caSMauro Carvalho Chehab 21010c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 21020c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 21030c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2104e847022aSFrank Schaefer .release = em28xx_videodevice_release, 21050c0d06caSMauro Carvalho Chehab }; 21060c0d06caSMauro Carvalho Chehab 2107b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2108b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2109b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2110b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2111b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2112b64f8e9aSMauro Carvalho Chehab 2113b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2114b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2115b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2116b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2117b64f8e9aSMauro Carvalho Chehab }; 2118b64f8e9aSMauro Carvalho Chehab 2119b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2120b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2121b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2122b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2123b64f8e9aSMauro Carvalho Chehab }; 2124b64f8e9aSMauro Carvalho Chehab 21250c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 21260c0d06caSMauro Carvalho Chehab 21270c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 21280c0d06caSMauro Carvalho Chehab const struct video_device *template, 21290c0d06caSMauro Carvalho Chehab const char *type_name) 21300c0d06caSMauro Carvalho Chehab { 21310c0d06caSMauro Carvalho Chehab struct video_device *vfd; 21320c0d06caSMauro Carvalho Chehab 21330c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 21340c0d06caSMauro Carvalho Chehab if (NULL == vfd) 21350c0d06caSMauro Carvalho Chehab return NULL; 21360c0d06caSMauro Carvalho Chehab 21370c0d06caSMauro Carvalho Chehab *vfd = *template; 21380c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 21390c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 21400c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 214169a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 2142d8c95c08SHans Verkuil if (dev->board.is_webcam) 2143d8c95c08SHans Verkuil vfd->tvnorms = 0; 21440c0d06caSMauro Carvalho Chehab 21450c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 21460c0d06caSMauro Carvalho Chehab dev->name, type_name); 21470c0d06caSMauro Carvalho Chehab 21480c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 21490c0d06caSMauro Carvalho Chehab return vfd; 21500c0d06caSMauro Carvalho Chehab } 21510c0d06caSMauro Carvalho Chehab 215201c28193SMauro Carvalho Chehab static void em28xx_tuner_setup(struct em28xx *dev) 21530560f337SMauro Carvalho Chehab { 21540560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 21550560f337SMauro Carvalho Chehab struct v4l2_frequency f; 21560560f337SMauro Carvalho Chehab 21570560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_ABSENT) 21580560f337SMauro Carvalho Chehab return; 21590560f337SMauro Carvalho Chehab 21600560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 21610560f337SMauro Carvalho Chehab 21620560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 21630560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 21640560f337SMauro Carvalho Chehab 21650560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 21660560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 21670560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 21680560f337SMauro Carvalho Chehab 21690560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_type_addr, &tun_setup); 21700560f337SMauro Carvalho Chehab } 21710560f337SMauro Carvalho Chehab 21720560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 21730560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 21740560f337SMauro Carvalho Chehab tun_setup.addr = dev->tuner_addr; 21750560f337SMauro Carvalho Chehab 21760560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_type_addr, &tun_setup); 21770560f337SMauro Carvalho Chehab } 21780560f337SMauro Carvalho Chehab 21790560f337SMauro Carvalho Chehab if (dev->tda9887_conf) { 21800560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 21810560f337SMauro Carvalho Chehab 21820560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 21830560f337SMauro Carvalho Chehab tda9887_cfg.priv = &dev->tda9887_conf; 21840560f337SMauro Carvalho Chehab 21850560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_config, &tda9887_cfg); 21860560f337SMauro Carvalho Chehab } 21870560f337SMauro Carvalho Chehab 21880560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 21890560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 21900560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 21910560f337SMauro Carvalho Chehab 21920560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 21930560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 21940560f337SMauro Carvalho Chehab 21950560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 21960560f337SMauro Carvalho Chehab 21970560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 21980560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 21990560f337SMauro Carvalho Chehab 22000560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 22010560f337SMauro Carvalho Chehab } 22020560f337SMauro Carvalho Chehab 22030560f337SMauro Carvalho Chehab /* configure tuner */ 22040560f337SMauro Carvalho Chehab f.tuner = 0; 22050560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 22060560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 22070560f337SMauro Carvalho Chehab dev->ctl_freq = f.frequency; 22080560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 22090560f337SMauro Carvalho Chehab } 22100560f337SMauro Carvalho Chehab 221101c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 22120c0d06caSMauro Carvalho Chehab { 22130c0d06caSMauro Carvalho Chehab u8 val; 22140c0d06caSMauro Carvalho Chehab int ret; 22150c0d06caSMauro Carvalho Chehab unsigned int maxw; 2216b64f8e9aSMauro Carvalho Chehab struct v4l2_ctrl_handler *hdl = &dev->ctrl_handler; 2217b64f8e9aSMauro Carvalho Chehab 2218822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2219822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2220822b8deaSMauro Carvalho Chehab return 0; 2221822b8deaSMauro Carvalho Chehab } 2222822b8deaSMauro Carvalho Chehab 222301c28193SMauro Carvalho Chehab if (!dev->has_video) { 2224b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2225b64f8e9aSMauro Carvalho Chehab return 0; 2226b64f8e9aSMauro Carvalho Chehab } 22270c0d06caSMauro Carvalho Chehab 22289634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 22290c0d06caSMauro Carvalho Chehab 223001c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 223101c28193SMauro Carvalho Chehab 2232b64f8e9aSMauro Carvalho Chehab ret = v4l2_device_register(&dev->udev->dev, &dev->v4l2_dev); 2233b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2234b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2235b64f8e9aSMauro Carvalho Chehab goto err; 2236b64f8e9aSMauro Carvalho Chehab } 2237b64f8e9aSMauro Carvalho Chehab 2238b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 2239b64f8e9aSMauro Carvalho Chehab dev->v4l2_dev.ctrl_handler = hdl; 2240b64f8e9aSMauro Carvalho Chehab 2241b64f8e9aSMauro Carvalho Chehab /* 2242b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2243b64f8e9aSMauro Carvalho Chehab */ 2244b64f8e9aSMauro Carvalho Chehab dev->vinmode = 0x10; 2245b64f8e9aSMauro Carvalho Chehab dev->vinctl = EM28XX_VINCTRL_INTERLACED | 2246b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2247b64f8e9aSMauro Carvalho Chehab 2248b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2249b64f8e9aSMauro Carvalho Chehab 2250b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 2251b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2252b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2253b64f8e9aSMauro Carvalho Chehab 2254b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 2255b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2256b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2257b64f8e9aSMauro Carvalho Chehab 2258b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 2259b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2260b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2261b64f8e9aSMauro Carvalho Chehab 2262b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 2263b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2264b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2265b64f8e9aSMauro Carvalho Chehab 2266b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2267b64f8e9aSMauro Carvalho Chehab 2268b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 2269b64f8e9aSMauro Carvalho Chehab int has_demod = (dev->tda9887_conf & TDA9887_PRESENT); 2270b64f8e9aSMauro Carvalho Chehab 2271b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 2272b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2273b64f8e9aSMauro Carvalho Chehab "tuner", dev->board.radio_addr, NULL); 2274b64f8e9aSMauro Carvalho Chehab 2275b64f8e9aSMauro Carvalho Chehab if (has_demod) 2276b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, 2277b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2278b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 2279b64f8e9aSMauro Carvalho Chehab if (dev->tuner_addr == 0) { 2280b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2281b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2282b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2283b64f8e9aSMauro Carvalho Chehab 2284b64f8e9aSMauro Carvalho Chehab sd = v4l2_i2c_new_subdev(&dev->v4l2_dev, 2285b64f8e9aSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], "tuner", 2286b64f8e9aSMauro Carvalho Chehab 0, v4l2_i2c_tuner_addrs(type)); 2287b64f8e9aSMauro Carvalho Chehab 2288b64f8e9aSMauro Carvalho Chehab if (sd) 2289b64f8e9aSMauro Carvalho Chehab dev->tuner_addr = v4l2_i2c_subdev_addr(sd); 2290b64f8e9aSMauro Carvalho Chehab } else { 2291b64f8e9aSMauro Carvalho Chehab v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap[dev->def_i2c_bus], 2292b64f8e9aSMauro Carvalho Chehab "tuner", dev->tuner_addr, NULL); 2293b64f8e9aSMauro Carvalho Chehab } 2294b64f8e9aSMauro Carvalho Chehab } 2295b64f8e9aSMauro Carvalho Chehab 2296b64f8e9aSMauro Carvalho Chehab em28xx_tuner_setup(dev); 2297d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2298b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2299b64f8e9aSMauro Carvalho Chehab 2300b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2301b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2302b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2303b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2304b64f8e9aSMauro Carvalho Chehab __func__, ret); 2305b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2306b64f8e9aSMauro Carvalho Chehab } 2307b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2308b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2309b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2310b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2311b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2312b64f8e9aSMauro Carvalho Chehab } else { 2313b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2314b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2315b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2316b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2317b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2318b64f8e9aSMauro Carvalho Chehab } 2319b64f8e9aSMauro Carvalho Chehab 2320b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2321b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2322b64f8e9aSMauro Carvalho Chehab 2323b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2324b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2325b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2326b64f8e9aSMauro Carvalho Chehab 2327b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2328b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2329b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2330b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2331b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2332b64f8e9aSMauro Carvalho Chehab __func__, ret); 2333b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2334b64f8e9aSMauro Carvalho Chehab } 2335b64f8e9aSMauro Carvalho Chehab msleep(3); 2336b64f8e9aSMauro Carvalho Chehab 2337b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2338b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2339b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2340b64f8e9aSMauro Carvalho Chehab __func__, ret); 2341b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2342b64f8e9aSMauro Carvalho Chehab } 2343b64f8e9aSMauro Carvalho Chehab msleep(3); 2344b64f8e9aSMauro Carvalho Chehab } 2345b64f8e9aSMauro Carvalho Chehab 23460c0d06caSMauro Carvalho Chehab /* set default norm */ 2347d8c95c08SHans Verkuil dev->norm = V4L2_STD_PAL; 23480c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 23490c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 23500c0d06caSMauro Carvalho Chehab 23510c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 23520c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 23530c0d06caSMauro Carvalho Chehab 23540c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 23550c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 23560c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 23570c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 23580c0d06caSMauro Carvalho Chehab maxw /= 2; 23590c0d06caSMauro Carvalho Chehab 23600c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 23610c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 23620c0d06caSMauro Carvalho Chehab 23630c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 23640c0d06caSMauro Carvalho Chehab 23650c0d06caSMauro Carvalho Chehab /* Audio defaults */ 23660c0d06caSMauro Carvalho Chehab dev->mute = 1; 23670c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 23680c0d06caSMauro Carvalho Chehab 23690c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 23700c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 23710c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 23720c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 23730c0d06caSMauro Carvalho Chehab 23740c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 23750c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 23760c0d06caSMauro Carvalho Chehab 23778f8b113aSFrank Schaefer /* Add image controls */ 23788f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 23798f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 23808f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_CONTRAST)) 23818f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 23828f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 23838f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 23848f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BRIGHTNESS)) 23858f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 23868f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 23878f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 23888f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SATURATION)) 23898f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 23908f8b113aSFrank Schaefer V4L2_CID_SATURATION, 23918f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 23928f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BLUE_BALANCE)) 23938f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 23948f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 23958f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 23968f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_RED_BALANCE)) 23978f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 23988f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 23998f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 24008f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SHARPNESS)) 24018f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 24028f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 24038f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 24048f8b113aSFrank Schaefer 24058f8b113aSFrank Schaefer /* Reset image controls */ 24068f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 24078f8b113aSFrank Schaefer v4l2_ctrl_handler_setup(&dev->ctrl_handler); 2408b64f8e9aSMauro Carvalho Chehab ret = dev->ctrl_handler.error; 2409b64f8e9aSMauro Carvalho Chehab if (ret) 2410b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24118f8b113aSFrank Schaefer 24120c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 24130c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 24140c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 24150c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2416b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2417b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24180c0d06caSMauro Carvalho Chehab } 2419d3829fadSDevin Heitmueller dev->vdev->queue = &dev->vb_vidq; 2420d3829fadSDevin Heitmueller dev->vdev->queue->lock = &dev->vb_queue_lock; 24210c0d06caSMauro Carvalho Chehab 24226e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 24236e46dabaSFrank Schaefer if (dev->board.is_webcam) { 24246e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_QUERYSTD); 24256e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_STD); 24266e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_STD); 24273bc85cceSFrank Schaefer } else { 24283bc85cceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 24296e46dabaSFrank Schaefer } 243066df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 243166df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_TUNER); 243266df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_TUNER); 243366df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_FREQUENCY); 243466df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_FREQUENCY); 243566df67b7SFrank Schaefer } 2436c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2437c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_AUDIO); 2438c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_AUDIO); 2439c2dcef83SFrank Schaefer } 24406e46dabaSFrank Schaefer 24410c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 24420c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 24430c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 24440c0d06caSMauro Carvalho Chehab if (ret) { 24450c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 24460c0d06caSMauro Carvalho Chehab ret); 2447b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24480c0d06caSMauro Carvalho Chehab } 24490c0d06caSMauro Carvalho Chehab 24500c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 24510c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 24520c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 24530c0d06caSMauro Carvalho Chehab "vbi"); 24540c0d06caSMauro Carvalho Chehab 2455d3829fadSDevin Heitmueller dev->vbi_dev->queue = &dev->vb_vbiq; 2456d3829fadSDevin Heitmueller dev->vbi_dev->queue->lock = &dev->vb_vbi_queue_lock; 2457d3829fadSDevin Heitmueller 245866df67b7SFrank Schaefer /* disable inapplicable ioctls */ 245983c8bcceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 246066df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 246166df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_TUNER); 246266df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_TUNER); 246366df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_FREQUENCY); 246466df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_FREQUENCY); 246566df67b7SFrank Schaefer } 2466c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2467c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_AUDIO); 2468c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_AUDIO); 2469c2dcef83SFrank Schaefer } 247066df67b7SFrank Schaefer 24710c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 24720c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 24730c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 24740c0d06caSMauro Carvalho Chehab if (ret < 0) { 24750c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2476b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24770c0d06caSMauro Carvalho Chehab } 24780c0d06caSMauro Carvalho Chehab } 24790c0d06caSMauro Carvalho Chehab 24800c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 24810c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 24820c0d06caSMauro Carvalho Chehab "radio"); 24830c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 24840c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 2485b64f8e9aSMauro Carvalho Chehab ret = -ENODEV; 2486b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24870c0d06caSMauro Carvalho Chehab } 24880c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 24890c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 24900c0d06caSMauro Carvalho Chehab if (ret < 0) { 24910c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2492b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 24930c0d06caSMauro Carvalho Chehab } 24940c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 24950c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 24960c0d06caSMauro Carvalho Chehab } 24970c0d06caSMauro Carvalho Chehab 24980c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 24990c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 25000c0d06caSMauro Carvalho Chehab 25010c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 25020c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 25030c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 25040c0d06caSMauro Carvalho Chehab 2505b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 2506b64f8e9aSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 2507b64f8e9aSMauro Carvalho Chehab 2508b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2509b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2510b64f8e9aSMauro Carvalho Chehab 25119634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 25129634614fSMauro Carvalho Chehab 251347677e51SMauro Carvalho Chehab kref_get(&dev->ref); 251447677e51SMauro Carvalho Chehab 251501c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 25160c0d06caSMauro Carvalho Chehab return 0; 2517b64f8e9aSMauro Carvalho Chehab 2518b64f8e9aSMauro Carvalho Chehab unregister_dev: 2519b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_free(&dev->ctrl_handler); 2520b64f8e9aSMauro Carvalho Chehab v4l2_device_unregister(&dev->v4l2_dev); 2521b64f8e9aSMauro Carvalho Chehab err: 252201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2523b64f8e9aSMauro Carvalho Chehab return ret; 25240c0d06caSMauro Carvalho Chehab } 252501c28193SMauro Carvalho Chehab 252601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 252701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 252801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 252901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 253001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2531a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2532a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 253301c28193SMauro Carvalho Chehab }; 253401c28193SMauro Carvalho Chehab 253501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 253601c28193SMauro Carvalho Chehab { 253701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 253801c28193SMauro Carvalho Chehab } 253901c28193SMauro Carvalho Chehab 254001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 254101c28193SMauro Carvalho Chehab { 254201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 254301c28193SMauro Carvalho Chehab } 254401c28193SMauro Carvalho Chehab 254501c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 254601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2547