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" 410c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4350fdf40fSHans Verkuil #include <media/v4l2-event.h> 440c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 450c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 460c0d06caSMauro Carvalho Chehab 470c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 480c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 490c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 500c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 510c0d06caSMauro Carvalho Chehab 520c0d06caSMauro Carvalho Chehab #define DRIVER_DESC "Empia em28xx based USB video device driver" 530c0d06caSMauro Carvalho Chehab 5443a20d79SFrank Schaefer #define EM28XX_VERSION "0.2.0" 550c0d06caSMauro Carvalho Chehab 560560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 570560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 580560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 590560f337SMauro Carvalho Chehab 600560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 610560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 620560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 630560f337SMauro Carvalho Chehab 640560f337SMauro Carvalho Chehab static int alt; 650560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 660560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 670560f337SMauro Carvalho Chehab 680c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 690c0d06caSMauro Carvalho Chehab if (video_debug) \ 700c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 710c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 720c0d06caSMauro Carvalho Chehab 730c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 740c0d06caSMauro Carvalho Chehab do {\ 750c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 760c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 770c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 780c0d06caSMauro Carvalho Chehab } \ 790c0d06caSMauro Carvalho Chehab } while (0) 800c0d06caSMauro Carvalho Chehab 810c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 820c0d06caSMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC); 830c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 840c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 850c0d06caSMauro Carvalho Chehab 86e507e0e5SFrank Schaefer 87e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 88e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 89e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 90e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 91e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 92e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 93e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 94e507e0e5SFrank Schaefer 95e507e0e5SFrank Schaefer 96d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 97d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 98d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 990c0d06caSMauro Carvalho Chehab 1000c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 1010c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 1020c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 1030c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 1040c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 1050c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 1060c0d06caSMauro Carvalho Chehab 1070c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1080c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1090c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1100c0d06caSMauro Carvalho Chehab 1110c0d06caSMauro Carvalho Chehab /* supported video standards */ 1120c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1130c0d06caSMauro Carvalho Chehab { 1140c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1150c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1160c0d06caSMauro Carvalho Chehab .depth = 16, 1170c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1180c0d06caSMauro Carvalho Chehab }, { 1190c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1200c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1210c0d06caSMauro Carvalho Chehab .depth = 16, 1220c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1230c0d06caSMauro Carvalho Chehab }, { 1240c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1250c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1260c0d06caSMauro Carvalho Chehab .depth = 8, 1270c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1280c0d06caSMauro Carvalho Chehab }, { 1290c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1300c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1310c0d06caSMauro Carvalho Chehab .depth = 8, 1320c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1330c0d06caSMauro Carvalho Chehab }, { 1340c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1350c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1360c0d06caSMauro Carvalho Chehab .depth = 8, 1370c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1380c0d06caSMauro Carvalho Chehab }, { 1390c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1400c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1410c0d06caSMauro Carvalho Chehab .depth = 12, 1420c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1430c0d06caSMauro Carvalho Chehab }, 1440c0d06caSMauro Carvalho Chehab }; 1450c0d06caSMauro Carvalho Chehab 1460560f337SMauro Carvalho Chehab int em28xx_vbi_supported(struct em28xx *dev) 1470560f337SMauro Carvalho Chehab { 1480560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1490560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1500560f337SMauro Carvalho Chehab return 0; 1510560f337SMauro Carvalho Chehab 1520560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1530560f337SMauro Carvalho Chehab return 0; 1540560f337SMauro Carvalho Chehab 1550560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1560560f337SMauro Carvalho Chehab 1570560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1580560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1590560f337SMauro Carvalho Chehab return 1; 1600560f337SMauro Carvalho Chehab 1610560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1620560f337SMauro Carvalho Chehab return 0; 1630560f337SMauro Carvalho Chehab } 1640560f337SMauro Carvalho Chehab 1650560f337SMauro Carvalho Chehab /* 1660560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1670560f337SMauro Carvalho Chehab * configure i2c attached devices 1680560f337SMauro Carvalho Chehab */ 1690560f337SMauro Carvalho Chehab void em28xx_wake_i2c(struct em28xx *dev) 1700560f337SMauro Carvalho Chehab { 1710560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, reset, 0); 1720560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 1730560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 1740560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_stream, 0); 1750560f337SMauro Carvalho Chehab } 1760560f337SMauro Carvalho Chehab 1770560f337SMauro Carvalho Chehab int em28xx_colorlevels_set_default(struct em28xx *dev) 1780560f337SMauro Carvalho Chehab { 1790560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 1800560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 1810560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 1820560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 1830560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 1840560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 1850560f337SMauro Carvalho Chehab 1860560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 1870560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 1880560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 1890560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 1900560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 1910560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 1920560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 1930560f337SMauro Carvalho Chehab } 1940560f337SMauro Carvalho Chehab 1950560f337SMauro Carvalho Chehab int em28xx_set_outfmt(struct em28xx *dev) 1960560f337SMauro Carvalho Chehab { 1970560f337SMauro Carvalho Chehab int ret; 1980560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 1990560f337SMauro Carvalho Chehab 2000560f337SMauro Carvalho Chehab fmt = dev->format->reg; 2010560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2020560f337SMauro Carvalho Chehab fmt |= 0x20; 2030560f337SMauro Carvalho Chehab /* 2040560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2050560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2060560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2070560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2080560f337SMauro Carvalho Chehab * 2090560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2100560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2110560f337SMauro Carvalho Chehab */ 2120560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2130560f337SMauro Carvalho Chehab if (ret < 0) 2140560f337SMauro Carvalho Chehab return ret; 2150560f337SMauro Carvalho Chehab 2160560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, dev->vinmode); 2170560f337SMauro Carvalho Chehab if (ret < 0) 2180560f337SMauro Carvalho Chehab return ret; 2190560f337SMauro Carvalho Chehab 2200560f337SMauro Carvalho Chehab vinctrl = dev->vinctl; 2210560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2220560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2230560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 2240560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, dev->vbi_width/4); 2250560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, dev->vbi_height); 2260560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 2270560f337SMauro Carvalho Chehab /* NTSC */ 2280560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 2290560f337SMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 2300560f337SMauro Carvalho Chehab /* PAL */ 2310560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2320560f337SMauro Carvalho Chehab } 2330560f337SMauro Carvalho Chehab } 2340560f337SMauro Carvalho Chehab 2350560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2360560f337SMauro Carvalho Chehab } 2370560f337SMauro Carvalho Chehab 2380560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2390560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2400560f337SMauro Carvalho Chehab { 2410560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2420560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2430560f337SMauro Carvalho Chehab 2440560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2450560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2460560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2470560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2480560f337SMauro Carvalho Chehab } 2490560f337SMauro Carvalho Chehab 2500560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2510560f337SMauro Carvalho Chehab u16 width, u16 height) 2520560f337SMauro Carvalho Chehab { 2530560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2540560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2550560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2560560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2570560f337SMauro Carvalho Chehab 2580560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2590560f337SMauro Carvalho Chehab hstart, vstart, 2600560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2610560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2620560f337SMauro Carvalho Chehab 2630560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2640560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2650560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2660560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2670560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2680560f337SMauro Carvalho Chehab 2690560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2700560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2710560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2720560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2730560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2740560f337SMauro Carvalho Chehab } 2750560f337SMauro Carvalho Chehab } 2760560f337SMauro Carvalho Chehab 2770560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 2780560f337SMauro Carvalho Chehab { 2790560f337SMauro Carvalho Chehab u8 mode; 2800560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 2810560f337SMauro Carvalho Chehab 2820560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 2830560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 2840560f337SMauro Carvalho Chehab } else { 2850560f337SMauro Carvalho Chehab u8 buf[2]; 2860560f337SMauro Carvalho Chehab 2870560f337SMauro Carvalho Chehab buf[0] = h; 2880560f337SMauro Carvalho Chehab buf[1] = h >> 8; 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 2900560f337SMauro Carvalho Chehab 2910560f337SMauro Carvalho Chehab buf[0] = v; 2920560f337SMauro Carvalho Chehab buf[1] = v >> 8; 2930560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 2940560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 2950560f337SMauro Carvalho Chehab to work correctly */ 2960560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 2970560f337SMauro Carvalho Chehab } 2980560f337SMauro Carvalho Chehab return em28xx_write_reg_bits(dev, EM28XX_R26_COMPR, mode, 0x30); 2990560f337SMauro Carvalho Chehab } 3000560f337SMauro Carvalho Chehab 3010560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 3020560f337SMauro Carvalho Chehab int em28xx_resolution_set(struct em28xx *dev) 3030560f337SMauro Carvalho Chehab { 3040560f337SMauro Carvalho Chehab int width, height; 3050560f337SMauro Carvalho Chehab width = norm_maxw(dev); 3060560f337SMauro Carvalho Chehab height = norm_maxh(dev); 3070560f337SMauro Carvalho Chehab 3080560f337SMauro Carvalho Chehab /* Properly setup VBI */ 3090560f337SMauro Carvalho Chehab dev->vbi_width = 720; 3100560f337SMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) 3110560f337SMauro Carvalho Chehab dev->vbi_height = 12; 3120560f337SMauro Carvalho Chehab else 3130560f337SMauro Carvalho Chehab dev->vbi_height = 18; 3140560f337SMauro Carvalho Chehab 3150560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3160560f337SMauro Carvalho Chehab 3170560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3180560f337SMauro Carvalho Chehab 3190560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3200560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3210560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3220560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3230560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3240560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3250560f337SMauro Carvalho Chehab region */ 3260560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3270560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3280560f337SMauro Carvalho Chehab else 3290560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3300560f337SMauro Carvalho Chehab 3310560f337SMauro Carvalho Chehab return em28xx_scaler_set(dev, dev->hscale, dev->vscale); 3320560f337SMauro Carvalho Chehab } 3330560f337SMauro Carvalho Chehab 3340560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 3350560f337SMauro Carvalho Chehab int em28xx_set_alternate(struct em28xx *dev) 3360560f337SMauro Carvalho Chehab { 3370560f337SMauro Carvalho Chehab int errCode; 3380560f337SMauro Carvalho Chehab int i; 3390560f337SMauro Carvalho Chehab unsigned int min_pkt_size = dev->width * 2 + 4; 3400560f337SMauro Carvalho Chehab 3410560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3420560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3430560f337SMauro Carvalho Chehab dev->alt = 0; 3440560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3450560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3460560f337SMauro Carvalho Chehab dev->alt = alt; 3470560f337SMauro Carvalho Chehab goto set_alt; 3480560f337SMauro Carvalho Chehab } 3490560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3500560f337SMauro Carvalho Chehab goto set_alt; 3510560f337SMauro Carvalho Chehab 3520560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3530560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3540560f337SMauro Carvalho Chehab green screen will be received. 3550560f337SMauro Carvalho Chehab */ 3560560f337SMauro Carvalho Chehab if (dev->width * 2 * dev->height > 720 * 240 * 2) 3570560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3580560f337SMauro Carvalho Chehab 3590560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3600560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3610560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3620560f337SMauro Carvalho Chehab dev->alt = i; 3630560f337SMauro Carvalho Chehab break; 3640560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3650560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3660560f337SMauro Carvalho Chehab */ 3670560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3680560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3690560f337SMauro Carvalho Chehab dev->alt = i; 3700560f337SMauro Carvalho Chehab } 3710560f337SMauro Carvalho Chehab 3720560f337SMauro Carvalho Chehab set_alt: 3730560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 3740560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 3750560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 3760560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 3770560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 3780560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 3790560f337SMauro Carvalho Chehab } else { /* isoc */ 3800560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 3810560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 3820560f337SMauro Carvalho Chehab dev->max_pkt_size = 3830560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 3840560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 3850560f337SMauro Carvalho Chehab } 3860560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 3870560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 3880560f337SMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, dev->alt); 3890560f337SMauro Carvalho Chehab if (errCode < 0) { 3900560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 3910560f337SMauro Carvalho Chehab dev->alt, errCode); 3920560f337SMauro Carvalho Chehab return errCode; 3930560f337SMauro Carvalho Chehab } 3940560f337SMauro Carvalho Chehab return 0; 3950560f337SMauro Carvalho Chehab } 3960560f337SMauro Carvalho Chehab 3970c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 3980c0d06caSMauro Carvalho Chehab DMA and thread functions 3990c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4000c0d06caSMauro Carvalho Chehab 4010c0d06caSMauro Carvalho Chehab /* 402948a49aaSFrank Schaefer * Finish the current buffer 4030c0d06caSMauro Carvalho Chehab */ 404948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4050c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4060c0d06caSMauro Carvalho Chehab { 407d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 408d3829fadSDevin Heitmueller 409d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 410d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 411d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 412d3829fadSDevin Heitmueller 413d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 4140c0d06caSMauro Carvalho Chehab } 4150c0d06caSMauro Carvalho Chehab 4160c0d06caSMauro Carvalho Chehab /* 41736016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4180c0d06caSMauro Carvalho Chehab */ 4190c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4200c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 42136016a35SFrank Schaefer unsigned char *usb_buf, 4224078d625SFrank Schaefer unsigned long len) 4230c0d06caSMauro Carvalho Chehab { 4240c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4250c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 4260c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 4270c0d06caSMauro Carvalho Chehab 428d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 429d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4300c0d06caSMauro Carvalho Chehab 43136016a35SFrank Schaefer startread = usb_buf; 4320c0d06caSMauro Carvalho Chehab remain = len; 4330c0d06caSMauro Carvalho Chehab 434c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 43536016a35SFrank Schaefer fieldstart = buf->vb_buf; 436c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 43736016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4380c0d06caSMauro Carvalho Chehab 4398732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4408732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4410c0d06caSMauro Carvalho Chehab 4420c0d06caSMauro Carvalho Chehab if (dev->progressive) 4430c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4440c0d06caSMauro Carvalho Chehab else 4450c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4460c0d06caSMauro Carvalho Chehab 4470c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4480c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4490c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4500c0d06caSMauro Carvalho Chehab 451d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4520c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 4530c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 454d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 455d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 45636016a35SFrank Schaefer (char *)startwrite; 4570c0d06caSMauro Carvalho Chehab lencopy = remain; 4580c0d06caSMauro Carvalho Chehab } 4590c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4600c0d06caSMauro Carvalho Chehab return; 4610c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4620c0d06caSMauro Carvalho Chehab 4630c0d06caSMauro Carvalho Chehab remain -= lencopy; 4640c0d06caSMauro Carvalho Chehab 4650c0d06caSMauro Carvalho Chehab while (remain > 0) { 466c02ec71bSFrank Schaefer if (dev->progressive) 467c02ec71bSFrank Schaefer startwrite += lencopy; 468c02ec71bSFrank Schaefer else 4690c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 4700c0d06caSMauro Carvalho Chehab startread += lencopy; 4710c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 4720c0d06caSMauro Carvalho Chehab lencopy = remain; 4730c0d06caSMauro Carvalho Chehab else 4740c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 4750c0d06caSMauro Carvalho Chehab 47636016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 477d3829fadSDevin Heitmueller buf->length) { 4780c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 4790c0d06caSMauro Carvalho Chehab "(2)\n", 4800c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 481d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 482d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 4830c0d06caSMauro Carvalho Chehab (char *)startwrite; 4840c0d06caSMauro Carvalho Chehab } 4850c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4860c0d06caSMauro Carvalho Chehab break; 4870c0d06caSMauro Carvalho Chehab 4880c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4890c0d06caSMauro Carvalho Chehab 4900c0d06caSMauro Carvalho Chehab remain -= lencopy; 4910c0d06caSMauro Carvalho Chehab } 4920c0d06caSMauro Carvalho Chehab 4938732533bSFrank Schaefer buf->pos += len; 4940c0d06caSMauro Carvalho Chehab } 4950c0d06caSMauro Carvalho Chehab 49636016a35SFrank Schaefer /* 49736016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 49836016a35SFrank Schaefer */ 4990c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5000c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 50136016a35SFrank Schaefer unsigned char *usb_buf, 5024078d625SFrank Schaefer unsigned long len) 5030c0d06caSMauro Carvalho Chehab { 50436016a35SFrank Schaefer unsigned int offset; 5050c0d06caSMauro Carvalho Chehab 506d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 507d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5080c0d06caSMauro Carvalho Chehab 5098732533bSFrank Schaefer offset = buf->pos; 5100c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 51136016a35SFrank Schaefer if (buf->top_field == 0) 51236016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 5130c0d06caSMauro Carvalho Chehab 51436016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5158732533bSFrank Schaefer buf->pos += len; 5160c0d06caSMauro Carvalho Chehab } 5170c0d06caSMauro Carvalho Chehab 5180c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5190c0d06caSMauro Carvalho Chehab int packet, int status) 5200c0d06caSMauro Carvalho Chehab { 5210c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5220c0d06caSMauro Carvalho Chehab 5230c0d06caSMauro Carvalho Chehab switch (status) { 5240c0d06caSMauro Carvalho Chehab case -ENOENT: 5250c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5260c0d06caSMauro Carvalho Chehab break; 5270c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5280c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5290c0d06caSMauro Carvalho Chehab break; 5300c0d06caSMauro Carvalho Chehab case -ENOSR: 5310c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5320c0d06caSMauro Carvalho Chehab break; 5330c0d06caSMauro Carvalho Chehab case -EPIPE: 5340c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5350c0d06caSMauro Carvalho Chehab break; 5360c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5370c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5380c0d06caSMauro Carvalho Chehab break; 5390c0d06caSMauro Carvalho Chehab case -EPROTO: 5400c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5410c0d06caSMauro Carvalho Chehab break; 5420c0d06caSMauro Carvalho Chehab case -EILSEQ: 5430c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5440c0d06caSMauro Carvalho Chehab break; 5450c0d06caSMauro Carvalho Chehab case -ETIME: 5460c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5470c0d06caSMauro Carvalho Chehab break; 5480c0d06caSMauro Carvalho Chehab } 5490c0d06caSMauro Carvalho Chehab if (packet < 0) { 5500c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5510c0d06caSMauro Carvalho Chehab } else { 5520c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5530c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5540c0d06caSMauro Carvalho Chehab } 5550c0d06caSMauro Carvalho Chehab } 5560c0d06caSMauro Carvalho Chehab 5570c0d06caSMauro Carvalho Chehab /* 55824a6d849SFrank Schaefer * get the next available buffer from dma queue 5590c0d06caSMauro Carvalho Chehab */ 56024a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 56124a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5620c0d06caSMauro Carvalho Chehab { 56324a6d849SFrank Schaefer struct em28xx_buffer *buf; 5640c0d06caSMauro Carvalho Chehab 5650c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5660c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 56724a6d849SFrank Schaefer return NULL; 5680c0d06caSMauro Carvalho Chehab } 5690c0d06caSMauro Carvalho Chehab 5700c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 571d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 5720c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 573d3829fadSDevin Heitmueller list_del(&buf->list); 5748732533bSFrank Schaefer buf->pos = 0; 575d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 5760c0d06caSMauro Carvalho Chehab 57724a6d849SFrank Schaefer return buf; 5780c0d06caSMauro Carvalho Chehab } 5790c0d06caSMauro Carvalho Chehab 580e04c00d9SFrank Schaefer /* 581e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 582e04c00d9SFrank Schaefer */ 583e04c00d9SFrank Schaefer static struct em28xx_buffer * 584e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 585e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 586e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 587e04c00d9SFrank Schaefer { 588e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 589e04c00d9SFrank Schaefer if (buf != NULL) 590e04c00d9SFrank Schaefer finish_buffer(dev, buf); 591e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 592e04c00d9SFrank Schaefer } 593e04c00d9SFrank Schaefer if (buf != NULL) { 594e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 595e04c00d9SFrank Schaefer buf->pos = 0; 596e04c00d9SFrank Schaefer } 597e04c00d9SFrank Schaefer 598e04c00d9SFrank Schaefer return buf; 599e04c00d9SFrank Schaefer } 600e04c00d9SFrank Schaefer 601227b7c90SFrank Schaefer /* 602227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 603227b7c90SFrank Schaefer */ 604227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 605227b7c90SFrank Schaefer unsigned char *data_pkt, 606227b7c90SFrank Schaefer unsigned int data_len) 607227b7c90SFrank Schaefer { 608227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 609227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 610227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 611227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 612227b7c90SFrank Schaefer 613227b7c90SFrank Schaefer /* capture type 0 = vbi start 614227b7c90SFrank Schaefer capture type 1 = vbi in progress 615227b7c90SFrank Schaefer capture type 2 = video start 616227b7c90SFrank Schaefer capture type 3 = video in progress */ 617227b7c90SFrank Schaefer if (data_len >= 4) { 618227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 619227b7c90SFrank Schaefer * never split across packets */ 620227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 621227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 622227b7c90SFrank Schaefer /* Continuation */ 623227b7c90SFrank Schaefer data_pkt += 4; 624227b7c90SFrank Schaefer data_len -= 4; 625227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 626227b7c90SFrank Schaefer /* Field start (VBI mode) */ 627227b7c90SFrank Schaefer dev->capture_type = 0; 628227b7c90SFrank Schaefer dev->vbi_read = 0; 629227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 630227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 631227b7c90SFrank Schaefer data_pkt += 4; 632227b7c90SFrank Schaefer data_len -= 4; 633227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 634227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 635227b7c90SFrank Schaefer dev->capture_type = 2; 636227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 637227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 638227b7c90SFrank Schaefer data_pkt += 4; 639227b7c90SFrank Schaefer data_len -= 4; 640227b7c90SFrank Schaefer } 641227b7c90SFrank Schaefer } 642227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 643227b7c90SFrank Schaefer * have no continuation header */ 644227b7c90SFrank Schaefer 645227b7c90SFrank Schaefer if (dev->capture_type == 0) { 646227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 647227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 648227b7c90SFrank Schaefer dev->capture_type = 1; 649227b7c90SFrank Schaefer } 650227b7c90SFrank Schaefer 651227b7c90SFrank Schaefer if (dev->capture_type == 1) { 652227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 653227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 654227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 655227b7c90SFrank Schaefer 656227b7c90SFrank Schaefer /* Copy VBI data */ 657227b7c90SFrank Schaefer if (vbi_buf != NULL) 658227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 659227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 660227b7c90SFrank Schaefer 661227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 662227b7c90SFrank Schaefer /* Continue with copying video data */ 663227b7c90SFrank Schaefer dev->capture_type = 2; 664227b7c90SFrank Schaefer data_pkt += vbi_data_len; 665227b7c90SFrank Schaefer data_len -= vbi_data_len; 666227b7c90SFrank Schaefer } 667227b7c90SFrank Schaefer } 668227b7c90SFrank Schaefer 669227b7c90SFrank Schaefer if (dev->capture_type == 2) { 670227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 671227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 672227b7c90SFrank Schaefer dev->capture_type = 3; 673227b7c90SFrank Schaefer } 674227b7c90SFrank Schaefer 675227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 676227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 677227b7c90SFrank Schaefer } 678227b7c90SFrank Schaefer 679e507e0e5SFrank Schaefer /* 680e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 681e507e0e5SFrank Schaefer */ 682e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 683e507e0e5SFrank Schaefer unsigned char *data_pkt, 684e507e0e5SFrank Schaefer unsigned int data_len) 685e507e0e5SFrank Schaefer { 686e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 687e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 688e507e0e5SFrank Schaefer bool frame_end = 0; 689e507e0e5SFrank Schaefer 690e507e0e5SFrank Schaefer /* Check for header */ 691e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 692e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 693e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 694e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 695e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 696e507e0e5SFrank Schaefer dev->top_field = !(data_pkt[1] & 697e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 698e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 699e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 700e507e0e5SFrank Schaefer data_pkt += 2; 701e507e0e5SFrank Schaefer data_len -= 2; 702e507e0e5SFrank Schaefer } 703e507e0e5SFrank Schaefer 704e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 705e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 706e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 707e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 708e507e0e5SFrank Schaefer } 709e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 710e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 711e507e0e5SFrank Schaefer * first frame. 712e507e0e5SFrank Schaefer */ 713e507e0e5SFrank Schaefer } 714e507e0e5SFrank Schaefer 715e507e0e5SFrank Schaefer /* Copy data */ 716e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 717e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 718e507e0e5SFrank Schaefer 719e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 720e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 721e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 722e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 723e507e0e5SFrank Schaefer } 724e507e0e5SFrank Schaefer 725e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 726e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 727e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 728e507e0e5SFrank Schaefer * header like with the other em28xx devices. 729e507e0e5SFrank Schaefer */ 730e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 731e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 732e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 733e507e0e5SFrank Schaefer } 734e507e0e5SFrank Schaefer 735960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7360fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7370c0d06caSMauro Carvalho Chehab { 738227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 739227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 740227b7c90SFrank Schaefer unsigned int usb_data_len; 7410c0d06caSMauro Carvalho Chehab 7420c0d06caSMauro Carvalho Chehab if (!dev) 7430c0d06caSMauro Carvalho Chehab return 0; 7440c0d06caSMauro Carvalho Chehab 7452665c299SFrank Schaefer if (dev->disconnected) 7460c0d06caSMauro Carvalho Chehab return 0; 7470c0d06caSMauro Carvalho Chehab 7481653cb0cSFrank Schaefer if (urb->status < 0) 7490c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7500c0d06caSMauro Carvalho Chehab 7514601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7524601cc39SFrank Schaefer 7534601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7544601cc39SFrank Schaefer num_packets = 1; 7554601cc39SFrank Schaefer else /* isoc */ 7564601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7570c0d06caSMauro Carvalho Chehab 7584601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7594601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 760227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7614601cc39SFrank Schaefer 762227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7634601cc39SFrank Schaefer } else { /* isoc */ 7644601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7654601cc39SFrank Schaefer print_err_status(dev, i, 7664601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 7670c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 7680c0d06caSMauro Carvalho Chehab continue; 7690c0d06caSMauro Carvalho Chehab } 7700c0d06caSMauro Carvalho Chehab 771227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 772227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 7730c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 7740c0d06caSMauro Carvalho Chehab continue; 7750c0d06caSMauro Carvalho Chehab } 7760c0d06caSMauro Carvalho Chehab 777227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 7784601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 7794601cc39SFrank Schaefer } 7804601cc39SFrank Schaefer 781227b7c90SFrank Schaefer if (usb_data_len == 0) { 7824601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 7834601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 7844601cc39SFrank Schaefer continue; 7854601cc39SFrank Schaefer } 7860c0d06caSMauro Carvalho Chehab 787e507e0e5SFrank Schaefer if (dev->is_em25xx) 788e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 789e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 790e507e0e5SFrank Schaefer else 791e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 792e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 793e507e0e5SFrank Schaefer 7940c0d06caSMauro Carvalho Chehab } 795227b7c90SFrank Schaefer return 1; 7960c0d06caSMauro Carvalho Chehab } 7970c0d06caSMauro Carvalho Chehab 7980c0d06caSMauro Carvalho Chehab 799d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 800d3829fadSDevin Heitmueller { 801d3829fadSDevin Heitmueller switch (f_type) { 802d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 803d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 804d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 805d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 806d3829fadSDevin Heitmueller default: 807d3829fadSDevin Heitmueller BUG(); 808d3829fadSDevin Heitmueller return 0; 809d3829fadSDevin Heitmueller } 810d3829fadSDevin Heitmueller } 811d3829fadSDevin Heitmueller 812d3829fadSDevin Heitmueller /* Usage lock check functions */ 813d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 814d3829fadSDevin Heitmueller { 815d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 816d3829fadSDevin Heitmueller 817d3829fadSDevin Heitmueller /* is it free? */ 818d3829fadSDevin Heitmueller if (dev->resources & res_type) { 819d3829fadSDevin Heitmueller /* no, someone else uses it */ 820d3829fadSDevin Heitmueller return -EBUSY; 821d3829fadSDevin Heitmueller } 822d3829fadSDevin Heitmueller 823d3829fadSDevin Heitmueller /* it's free, grab it */ 824d3829fadSDevin Heitmueller dev->resources |= res_type; 825d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 826d3829fadSDevin Heitmueller return 0; 827d3829fadSDevin Heitmueller } 828d3829fadSDevin Heitmueller 829d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 830d3829fadSDevin Heitmueller { 831d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 832d3829fadSDevin Heitmueller 833d3829fadSDevin Heitmueller dev->resources &= ~res_type; 834d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 835d3829fadSDevin Heitmueller } 836d3829fadSDevin Heitmueller 8370c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 838d3829fadSDevin Heitmueller Videobuf2 operations 8390c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8400c0d06caSMauro Carvalho Chehab 841d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 842d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 843d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 8440c0d06caSMauro Carvalho Chehab { 845d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 846d3829fadSDevin Heitmueller unsigned long size; 8470c0d06caSMauro Carvalho Chehab 848d3829fadSDevin Heitmueller if (fmt) 849d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 850d3829fadSDevin Heitmueller else 851d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 8520c0d06caSMauro Carvalho Chehab 853d3829fadSDevin Heitmueller if (size == 0) 854d3829fadSDevin Heitmueller return -EINVAL; 8550c0d06caSMauro Carvalho Chehab 856d3829fadSDevin Heitmueller if (0 == *nbuffers) 857d3829fadSDevin Heitmueller *nbuffers = 32; 8580c0d06caSMauro Carvalho Chehab 859d3829fadSDevin Heitmueller *nplanes = 1; 860d3829fadSDevin Heitmueller sizes[0] = size; 8610c0d06caSMauro Carvalho Chehab 8620c0d06caSMauro Carvalho Chehab return 0; 8630c0d06caSMauro Carvalho Chehab } 8640c0d06caSMauro Carvalho Chehab 8650c0d06caSMauro Carvalho Chehab static int 866d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 8670c0d06caSMauro Carvalho Chehab { 868d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 8690c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 870d3829fadSDevin Heitmueller unsigned long size; 8710c0d06caSMauro Carvalho Chehab 872d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 8730c0d06caSMauro Carvalho Chehab 874d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 875d3829fadSDevin Heitmueller 876d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 877d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 878d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 8790c0d06caSMauro Carvalho Chehab return -EINVAL; 880d3829fadSDevin Heitmueller } 881d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 8820c0d06caSMauro Carvalho Chehab 883d3829fadSDevin Heitmueller return 0; 8840c0d06caSMauro Carvalho Chehab } 8850c0d06caSMauro Carvalho Chehab 886d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 887d3829fadSDevin Heitmueller { 888d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 889d3829fadSDevin Heitmueller struct v4l2_frequency f; 890d3829fadSDevin Heitmueller int rc = 0; 8910c0d06caSMauro Carvalho Chehab 892d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 893d3829fadSDevin Heitmueller 894d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 895d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 896d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 897d3829fadSDevin Heitmueller if (rc) 898d3829fadSDevin Heitmueller return rc; 899d3829fadSDevin Heitmueller 900032f1ddfSFrank Schaefer if (dev->streaming_users == 0) { 901d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 902d3829fadSDevin Heitmueller 903d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 904d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 905d3829fadSDevin Heitmueller 906d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 907d3829fadSDevin Heitmueller some i2c device 908d3829fadSDevin Heitmueller */ 909d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 910d3829fadSDevin Heitmueller 9110455eebfSFrank Schaefer dev->capture_type = -1; 912c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 913c647a91aSFrank Schaefer dev->analog_xfer_bulk, 9140c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 9150c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 916c647a91aSFrank Schaefer dev->packet_multiplier, 9170fa4a402SFrank Schaefer em28xx_urb_data_copy); 9180c0d06caSMauro Carvalho Chehab if (rc < 0) 919032f1ddfSFrank Schaefer return rc; 920d3829fadSDevin Heitmueller 921d3829fadSDevin Heitmueller /* 922d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 923d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 924d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 925d3829fadSDevin Heitmueller */ 926d3829fadSDevin Heitmueller 927d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 928d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 929d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 930d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 931d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 932d3829fadSDevin Heitmueller else 933d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 934d3829fadSDevin Heitmueller v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 9350c0d06caSMauro Carvalho Chehab } 9360c0d06caSMauro Carvalho Chehab 937032f1ddfSFrank Schaefer dev->streaming_users++; 938032f1ddfSFrank Schaefer 9390c0d06caSMauro Carvalho Chehab return rc; 9400c0d06caSMauro Carvalho Chehab } 9410c0d06caSMauro Carvalho Chehab 9423a799c27SMauro Carvalho Chehab static int em28xx_stop_streaming(struct vb2_queue *vq) 9430c0d06caSMauro Carvalho Chehab { 944d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 9450c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 946d3829fadSDevin Heitmueller unsigned long flags = 0; 9470c0d06caSMauro Carvalho Chehab 948d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9490c0d06caSMauro Carvalho Chehab 950d3829fadSDevin Heitmueller res_free(dev, vq->type); 951d3829fadSDevin Heitmueller 952d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 953d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 954d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9550c0d06caSMauro Carvalho Chehab } 9560c0d06caSMauro Carvalho Chehab 957d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 958d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 959d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 960d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 961d3829fadSDevin Heitmueller list_del(&buf->list); 962d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 963d3829fadSDevin Heitmueller } 964d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 965d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 966d3829fadSDevin Heitmueller 967d3829fadSDevin Heitmueller return 0; 968d3829fadSDevin Heitmueller } 969d3829fadSDevin Heitmueller 970d3829fadSDevin Heitmueller int em28xx_stop_vbi_streaming(struct vb2_queue *vq) 9710c0d06caSMauro Carvalho Chehab { 972d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 973d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 974d3829fadSDevin Heitmueller unsigned long flags = 0; 9750c0d06caSMauro Carvalho Chehab 976d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 9770c0d06caSMauro Carvalho Chehab 978d3829fadSDevin Heitmueller res_free(dev, vq->type); 979d3829fadSDevin Heitmueller 980d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 981d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 982d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 9830c0d06caSMauro Carvalho Chehab } 9840c0d06caSMauro Carvalho Chehab 985d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 986d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 987d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 988d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 989d3829fadSDevin Heitmueller list_del(&buf->list); 990d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 991d3829fadSDevin Heitmueller } 992d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 993d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 994d3829fadSDevin Heitmueller 995d3829fadSDevin Heitmueller return 0; 996d3829fadSDevin Heitmueller } 997d3829fadSDevin Heitmueller 998d3829fadSDevin Heitmueller static void 999d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1000d3829fadSDevin Heitmueller { 1001d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1002d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 1003d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1004d3829fadSDevin Heitmueller unsigned long flags = 0; 1005d3829fadSDevin Heitmueller 1006d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1007d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1008d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1009d3829fadSDevin Heitmueller 1010d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1011d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1012d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1013d3829fadSDevin Heitmueller } 1014d3829fadSDevin Heitmueller 1015d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1016d3829fadSDevin Heitmueller .queue_setup = queue_setup, 10170c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 10180c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1019d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1020d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1021d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1022d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 10230c0d06caSMauro Carvalho Chehab }; 10240c0d06caSMauro Carvalho Chehab 1025d3829fadSDevin Heitmueller int em28xx_vb2_setup(struct em28xx *dev) 1026d3829fadSDevin Heitmueller { 1027d3829fadSDevin Heitmueller int rc; 1028d3829fadSDevin Heitmueller struct vb2_queue *q; 1029d3829fadSDevin Heitmueller 1030d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 1031d3829fadSDevin Heitmueller q = &dev->vb_vidq; 1032d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1033ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1034195281d0SFrank Schaefer q->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1035d3829fadSDevin Heitmueller q->drv_priv = dev; 1036d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1037d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1038d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1039d3829fadSDevin Heitmueller 1040d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1041d3829fadSDevin Heitmueller if (rc < 0) 1042d3829fadSDevin Heitmueller return rc; 1043d3829fadSDevin Heitmueller 1044d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 1045d3829fadSDevin Heitmueller q = &dev->vb_vbiq; 1046d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1047d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1048195281d0SFrank Schaefer q->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1049d3829fadSDevin Heitmueller q->drv_priv = dev; 1050d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1051d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1052d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1053d3829fadSDevin Heitmueller 1054d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1055d3829fadSDevin Heitmueller if (rc < 0) 1056d3829fadSDevin Heitmueller return rc; 1057d3829fadSDevin Heitmueller 1058d3829fadSDevin Heitmueller return 0; 1059d3829fadSDevin Heitmueller } 1060d3829fadSDevin Heitmueller 10610c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 10620c0d06caSMauro Carvalho Chehab 10630c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 10640c0d06caSMauro Carvalho Chehab { 10650c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 10660c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 10670c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 10680c0d06caSMauro Carvalho Chehab 10690c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 10700c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 10710c0d06caSMauro Carvalho Chehab 10720c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 10730c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 10740c0d06caSMauro Carvalho Chehab 10750c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 10760c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 10770c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 10780c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 10790c0d06caSMauro Carvalho Chehab } 10800c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 10810c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 10820c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 10830c0d06caSMauro Carvalho Chehab } 10840c0d06caSMauro Carvalho Chehab 10850c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 10860c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 10870c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 10880c0d06caSMauro Carvalho Chehab } 10890c0d06caSMauro Carvalho Chehab 10900c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 10910c0d06caSMauro Carvalho Chehab } 10920c0d06caSMauro Carvalho Chehab 1093081b945eSHans Verkuil void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 10940c0d06caSMauro Carvalho Chehab { 1095081b945eSHans Verkuil struct em28xx *dev = priv; 10960c0d06caSMauro Carvalho Chehab 10970c0d06caSMauro Carvalho Chehab /* 1098081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1099081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1100081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1101081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 11020c0d06caSMauro Carvalho Chehab */ 11030c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 11040c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1105081b945eSHans Verkuil dev->mute = ctrl->val; 1106081b945eSHans Verkuil em28xx_audio_analog_set(dev); 11070c0d06caSMauro Carvalho Chehab break; 11080c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1109081b945eSHans Verkuil dev->volume = ctrl->val; 1110081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1111081b945eSHans Verkuil break; 1112081b945eSHans Verkuil } 1113081b945eSHans Verkuil } 1114081b945eSHans Verkuil 1115081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1116081b945eSHans Verkuil { 1117081b945eSHans Verkuil struct em28xx *dev = container_of(ctrl->handler, struct em28xx, ctrl_handler); 11188f8b113aSFrank Schaefer int ret = -EINVAL; 1119081b945eSHans Verkuil 1120081b945eSHans Verkuil switch (ctrl->id) { 1121081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1122081b945eSHans Verkuil dev->mute = ctrl->val; 11238f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1124081b945eSHans Verkuil break; 1125081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1126081b945eSHans Verkuil dev->volume = ctrl->val; 11278f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 11288f8b113aSFrank Schaefer break; 11298f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 11308f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 11318f8b113aSFrank Schaefer break; 11328f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 11338f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 11348f8b113aSFrank Schaefer break; 11358f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 11368f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 11378f8b113aSFrank Schaefer break; 11388f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 11398f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 11408f8b113aSFrank Schaefer break; 11418f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 11428f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 11438f8b113aSFrank Schaefer break; 11448f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 11458f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 11460c0d06caSMauro Carvalho Chehab break; 11470c0d06caSMauro Carvalho Chehab } 11480c0d06caSMauro Carvalho Chehab 11498f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 11500c0d06caSMauro Carvalho Chehab } 11510c0d06caSMauro Carvalho Chehab 1152081b945eSHans Verkuil const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1153081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1154081b945eSHans Verkuil }; 1155081b945eSHans Verkuil 11566b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 11570c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 11580c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 11590c0d06caSMauro Carvalho Chehab { 11600c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 11610c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 11620c0d06caSMauro Carvalho Chehab 11630c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 116481685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 116581685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 11660c0d06caSMauro Carvalho Chehab 11670c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 116881685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 116981685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 11700c0d06caSMauro Carvalho Chehab } 11710c0d06caSMauro Carvalho Chehab 1172b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1173b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1174b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1175b8374138SFrank Schaefer { 1176b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1177b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1178b8374138SFrank Schaefer 1179b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1180b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 1181b8374138SFrank Schaefer } 1182b8374138SFrank Schaefer 11830c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 11840c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 11850c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 11860c0d06caSMauro Carvalho Chehab 11870c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 11880c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 11890c0d06caSMauro Carvalho Chehab { 11900c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11910c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11920c0d06caSMauro Carvalho Chehab 11930c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 11940c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 11950c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 11960c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 11970c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 11980c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 11990c0d06caSMauro Carvalho Chehab 12000c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 12010c0d06caSMauro Carvalho Chehab if (dev->progressive) 12020c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12030c0d06caSMauro Carvalho Chehab else 12040c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 12050c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 12060c0d06caSMauro Carvalho Chehab return 0; 12070c0d06caSMauro Carvalho Chehab } 12080c0d06caSMauro Carvalho Chehab 12090c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 12100c0d06caSMauro Carvalho Chehab { 12110c0d06caSMauro Carvalho Chehab unsigned int i; 12120c0d06caSMauro Carvalho Chehab 12130c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 12140c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 12150c0d06caSMauro Carvalho Chehab return &format[i]; 12160c0d06caSMauro Carvalho Chehab 12170c0d06caSMauro Carvalho Chehab return NULL; 12180c0d06caSMauro Carvalho Chehab } 12190c0d06caSMauro Carvalho Chehab 12200c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 12210c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12220c0d06caSMauro Carvalho Chehab { 12230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12250c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 12260c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 12270c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 12280c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 12290c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 12300c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12310c0d06caSMauro Carvalho Chehab 12320c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 12330c0d06caSMauro Carvalho Chehab if (!fmt) { 12340c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 12350c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 12360c0d06caSMauro Carvalho Chehab return -EINVAL; 12370c0d06caSMauro Carvalho Chehab } 12380c0d06caSMauro Carvalho Chehab 12390c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 12400c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 12410c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 12420c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1243d3829fadSDevin Heitmueller /* 1244d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1245d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1246d3829fadSDevin Heitmueller * to 50% 1247d3829fadSDevin Heitmueller */ 12480c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 12490c0d06caSMauro Carvalho Chehab width /= 2; 12500c0d06caSMauro Carvalho Chehab } else { 12510c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 12520c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 12530c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 12540c0d06caSMauro Carvalho Chehab 1, 0); 12550c0d06caSMauro Carvalho Chehab } 12560c0d06caSMauro Carvalho Chehab 12576b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 125846f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 12590c0d06caSMauro Carvalho Chehab 12600c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 12610c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 12620c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1263e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 12640c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 12650c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 12660c0d06caSMauro Carvalho Chehab if (dev->progressive) 12670c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 12680c0d06caSMauro Carvalho Chehab else 12690c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 12700c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 127151dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 12720c0d06caSMauro Carvalho Chehab 12730c0d06caSMauro Carvalho Chehab return 0; 12740c0d06caSMauro Carvalho Chehab } 12750c0d06caSMauro Carvalho Chehab 12760c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 12770c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 12780c0d06caSMauro Carvalho Chehab { 12790c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 12800c0d06caSMauro Carvalho Chehab 12810c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 12820c0d06caSMauro Carvalho Chehab if (!fmt) 12830c0d06caSMauro Carvalho Chehab return -EINVAL; 12840c0d06caSMauro Carvalho Chehab 12850c0d06caSMauro Carvalho Chehab dev->format = fmt; 12860c0d06caSMauro Carvalho Chehab dev->width = width; 12870c0d06caSMauro Carvalho Chehab dev->height = height; 12880c0d06caSMauro Carvalho Chehab 12890c0d06caSMauro Carvalho Chehab /* set new image size */ 12906b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 12910c0d06caSMauro Carvalho Chehab 12920c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 12930c0d06caSMauro Carvalho Chehab 12940c0d06caSMauro Carvalho Chehab return 0; 12950c0d06caSMauro Carvalho Chehab } 12960c0d06caSMauro Carvalho Chehab 12970c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 12980c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 12990c0d06caSMauro Carvalho Chehab { 1300d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 13010c0d06caSMauro Carvalho Chehab 1302d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1303d3829fadSDevin Heitmueller return -EBUSY; 13040c0d06caSMauro Carvalho Chehab 13050c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 13060c0d06caSMauro Carvalho Chehab 13070c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 13080c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 13090c0d06caSMauro Carvalho Chehab } 13100c0d06caSMauro Carvalho Chehab 13110c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 13120c0d06caSMauro Carvalho Chehab { 13130c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13140c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13150c0d06caSMauro Carvalho Chehab 13160c0d06caSMauro Carvalho Chehab *norm = dev->norm; 13170c0d06caSMauro Carvalho Chehab 13180c0d06caSMauro Carvalho Chehab return 0; 13190c0d06caSMauro Carvalho Chehab } 13200c0d06caSMauro Carvalho Chehab 13210c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 13220c0d06caSMauro Carvalho Chehab { 13230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13250c0d06caSMauro Carvalho Chehab 13260c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 13270c0d06caSMauro Carvalho Chehab 13280c0d06caSMauro Carvalho Chehab return 0; 13290c0d06caSMauro Carvalho Chehab } 13300c0d06caSMauro Carvalho Chehab 1331314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 13320c0d06caSMauro Carvalho Chehab { 13330c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13340c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13350c0d06caSMauro Carvalho Chehab struct v4l2_format f; 13360c0d06caSMauro Carvalho Chehab 1337314527acSHans Verkuil if (norm == dev->norm) 1338d8c95c08SHans Verkuil return 0; 13390c0d06caSMauro Carvalho Chehab 1340d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1341d8c95c08SHans Verkuil return -EBUSY; 1342d8c95c08SHans Verkuil 1343314527acSHans Verkuil dev->norm = norm; 13440c0d06caSMauro Carvalho Chehab 13450c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1346d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1347314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 13480c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 13490c0d06caSMauro Carvalho Chehab 13500c0d06caSMauro Carvalho Chehab /* set new image size */ 13510c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 13520c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 13536b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 13540c0d06caSMauro Carvalho Chehab 13550c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 13560c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 13570c0d06caSMauro Carvalho Chehab 13580c0d06caSMauro Carvalho Chehab return 0; 13590c0d06caSMauro Carvalho Chehab } 13600c0d06caSMauro Carvalho Chehab 13610c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 13620c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 13630c0d06caSMauro Carvalho Chehab { 13640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13660c0d06caSMauro Carvalho Chehab int rc = 0; 13670c0d06caSMauro Carvalho Chehab 136886ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 13690c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 13700c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 13710c0d06caSMauro Carvalho Chehab video, g_parm, p); 13720c0d06caSMauro Carvalho Chehab else 13730c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 13740c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 13750c0d06caSMauro Carvalho Chehab 13760c0d06caSMauro Carvalho Chehab return rc; 13770c0d06caSMauro Carvalho Chehab } 13780c0d06caSMauro Carvalho Chehab 13790c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 13800c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 13810c0d06caSMauro Carvalho Chehab { 13820c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13830c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13840c0d06caSMauro Carvalho Chehab 138586ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 13860c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 13870c0d06caSMauro Carvalho Chehab } 13880c0d06caSMauro Carvalho Chehab 13890c0d06caSMauro Carvalho Chehab static const char *iname[] = { 13900c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 13910c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 13920c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 13930c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 13940c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 13950c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 13960c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 13970c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 13980c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 13990c0d06caSMauro Carvalho Chehab }; 14000c0d06caSMauro Carvalho Chehab 14010c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 14020c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 14030c0d06caSMauro Carvalho Chehab { 14040c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14050c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14060c0d06caSMauro Carvalho Chehab unsigned int n; 14070c0d06caSMauro Carvalho Chehab 14080c0d06caSMauro Carvalho Chehab n = i->index; 14090c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 14100c0d06caSMauro Carvalho Chehab return -EINVAL; 14110c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 14120c0d06caSMauro Carvalho Chehab return -EINVAL; 14130c0d06caSMauro Carvalho Chehab 14140c0d06caSMauro Carvalho Chehab i->index = n; 14150c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 14160c0d06caSMauro Carvalho Chehab 14170c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 14180c0d06caSMauro Carvalho Chehab 14190c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 14200c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 14210c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 14220c0d06caSMauro Carvalho Chehab 14230c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 1424d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1425d8c95c08SHans Verkuil if (dev->board.is_webcam) 1426d8c95c08SHans Verkuil i->capabilities = 0; 14270c0d06caSMauro Carvalho Chehab 14280c0d06caSMauro Carvalho Chehab return 0; 14290c0d06caSMauro Carvalho Chehab } 14300c0d06caSMauro Carvalho Chehab 14310c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 14320c0d06caSMauro Carvalho Chehab { 14330c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14340c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14350c0d06caSMauro Carvalho Chehab 14360c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 14370c0d06caSMauro Carvalho Chehab 14380c0d06caSMauro Carvalho Chehab return 0; 14390c0d06caSMauro Carvalho Chehab } 14400c0d06caSMauro Carvalho Chehab 14410c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 14420c0d06caSMauro Carvalho Chehab { 14430c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14440c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14450c0d06caSMauro Carvalho Chehab 14460c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 14470c0d06caSMauro Carvalho Chehab return -EINVAL; 14480c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 14490c0d06caSMauro Carvalho Chehab return -EINVAL; 14500c0d06caSMauro Carvalho Chehab 14510c0d06caSMauro Carvalho Chehab video_mux(dev, i); 14520c0d06caSMauro Carvalho Chehab return 0; 14530c0d06caSMauro Carvalho Chehab } 14540c0d06caSMauro Carvalho Chehab 14550c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 14560c0d06caSMauro Carvalho Chehab { 14570c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14580c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14590c0d06caSMauro Carvalho Chehab 14600c0d06caSMauro Carvalho Chehab switch (a->index) { 14610c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 14620c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 14630c0d06caSMauro Carvalho Chehab break; 14640c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 14650c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 14660c0d06caSMauro Carvalho Chehab break; 14670c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 14680c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 14690c0d06caSMauro Carvalho Chehab break; 14700c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 14710c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 14720c0d06caSMauro Carvalho Chehab break; 14730c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 14740c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 14750c0d06caSMauro Carvalho Chehab break; 14760c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 14770c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 14780c0d06caSMauro Carvalho Chehab break; 14790c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 14800c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 14810c0d06caSMauro Carvalho Chehab break; 14820c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 14830c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 14840c0d06caSMauro Carvalho Chehab break; 14850c0d06caSMauro Carvalho Chehab default: 14860c0d06caSMauro Carvalho Chehab return -EINVAL; 14870c0d06caSMauro Carvalho Chehab } 14880c0d06caSMauro Carvalho Chehab 14890c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 14900c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 14910c0d06caSMauro Carvalho Chehab 14920c0d06caSMauro Carvalho Chehab return 0; 14930c0d06caSMauro Carvalho Chehab } 14940c0d06caSMauro Carvalho Chehab 14950e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 14960c0d06caSMauro Carvalho Chehab { 14970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14990c0d06caSMauro Carvalho Chehab 15000c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 15010c0d06caSMauro Carvalho Chehab return -EINVAL; 15020c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 15030c0d06caSMauro Carvalho Chehab return -EINVAL; 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 15060c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 15070c0d06caSMauro Carvalho Chehab 15080c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 15090c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 15100c0d06caSMauro Carvalho Chehab 15110c0d06caSMauro Carvalho Chehab return 0; 15120c0d06caSMauro Carvalho Chehab } 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15150c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15160c0d06caSMauro Carvalho Chehab { 15170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15190c0d06caSMauro Carvalho Chehab 15200c0d06caSMauro Carvalho Chehab if (0 != t->index) 15210c0d06caSMauro Carvalho Chehab return -EINVAL; 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 15260c0d06caSMauro Carvalho Chehab return 0; 15270c0d06caSMauro Carvalho Chehab } 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15302f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15310c0d06caSMauro Carvalho Chehab { 15320c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15330c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab if (0 != t->index) 15360c0d06caSMauro Carvalho Chehab return -EINVAL; 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 15390c0d06caSMauro Carvalho Chehab return 0; 15400c0d06caSMauro Carvalho Chehab } 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15430c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15440c0d06caSMauro Carvalho Chehab { 15450c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15470c0d06caSMauro Carvalho Chehab 154820deebfeSHans Verkuil if (0 != f->tuner) 154920deebfeSHans Verkuil return -EINVAL; 155020deebfeSHans Verkuil 15510c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 15520c0d06caSMauro Carvalho Chehab return 0; 15530c0d06caSMauro Carvalho Chehab } 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1556b530a447SHans Verkuil const struct v4l2_frequency *f) 15570c0d06caSMauro Carvalho Chehab { 1558b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 15590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15610c0d06caSMauro Carvalho Chehab 15620c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 15630c0d06caSMauro Carvalho Chehab return -EINVAL; 15640c0d06caSMauro Carvalho Chehab 15650c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 1566b530a447SHans Verkuil v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_frequency, &new_freq); 1567b530a447SHans Verkuil dev->ctl_freq = new_freq.frequency; 15680c0d06caSMauro Carvalho Chehab 15690c0d06caSMauro Carvalho Chehab return 0; 15700c0d06caSMauro Carvalho Chehab } 15710c0d06caSMauro Carvalho Chehab 1572cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 157396b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 157496b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 15753b2d17b4SHans Verkuil { 15763b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 15773b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 15783b2d17b4SHans Verkuil 15793b2d17b4SHans Verkuil if (chip->match.addr > 1) 15803b2d17b4SHans Verkuil return -EINVAL; 15813b2d17b4SHans Verkuil if (chip->match.addr == 1) 15823b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 15833b2d17b4SHans Verkuil else 15843b2d17b4SHans Verkuil strlcpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name)); 15853b2d17b4SHans Verkuil return 0; 15863b2d17b4SHans Verkuil } 15873b2d17b4SHans Verkuil 158835deba32SFrank Schaefer static int em28xx_reg_len(int reg) 158935deba32SFrank Schaefer { 159035deba32SFrank Schaefer switch (reg) { 159135deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 159235deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 159335deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 159435deba32SFrank Schaefer return 2; 159535deba32SFrank Schaefer default: 159635deba32SFrank Schaefer return 1; 159735deba32SFrank Schaefer } 159835deba32SFrank Schaefer } 15990c0d06caSMauro Carvalho Chehab 16000c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16010c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16020c0d06caSMauro Carvalho Chehab { 16030c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16040c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16050c0d06caSMauro Carvalho Chehab int ret; 16060c0d06caSMauro Carvalho Chehab 16073b2d17b4SHans Verkuil if (reg->match.addr > 1) 16083b2d17b4SHans Verkuil return -EINVAL; 1609abca2056SHans Verkuil if (reg->match.addr) { 16100c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16110c0d06caSMauro Carvalho Chehab if (ret < 0) 16120c0d06caSMauro Carvalho Chehab return ret; 16130c0d06caSMauro Carvalho Chehab 16140c0d06caSMauro Carvalho Chehab reg->val = ret; 16150c0d06caSMauro Carvalho Chehab reg->size = 1; 16160c0d06caSMauro Carvalho Chehab return 0; 16170c0d06caSMauro Carvalho Chehab } 16180c0d06caSMauro Carvalho Chehab 16190c0d06caSMauro Carvalho Chehab /* Match host */ 16200c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16210c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16220c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16230c0d06caSMauro Carvalho Chehab 16240c0d06caSMauro Carvalho Chehab if (ret < 0) 16250c0d06caSMauro Carvalho Chehab return ret; 16260c0d06caSMauro Carvalho Chehab 16270c0d06caSMauro Carvalho Chehab reg->val = ret; 16280c0d06caSMauro Carvalho Chehab } else { 16290c0d06caSMauro Carvalho Chehab __le16 val = 0; 16300c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16310c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16320c0d06caSMauro Carvalho Chehab if (ret < 0) 16330c0d06caSMauro Carvalho Chehab return ret; 16340c0d06caSMauro Carvalho Chehab 16350c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16360c0d06caSMauro Carvalho Chehab } 16370c0d06caSMauro Carvalho Chehab 16380c0d06caSMauro Carvalho Chehab return 0; 16390c0d06caSMauro Carvalho Chehab } 16400c0d06caSMauro Carvalho Chehab 16410c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1642977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 16430c0d06caSMauro Carvalho Chehab { 16440c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16450c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16460c0d06caSMauro Carvalho Chehab __le16 buf; 16470c0d06caSMauro Carvalho Chehab 16483b2d17b4SHans Verkuil if (reg->match.addr > 1) 16493b2d17b4SHans Verkuil return -EINVAL; 1650abca2056SHans Verkuil if (reg->match.addr) 16510c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16520c0d06caSMauro Carvalho Chehab 16530c0d06caSMauro Carvalho Chehab /* Match host */ 16540c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 16550c0d06caSMauro Carvalho Chehab 16560c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 16570c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 16580c0d06caSMauro Carvalho Chehab } 16590c0d06caSMauro Carvalho Chehab #endif 16600c0d06caSMauro Carvalho Chehab 16610c0d06caSMauro Carvalho Chehab 16620c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 16630c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 16640c0d06caSMauro Carvalho Chehab { 1665a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 16660c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16670c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16680c0d06caSMauro Carvalho Chehab 16690c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 16700c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 16710c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 16720c0d06caSMauro Carvalho Chehab 1673a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1674a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1675a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1676a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1677a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1678a9d79fe5SHans Verkuil else 16791d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 16800c0d06caSMauro Carvalho Chehab 16810c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1682a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 16830c0d06caSMauro Carvalho Chehab 16840c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1685a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 16860c0d06caSMauro Carvalho Chehab 1687a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1688a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1689a9d79fe5SHans Verkuil if (dev->vbi_dev) 16901d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1691a9d79fe5SHans Verkuil if (dev->radio_dev) 1692a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 16930c0d06caSMauro Carvalho Chehab return 0; 16940c0d06caSMauro Carvalho Chehab } 16950c0d06caSMauro Carvalho Chehab 16960c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 16970c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 16980c0d06caSMauro Carvalho Chehab { 16990c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 17000c0d06caSMauro Carvalho Chehab return -EINVAL; 17010c0d06caSMauro Carvalho Chehab 17020c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 17030c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 17040c0d06caSMauro Carvalho Chehab 17050c0d06caSMauro Carvalho Chehab return 0; 17060c0d06caSMauro Carvalho Chehab } 17070c0d06caSMauro Carvalho Chehab 17080c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 17090c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 17100c0d06caSMauro Carvalho Chehab { 17110c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17120c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17130c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 17140c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 17150c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 17160c0d06caSMauro Carvalho Chehab 17170c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 17180c0d06caSMauro Carvalho Chehab if (!fmt) { 17190c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 17200c0d06caSMauro Carvalho Chehab fsize->pixel_format); 17210c0d06caSMauro Carvalho Chehab return -EINVAL; 17220c0d06caSMauro Carvalho Chehab } 17230c0d06caSMauro Carvalho Chehab 17240c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 17250c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 17260c0d06caSMauro Carvalho Chehab return -EINVAL; 17270c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 17280c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 17290c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 17300c0d06caSMauro Carvalho Chehab return 0; 17310c0d06caSMauro Carvalho Chehab } 17320c0d06caSMauro Carvalho Chehab 17330c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 17340c0d06caSMauro Carvalho Chehab return -EINVAL; 17350c0d06caSMauro Carvalho Chehab 17360c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 17370c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 17386c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 17396c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 17406c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 17410c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 17426c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 17436c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 17440c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 17450c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 17460c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 17470c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 17480c0d06caSMauro Carvalho Chehab return 0; 17490c0d06caSMauro Carvalho Chehab } 17500c0d06caSMauro Carvalho Chehab 17510c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 17540c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 17550c0d06caSMauro Carvalho Chehab { 17560c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17570c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17580c0d06caSMauro Carvalho Chehab 17590c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 17600c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 17610c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 17620c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 17630c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 17640c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 17650c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 17662a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 17670c0d06caSMauro Carvalho Chehab 17680c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 17690c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 17700c0d06caSMauro Carvalho Chehab /* NTSC */ 17710c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 17720c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 17730c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 17740c0d06caSMauro Carvalho Chehab /* PAL */ 17750c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 17760c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 17770c0d06caSMauro Carvalho Chehab } 17780c0d06caSMauro Carvalho Chehab 17790c0d06caSMauro Carvalho Chehab return 0; 17800c0d06caSMauro Carvalho Chehab } 17810c0d06caSMauro Carvalho Chehab 17820c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 17830c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 17840c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 17850c0d06caSMauro Carvalho Chehab 17860c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 17870c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17880c0d06caSMauro Carvalho Chehab { 17890c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 17900c0d06caSMauro Carvalho Chehab 17910c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 17920c0d06caSMauro Carvalho Chehab return -EINVAL; 17930c0d06caSMauro Carvalho Chehab 17940c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 17970c0d06caSMauro Carvalho Chehab 17980c0d06caSMauro Carvalho Chehab return 0; 17990c0d06caSMauro Carvalho Chehab } 18000c0d06caSMauro Carvalho Chehab 18010c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18022f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18030c0d06caSMauro Carvalho Chehab { 18040c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18050c0d06caSMauro Carvalho Chehab 18060c0d06caSMauro Carvalho Chehab if (0 != t->index) 18070c0d06caSMauro Carvalho Chehab return -EINVAL; 18080c0d06caSMauro Carvalho Chehab 18090c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 18100c0d06caSMauro Carvalho Chehab 18110c0d06caSMauro Carvalho Chehab return 0; 18120c0d06caSMauro Carvalho Chehab } 18130c0d06caSMauro Carvalho Chehab 18140c0d06caSMauro Carvalho Chehab /* 18150c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 18160c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 18170c0d06caSMauro Carvalho Chehab */ 18180c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 18190c0d06caSMauro Carvalho Chehab { 18200c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 18210c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 18220c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 18230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 18240c0d06caSMauro Carvalho Chehab 18250c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 18260c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 18270c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 18280c0d06caSMauro Carvalho Chehab break; 18290c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 18300c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 18310c0d06caSMauro Carvalho Chehab break; 18320c0d06caSMauro Carvalho Chehab } 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 18350c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 18360c0d06caSMauro Carvalho Chehab dev->users); 18370c0d06caSMauro Carvalho Chehab 18380c0d06caSMauro Carvalho Chehab 18390c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 18400c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 18410c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 18420c0d06caSMauro Carvalho Chehab if (!fh) { 18430c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 18440c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 18450c0d06caSMauro Carvalho Chehab return -ENOMEM; 18460c0d06caSMauro Carvalho Chehab } 184769a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 18480c0d06caSMauro Carvalho Chehab fh->dev = dev; 18490c0d06caSMauro Carvalho Chehab fh->type = fh_type; 18500c0d06caSMauro Carvalho Chehab filp->private_data = fh; 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 18530c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 18540c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 18550c0d06caSMauro Carvalho Chehab 18560c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 18570c0d06caSMauro Carvalho Chehab some i2c device 18580c0d06caSMauro Carvalho Chehab */ 18590c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 18600c0d06caSMauro Carvalho Chehab 18610c0d06caSMauro Carvalho Chehab } 1862d3829fadSDevin Heitmueller 1863d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 18640c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 18650c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 18660c0d06caSMauro Carvalho Chehab } 18670c0d06caSMauro Carvalho Chehab 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 /* 18770c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 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 */ 18810c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 18820c0d06caSMauro Carvalho Chehab { 18830c0d06caSMauro Carvalho Chehab 18840c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 18850c0d06caSMauro Carvalho Chehab 18860c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 18870c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 18880c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 18890c0d06caSMauro Carvalho Chehab else 18900c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 18910c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 18920c0d06caSMauro Carvalho Chehab } 18930c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 18940c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 18950c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 18960c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 18970c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 18980c0d06caSMauro Carvalho Chehab else 18990c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 19000c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 19010c0d06caSMauro Carvalho Chehab } 19020c0d06caSMauro Carvalho Chehab if (dev->vdev) { 19030c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 19040c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 19050c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 19060c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 19070c0d06caSMauro Carvalho Chehab else 19080c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 19090c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 19100c0d06caSMauro Carvalho Chehab } 19110c0d06caSMauro Carvalho Chehab } 19120c0d06caSMauro Carvalho Chehab 19130c0d06caSMauro Carvalho Chehab /* 19140c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 19150c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 19160c0d06caSMauro Carvalho Chehab * calls and ioctls 19170c0d06caSMauro Carvalho Chehab */ 19180c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 19190c0d06caSMauro Carvalho Chehab { 19200c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 19210c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19220c0d06caSMauro Carvalho Chehab int errCode; 19230c0d06caSMauro Carvalho Chehab 19240c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 19250c0d06caSMauro Carvalho Chehab 1926d3829fadSDevin Heitmueller vb2_fop_release(filp); 192798c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 19280c0d06caSMauro Carvalho Chehab 19290c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 19300c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 19310c0d06caSMauro Carvalho Chehab free the remaining resources */ 19322665c299SFrank Schaefer if (dev->disconnected) { 19330c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 19340cf544a6SFrank Schaefer kfree(dev->alt_max_pkt_size_isoc); 1935e36c92fdSDan Carpenter mutex_unlock(&dev->lock); 19360c0d06caSMauro Carvalho Chehab kfree(dev); 19370c0d06caSMauro Carvalho Chehab return 0; 19380c0d06caSMauro Carvalho Chehab } 19390c0d06caSMauro Carvalho Chehab 19400c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 19410c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 19420c0d06caSMauro Carvalho Chehab 19430c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 19440c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 19450c0d06caSMauro Carvalho Chehab 19460c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 19470c0d06caSMauro Carvalho Chehab dev->alt = 0; 19480c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 19490c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 19500c0d06caSMauro Carvalho Chehab if (errCode < 0) { 19510c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 19520c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 19530c0d06caSMauro Carvalho Chehab } 19540c0d06caSMauro Carvalho Chehab } 19550c0d06caSMauro Carvalho Chehab 19560c0d06caSMauro Carvalho Chehab dev->users--; 19570c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19580c0d06caSMauro Carvalho Chehab return 0; 19590c0d06caSMauro Carvalho Chehab } 19600c0d06caSMauro Carvalho Chehab 19610c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 19620c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 19630c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 19640c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 1965d3829fadSDevin Heitmueller .read = vb2_fop_read, 1966d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 1967d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 19680c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 19690c0d06caSMauro Carvalho Chehab }; 19700c0d06caSMauro Carvalho Chehab 19710c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 19720c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 19730c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 19740c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 19750c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 19760c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 19770c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 19782a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 1979aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 19800c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 19810c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 19820c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 19830c0d06caSMauro Carvalho Chehab 1984d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 1985d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 1986d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 1987d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 1988d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 1989d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 1990d3829fadSDevin Heitmueller 19910c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 19920c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 19930c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 19940c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 19950c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 19960c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 19970c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 19980c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 1999d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2000d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 20010c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 20020c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 20030c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20040c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 200550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 200650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20070c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 200896b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 20090c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20100c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20110c0d06caSMauro Carvalho Chehab #endif 20120c0d06caSMauro Carvalho Chehab }; 20130c0d06caSMauro Carvalho Chehab 20140c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 20150c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 2016d3829fadSDevin Heitmueller .release = video_device_release_empty, 20170c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 20180c0d06caSMauro Carvalho Chehab 20190c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 20200c0d06caSMauro Carvalho Chehab }; 20210c0d06caSMauro Carvalho Chehab 20220c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 20230c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20240c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20250c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 20260c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20270c0d06caSMauro Carvalho Chehab }; 20280c0d06caSMauro Carvalho Chehab 20290c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2030a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 20310c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 20320c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 20330c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20340c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 203550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 203650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20370c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2038430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 20390c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20400c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20410c0d06caSMauro Carvalho Chehab #endif 20420c0d06caSMauro Carvalho Chehab }; 20430c0d06caSMauro Carvalho Chehab 20440c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 20450c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 20460c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 20470c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 20480c0d06caSMauro Carvalho Chehab }; 20490c0d06caSMauro Carvalho Chehab 20500c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 20510c0d06caSMauro Carvalho Chehab 20520c0d06caSMauro Carvalho Chehab 20530c0d06caSMauro Carvalho Chehab 20540c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 20550c0d06caSMauro Carvalho Chehab const struct video_device *template, 20560c0d06caSMauro Carvalho Chehab const char *type_name) 20570c0d06caSMauro Carvalho Chehab { 20580c0d06caSMauro Carvalho Chehab struct video_device *vfd; 20590c0d06caSMauro Carvalho Chehab 20600c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 20610c0d06caSMauro Carvalho Chehab if (NULL == vfd) 20620c0d06caSMauro Carvalho Chehab return NULL; 20630c0d06caSMauro Carvalho Chehab 20640c0d06caSMauro Carvalho Chehab *vfd = *template; 20650c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 20660c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 20670c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 206869a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 2069d8c95c08SHans Verkuil if (dev->board.is_webcam) 2070d8c95c08SHans Verkuil vfd->tvnorms = 0; 20710c0d06caSMauro Carvalho Chehab 20720c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 20730c0d06caSMauro Carvalho Chehab dev->name, type_name); 20740c0d06caSMauro Carvalho Chehab 20750c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 20760c0d06caSMauro Carvalho Chehab return vfd; 20770c0d06caSMauro Carvalho Chehab } 20780c0d06caSMauro Carvalho Chehab 20790560f337SMauro Carvalho Chehab static void em28xx_setup_xc3028(struct em28xx *dev, struct xc2028_ctrl *ctl) 20800560f337SMauro Carvalho Chehab { 20810560f337SMauro Carvalho Chehab memset(ctl, 0, sizeof(*ctl)); 20820560f337SMauro Carvalho Chehab 20830560f337SMauro Carvalho Chehab ctl->fname = XC2028_DEFAULT_FIRMWARE; 20840560f337SMauro Carvalho Chehab ctl->max_len = 64; 20850560f337SMauro Carvalho Chehab ctl->mts = em28xx_boards[dev->model].mts_firmware; 20860560f337SMauro Carvalho Chehab 20870560f337SMauro Carvalho Chehab switch (dev->model) { 20880560f337SMauro Carvalho Chehab case EM2880_BOARD_EMPIRE_DUAL_TV: 20890560f337SMauro Carvalho Chehab case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900: 20900560f337SMauro Carvalho Chehab case EM2882_BOARD_TERRATEC_HYBRID_XS: 20910560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_ZARLINK456; 20920560f337SMauro Carvalho Chehab break; 20930560f337SMauro Carvalho Chehab case EM2880_BOARD_TERRATEC_HYBRID_XS: 20940560f337SMauro Carvalho Chehab case EM2880_BOARD_TERRATEC_HYBRID_XS_FR: 20950560f337SMauro Carvalho Chehab case EM2881_BOARD_PINNACLE_HYBRID_PRO: 20960560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_ZARLINK456; 20970560f337SMauro Carvalho Chehab break; 20980560f337SMauro Carvalho Chehab case EM2880_BOARD_HAUPPAUGE_WINTV_HVR_900_R2: 20990560f337SMauro Carvalho Chehab case EM2882_BOARD_PINNACLE_HYBRID_PRO_330E: 21000560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_DEFAULT; 21010560f337SMauro Carvalho Chehab break; 21020560f337SMauro Carvalho Chehab case EM2880_BOARD_AMD_ATI_TV_WONDER_HD_600: 21030560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_DEFAULT; 21040560f337SMauro Carvalho Chehab ctl->fname = XC3028L_DEFAULT_FIRMWARE; 21050560f337SMauro Carvalho Chehab break; 21060560f337SMauro Carvalho Chehab case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_850: 21070560f337SMauro Carvalho Chehab case EM2883_BOARD_HAUPPAUGE_WINTV_HVR_950: 21080560f337SMauro Carvalho Chehab case EM2880_BOARD_PINNACLE_PCTV_HD_PRO: 21090560f337SMauro Carvalho Chehab /* FIXME: Better to specify the needed IF */ 21100560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_DEFAULT; 21110560f337SMauro Carvalho Chehab break; 21120560f337SMauro Carvalho Chehab case EM2883_BOARD_KWORLD_HYBRID_330U: 21130560f337SMauro Carvalho Chehab case EM2882_BOARD_DIKOM_DK300: 21140560f337SMauro Carvalho Chehab case EM2882_BOARD_KWORLD_VS_DVBT: 21150560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_CHINA; 21160560f337SMauro Carvalho Chehab ctl->fname = XC2028_DEFAULT_FIRMWARE; 21170560f337SMauro Carvalho Chehab break; 21180560f337SMauro Carvalho Chehab case EM2882_BOARD_EVGA_INDTUBE: 21190560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_CHINA; 21200560f337SMauro Carvalho Chehab ctl->fname = XC3028L_DEFAULT_FIRMWARE; 21210560f337SMauro Carvalho Chehab break; 21220560f337SMauro Carvalho Chehab default: 21230560f337SMauro Carvalho Chehab ctl->demod = XC3028_FE_OREN538; 21240560f337SMauro Carvalho Chehab } 21250560f337SMauro Carvalho Chehab } 21260560f337SMauro Carvalho Chehab 21270560f337SMauro Carvalho Chehab void em28xx_tuner_setup(struct em28xx *dev) 21280560f337SMauro Carvalho Chehab { 21290560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 21300560f337SMauro Carvalho Chehab struct v4l2_frequency f; 21310560f337SMauro Carvalho Chehab 21320560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_ABSENT) 21330560f337SMauro Carvalho Chehab return; 21340560f337SMauro Carvalho Chehab 21350560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 21360560f337SMauro Carvalho Chehab 21370560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 21380560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 21390560f337SMauro Carvalho Chehab 21400560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 21410560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 21420560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 21430560f337SMauro Carvalho Chehab 21440560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_type_addr, &tun_setup); 21450560f337SMauro Carvalho Chehab } 21460560f337SMauro Carvalho Chehab 21470560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 21480560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 21490560f337SMauro Carvalho Chehab tun_setup.addr = dev->tuner_addr; 21500560f337SMauro Carvalho Chehab 21510560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_type_addr, &tun_setup); 21520560f337SMauro Carvalho Chehab } 21530560f337SMauro Carvalho Chehab 21540560f337SMauro Carvalho Chehab if (dev->tda9887_conf) { 21550560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 21560560f337SMauro Carvalho Chehab 21570560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 21580560f337SMauro Carvalho Chehab tda9887_cfg.priv = &dev->tda9887_conf; 21590560f337SMauro Carvalho Chehab 21600560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_config, &tda9887_cfg); 21610560f337SMauro Carvalho Chehab } 21620560f337SMauro Carvalho Chehab 21630560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 21640560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 21650560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 21660560f337SMauro Carvalho Chehab 21670560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 21680560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 21690560f337SMauro Carvalho Chehab 21700560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 21710560f337SMauro Carvalho Chehab 21720560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 21730560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 21740560f337SMauro Carvalho Chehab 21750560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 21760560f337SMauro Carvalho Chehab } 21770560f337SMauro Carvalho Chehab 21780560f337SMauro Carvalho Chehab /* configure tuner */ 21790560f337SMauro Carvalho Chehab f.tuner = 0; 21800560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 21810560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 21820560f337SMauro Carvalho Chehab dev->ctl_freq = f.frequency; 21830560f337SMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 21840560f337SMauro Carvalho Chehab } 21850560f337SMauro Carvalho Chehab 21860c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 21870c0d06caSMauro Carvalho Chehab { 21880c0d06caSMauro Carvalho Chehab u8 val; 21890c0d06caSMauro Carvalho Chehab int ret; 21900c0d06caSMauro Carvalho Chehab unsigned int maxw; 21910c0d06caSMauro Carvalho Chehab 21920c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 21930c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 21940c0d06caSMauro Carvalho Chehab 21950c0d06caSMauro Carvalho Chehab /* set default norm */ 2196d8c95c08SHans Verkuil dev->norm = V4L2_STD_PAL; 21970c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 21980c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 21990c0d06caSMauro Carvalho Chehab 22000c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 22010c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 22020c0d06caSMauro Carvalho Chehab 22030c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 22040c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 22050c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 22060c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 22070c0d06caSMauro Carvalho Chehab maxw /= 2; 22080c0d06caSMauro Carvalho Chehab 22090c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 22100c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 22110c0d06caSMauro Carvalho Chehab 22120c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 22130c0d06caSMauro Carvalho Chehab 22140c0d06caSMauro Carvalho Chehab /* Audio defaults */ 22150c0d06caSMauro Carvalho Chehab dev->mute = 1; 22160c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 22170c0d06caSMauro Carvalho Chehab 22180c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 22190c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 22200c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 22210c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 22220c0d06caSMauro Carvalho Chehab 22230c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 22240c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 22250c0d06caSMauro Carvalho Chehab 22268f8b113aSFrank Schaefer /* Add image controls */ 22278f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 22288f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 22298f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_CONTRAST)) 22308f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22318f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 22328f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 22338f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BRIGHTNESS)) 22348f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22358f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 22368f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 22378f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SATURATION)) 22388f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22398f8b113aSFrank Schaefer V4L2_CID_SATURATION, 22408f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 22418f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BLUE_BALANCE)) 22428f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22438f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 22448f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 22458f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_RED_BALANCE)) 22468f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22478f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 22488f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 22498f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SHARPNESS)) 22508f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 22518f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 22528f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 22538f8b113aSFrank Schaefer 22548f8b113aSFrank Schaefer /* Reset image controls */ 22558f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 22568f8b113aSFrank Schaefer v4l2_ctrl_handler_setup(&dev->ctrl_handler); 22578f8b113aSFrank Schaefer if (dev->ctrl_handler.error) 22588f8b113aSFrank Schaefer return dev->ctrl_handler.error; 22598f8b113aSFrank Schaefer 22600c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 22610c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 22620c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 22630c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 22640c0d06caSMauro Carvalho Chehab return -ENODEV; 22650c0d06caSMauro Carvalho Chehab } 2266d3829fadSDevin Heitmueller dev->vdev->queue = &dev->vb_vidq; 2267d3829fadSDevin Heitmueller dev->vdev->queue->lock = &dev->vb_queue_lock; 22680c0d06caSMauro Carvalho Chehab 22696e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 22706e46dabaSFrank Schaefer if (dev->board.is_webcam) { 22716e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_QUERYSTD); 22726e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_STD); 22736e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_STD); 22743bc85cceSFrank Schaefer } else { 22753bc85cceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 22766e46dabaSFrank Schaefer } 227766df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 227866df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_TUNER); 227966df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_TUNER); 228066df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_FREQUENCY); 228166df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_FREQUENCY); 228266df67b7SFrank Schaefer } 2283c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2284c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_AUDIO); 2285c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_AUDIO); 2286c2dcef83SFrank Schaefer } 22876e46dabaSFrank Schaefer 22880c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 22890c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 22900c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 22910c0d06caSMauro Carvalho Chehab if (ret) { 22920c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 22930c0d06caSMauro Carvalho Chehab ret); 22940c0d06caSMauro Carvalho Chehab return ret; 22950c0d06caSMauro Carvalho Chehab } 22960c0d06caSMauro Carvalho Chehab 22970c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 22980c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 22990c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 23000c0d06caSMauro Carvalho Chehab "vbi"); 23010c0d06caSMauro Carvalho Chehab 2302d3829fadSDevin Heitmueller dev->vbi_dev->queue = &dev->vb_vbiq; 2303d3829fadSDevin Heitmueller dev->vbi_dev->queue->lock = &dev->vb_vbi_queue_lock; 2304d3829fadSDevin Heitmueller 230566df67b7SFrank Schaefer /* disable inapplicable ioctls */ 230683c8bcceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 230766df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 230866df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_TUNER); 230966df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_TUNER); 231066df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_FREQUENCY); 231166df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_FREQUENCY); 231266df67b7SFrank Schaefer } 2313c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 2314c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_AUDIO); 2315c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_AUDIO); 2316c2dcef83SFrank Schaefer } 231766df67b7SFrank Schaefer 23180c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 23190c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 23200c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 23210c0d06caSMauro Carvalho Chehab if (ret < 0) { 23220c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 23230c0d06caSMauro Carvalho Chehab return ret; 23240c0d06caSMauro Carvalho Chehab } 23250c0d06caSMauro Carvalho Chehab } 23260c0d06caSMauro Carvalho Chehab 23270c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 23280c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 23290c0d06caSMauro Carvalho Chehab "radio"); 23300c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 23310c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 23320c0d06caSMauro Carvalho Chehab return -ENODEV; 23330c0d06caSMauro Carvalho Chehab } 23340c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 23350c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 23360c0d06caSMauro Carvalho Chehab if (ret < 0) { 23370c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 23380c0d06caSMauro Carvalho Chehab return ret; 23390c0d06caSMauro Carvalho Chehab } 23400c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 23410c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 23420c0d06caSMauro Carvalho Chehab } 23430c0d06caSMauro Carvalho Chehab 23440c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 23450c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 23460c0d06caSMauro Carvalho Chehab 23470c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 23480c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 23490c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 23500c0d06caSMauro Carvalho Chehab 23510c0d06caSMauro Carvalho Chehab return 0; 23520c0d06caSMauro Carvalho Chehab } 2353