1f22e9e71SMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0+
2f22e9e71SMauro Carvalho Chehab //
3f22e9e71SMauro Carvalho Chehab // em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB
4f22e9e71SMauro Carvalho Chehab // video capture devices
5f22e9e71SMauro Carvalho Chehab //
6f22e9e71SMauro Carvalho Chehab // Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
7f22e9e71SMauro Carvalho Chehab // Markus Rechberger <mrechberger@gmail.com>
832590819SMauro Carvalho Chehab // Mauro Carvalho Chehab <mchehab@kernel.org>
9f22e9e71SMauro Carvalho Chehab // Sascha Sommer <saschasommer@freenet.de>
10f22e9e71SMauro Carvalho Chehab // Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com>
11f22e9e71SMauro Carvalho Chehab //
12f22e9e71SMauro Carvalho Chehab // Some parts based on SN9C10x PC Camera Controllers GPL driver made
13f22e9e71SMauro Carvalho Chehab // by Luca Risolia <luca.risolia@studio.unibo.it>
140c0d06caSMauro Carvalho Chehab
158314d402SMauro Carvalho Chehab #include "em28xx.h"
168314d402SMauro Carvalho Chehab
170c0d06caSMauro Carvalho Chehab #include <linux/init.h>
180c0d06caSMauro Carvalho Chehab #include <linux/list.h>
190c0d06caSMauro Carvalho Chehab #include <linux/module.h>
200c0d06caSMauro Carvalho Chehab #include <linux/kernel.h>
210c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h>
220c0d06caSMauro Carvalho Chehab #include <linux/usb.h>
230c0d06caSMauro Carvalho Chehab #include <linux/i2c.h>
240c0d06caSMauro Carvalho Chehab #include <linux/mm.h>
250c0d06caSMauro Carvalho Chehab #include <linux/mutex.h>
260c0d06caSMauro Carvalho Chehab #include <linux/slab.h>
270c0d06caSMauro Carvalho Chehab
2801c28193SMauro Carvalho Chehab #include "em28xx-v4l.h"
290c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h>
300c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h>
3150fdf40fSHans Verkuil #include <media/v4l2-event.h>
32d647f0b7SMauro Carvalho Chehab #include <media/drv-intf/msp3400.h>
330c0d06caSMauro Carvalho Chehab #include <media/tuner.h>
340c0d06caSMauro Carvalho Chehab
350c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \
360c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \
3732590819SMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@kernel.org>, " \
380c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>"
390c0d06caSMauro Carvalho Chehab
400560f337SMauro Carvalho Chehab static unsigned int isoc_debug;
410560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644);
420560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]");
430560f337SMauro Carvalho Chehab
440560f337SMauro Carvalho Chehab static unsigned int disable_vbi;
450560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644);
460560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support");
470560f337SMauro Carvalho Chehab
480560f337SMauro Carvalho Chehab static int alt;
490560f337SMauro Carvalho Chehab module_param(alt, int, 0644);
500560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint");
510560f337SMauro Carvalho Chehab
520c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do { \
530c0d06caSMauro Carvalho Chehab if (video_debug) \
5429b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \
55ce8591ffSMauro Carvalho Chehab "video: %s: " fmt, __func__, ## arg); \
56ce8591ffSMauro Carvalho Chehab } while (0)
570c0d06caSMauro Carvalho Chehab
582a96f60eSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) do {\
592a96f60eSMauro Carvalho Chehab if (isoc_debug) \
6029b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \
61ce8591ffSMauro Carvalho Chehab "isoc: %s: " fmt, __func__, ## arg); \
62ce8591ffSMauro Carvalho Chehab } while (0)
630c0d06caSMauro Carvalho Chehab
640c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR);
65d8992b09SMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC " - v4l2 interface");
66f22e9e71SMauro Carvalho Chehab MODULE_LICENSE("GPL v2");
670c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION);
680c0d06caSMauro Carvalho Chehab
69e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02
70e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20
71e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02
72e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01
73e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \
74e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \
75e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID)
76e507e0e5SFrank Schaefer
77d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U };
78d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U };
79d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U };
800c0d06caSMauro Carvalho Chehab
810c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444);
820c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444);
830c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444);
840c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers");
850c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers");
860c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers");
870c0d06caSMauro Carvalho Chehab
880c0d06caSMauro Carvalho Chehab static unsigned int video_debug;
890c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644);
900c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]");
910c0d06caSMauro Carvalho Chehab
920c0d06caSMauro Carvalho Chehab /* supported video standards */
930c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = {
940c0d06caSMauro Carvalho Chehab {
950c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV,
960c0d06caSMauro Carvalho Chehab .depth = 16,
970c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V,
980c0d06caSMauro Carvalho Chehab }, {
990c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565,
1000c0d06caSMauro Carvalho Chehab .depth = 16,
1010c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656,
1020c0d06caSMauro Carvalho Chehab }, {
103495ab569SFrank Schaefer .fourcc = V4L2_PIX_FMT_SRGGB8,
104495ab569SFrank Schaefer .depth = 8,
105495ab569SFrank Schaefer .reg = EM28XX_OUTFMT_RGB_8_RGRG,
106495ab569SFrank Schaefer }, {
1070c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8,
1080c0d06caSMauro Carvalho Chehab .depth = 8,
1090c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG,
1100c0d06caSMauro Carvalho Chehab }, {
1110c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8,
1120c0d06caSMauro Carvalho Chehab .depth = 8,
1130c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR,
1140c0d06caSMauro Carvalho Chehab }, {
1150c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8,
1160c0d06caSMauro Carvalho Chehab .depth = 8,
1170c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB,
1180c0d06caSMauro Carvalho Chehab }, {
1190c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P,
1200c0d06caSMauro Carvalho Chehab .depth = 12,
1210c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411,
1220c0d06caSMauro Carvalho Chehab },
1230c0d06caSMauro Carvalho Chehab };
1240c0d06caSMauro Carvalho Chehab
12525c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */
norm_maxw(struct em28xx * dev)12625c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev)
12725c61e4cSFrank Schaefer {
128d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
129d7dc18daSFrank Schaefer
130aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
131d7dc18daSFrank Schaefer return v4l2->sensor_xres;
13225c61e4cSFrank Schaefer
13325c61e4cSFrank Schaefer if (dev->board.max_range_640_480)
13425c61e4cSFrank Schaefer return 640;
13525c61e4cSFrank Schaefer
13625c61e4cSFrank Schaefer return 720;
13725c61e4cSFrank Schaefer }
13825c61e4cSFrank Schaefer
norm_maxh(struct em28xx * dev)13925c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev)
14025c61e4cSFrank Schaefer {
14152faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
14252faaf78SFrank Schaefer
143aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
144d7dc18daSFrank Schaefer return v4l2->sensor_yres;
14525c61e4cSFrank Schaefer
14625c61e4cSFrank Schaefer if (dev->board.max_range_640_480)
14725c61e4cSFrank Schaefer return 480;
14825c61e4cSFrank Schaefer
14952faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480;
15025c61e4cSFrank Schaefer }
15125c61e4cSFrank Schaefer
em28xx_vbi_supported(struct em28xx * dev)15201c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev)
1530560f337SMauro Carvalho Chehab {
1540560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */
1550560f337SMauro Carvalho Chehab if (disable_vbi == 1)
1560560f337SMauro Carvalho Chehab return 0;
1570560f337SMauro Carvalho Chehab
158aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
1590560f337SMauro Carvalho Chehab return 0;
1600560f337SMauro Carvalho Chehab
1610560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */
1620560f337SMauro Carvalho Chehab
1630560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 ||
1640560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883)
1650560f337SMauro Carvalho Chehab return 1;
1660560f337SMauro Carvalho Chehab
1670560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */
1680560f337SMauro Carvalho Chehab return 0;
1690560f337SMauro Carvalho Chehab }
1700560f337SMauro Carvalho Chehab
1710560f337SMauro Carvalho Chehab /*
1720560f337SMauro Carvalho Chehab * em28xx_wake_i2c()
1730560f337SMauro Carvalho Chehab * configure i2c attached devices
1740560f337SMauro Carvalho Chehab */
em28xx_wake_i2c(struct em28xx * dev)17501c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev)
1760560f337SMauro Carvalho Chehab {
17795d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev;
178fdf1bc9fSMauro Carvalho Chehab
17995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0);
18095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing,
1810560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0);
1820560f337SMauro Carvalho Chehab }
1830560f337SMauro Carvalho Chehab
em28xx_colorlevels_set_default(struct em28xx * dev)18401c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev)
1850560f337SMauro Carvalho Chehab {
1860560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT);
1870560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT);
1880560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT);
1890560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT);
1900560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT);
1910560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT);
1920560f337SMauro Carvalho Chehab
1930560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20);
1940560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20);
1950560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20);
1960560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20);
1970560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00);
1980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00);
1990560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00);
2000560f337SMauro Carvalho Chehab }
2010560f337SMauro Carvalho Chehab
em28xx_set_outfmt(struct em28xx * dev)20201c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev)
2030560f337SMauro Carvalho Chehab {
2040560f337SMauro Carvalho Chehab int ret;
2050560f337SMauro Carvalho Chehab u8 fmt, vinctrl;
206753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
2070560f337SMauro Carvalho Chehab
20806e20672SFrank Schaefer fmt = v4l2->format->reg;
2090560f337SMauro Carvalho Chehab if (!dev->is_em25xx)
2100560f337SMauro Carvalho Chehab fmt |= 0x20;
2110560f337SMauro Carvalho Chehab /*
2120560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed !
2130560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work
2140560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx
2150560f337SMauro Carvalho Chehab * devices and we've always been setting it, too.
2160560f337SMauro Carvalho Chehab *
2170560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set,
2180560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there.
2190560f337SMauro Carvalho Chehab */
2200560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt);
2210560f337SMauro Carvalho Chehab if (ret < 0)
2220560f337SMauro Carvalho Chehab return ret;
2230560f337SMauro Carvalho Chehab
2249297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode);
2250560f337SMauro Carvalho Chehab if (ret < 0)
2260560f337SMauro Carvalho Chehab return ret;
2270560f337SMauro Carvalho Chehab
2289297285eSFrank Schaefer vinctrl = v4l2->vinctl;
2290560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) {
2300560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW;
2310560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00);
232f9fe90a4SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH,
233f9fe90a4SMauro Carvalho Chehab v4l2->vbi_width / 4);
234753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height);
23552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) {
2360560f337SMauro Carvalho Chehab /* NTSC */
2370560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09);
23852faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) {
2390560f337SMauro Carvalho Chehab /* PAL */
2400560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07);
2410560f337SMauro Carvalho Chehab }
2420560f337SMauro Carvalho Chehab }
2430560f337SMauro Carvalho Chehab
2440560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl);
2450560f337SMauro Carvalho Chehab }
2460560f337SMauro Carvalho Chehab
em28xx_accumulator_set(struct em28xx * dev,u8 xmin,u8 xmax,u8 ymin,u8 ymax)2470560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax,
2480560f337SMauro Carvalho Chehab u8 ymin, u8 ymax)
2490560f337SMauro Carvalho Chehab {
2500560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n",
2510560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax);
2520560f337SMauro Carvalho Chehab
2530560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1);
2540560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1);
2550560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1);
2560560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1);
2570560f337SMauro Carvalho Chehab }
2580560f337SMauro Carvalho Chehab
em28xx_capture_area_set(struct em28xx * dev,u8 hstart,u8 vstart,u16 width,u16 height)2590560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart,
2600560f337SMauro Carvalho Chehab u16 width, u16 height)
2610560f337SMauro Carvalho Chehab {
2620560f337SMauro Carvalho Chehab u8 cwidth = width >> 2;
2630560f337SMauro Carvalho Chehab u8 cheight = height >> 2;
2640560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01);
2650560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */
2660560f337SMauro Carvalho Chehab
2670560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n",
2680560f337SMauro Carvalho Chehab hstart, vstart,
2690560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2),
2700560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2));
2710560f337SMauro Carvalho Chehab
2720560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1);
2730560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1);
2740560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1);
2750560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1);
2760560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1);
2770560f337SMauro Carvalho Chehab
2780560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */
2790560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */
2800560f337SMauro Carvalho Chehab if (dev->is_em25xx) {
2810560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4);
2820560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4);
2830560f337SMauro Carvalho Chehab }
2840560f337SMauro Carvalho Chehab }
2850560f337SMauro Carvalho Chehab
em28xx_scaler_set(struct em28xx * dev,u16 h,u16 v)2860560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v)
2870560f337SMauro Carvalho Chehab {
288cba8e9b3SFrank Schaefer u8 mode = 0x00;
2890560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */
2900560f337SMauro Carvalho Chehab
2910560f337SMauro Carvalho Chehab if (dev->board.is_em2800) {
2920560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00);
2930560f337SMauro Carvalho Chehab } else {
2940560f337SMauro Carvalho Chehab u8 buf[2];
2950560f337SMauro Carvalho Chehab
2960560f337SMauro Carvalho Chehab buf[0] = h;
2970560f337SMauro Carvalho Chehab buf[1] = h >> 8;
2980560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2);
2990560f337SMauro Carvalho Chehab
3000560f337SMauro Carvalho Chehab buf[0] = v;
3010560f337SMauro Carvalho Chehab buf[1] = v >> 8;
3020560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2);
303f9fe90a4SMauro Carvalho Chehab /*
304f9fe90a4SMauro Carvalho Chehab * it seems that both H and V scalers must be active
305f9fe90a4SMauro Carvalho Chehab * to work correctly
306f9fe90a4SMauro Carvalho Chehab */
3070560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00;
3080560f337SMauro Carvalho Chehab }
309cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode);
3100560f337SMauro Carvalho Chehab }
3110560f337SMauro Carvalho Chehab
3120560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */
em28xx_resolution_set(struct em28xx * dev)31301c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev)
3140560f337SMauro Carvalho Chehab {
315753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
316753aee77SFrank Schaefer int width = norm_maxw(dev);
317753aee77SFrank Schaefer int height = norm_maxh(dev);
3180560f337SMauro Carvalho Chehab
3190560f337SMauro Carvalho Chehab /* Properly setup VBI */
320753aee77SFrank Schaefer v4l2->vbi_width = 720;
32152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60)
322753aee77SFrank Schaefer v4l2->vbi_height = 12;
3230560f337SMauro Carvalho Chehab else
324753aee77SFrank Schaefer v4l2->vbi_height = 18;
3250560f337SMauro Carvalho Chehab
3260560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev);
3270560f337SMauro Carvalho Chehab
3280560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2);
3290560f337SMauro Carvalho Chehab
330f9fe90a4SMauro Carvalho Chehab /*
331f9fe90a4SMauro Carvalho Chehab * If we don't set the start position to 2 in VBI mode, we end up
332f9fe90a4SMauro Carvalho Chehab * with line 20/21 being YUYV encoded instead of being in 8-bit
333f9fe90a4SMauro Carvalho Chehab * greyscale. The core of the issue is that line 21 (and line 23 for
334f9fe90a4SMauro Carvalho Chehab * PAL WSS) are inside of active video region, and as a result they
335f9fe90a4SMauro Carvalho Chehab * get the pixelformatting associated with that area. So by cropping
336f9fe90a4SMauro Carvalho Chehab * it out, we end up with the same format as the rest of the VBI
337f9fe90a4SMauro Carvalho Chehab * region
338f9fe90a4SMauro Carvalho Chehab */
3390560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1)
3400560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height);
3410560f337SMauro Carvalho Chehab else
3420560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height);
3430560f337SMauro Carvalho Chehab
344753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale);
3450560f337SMauro Carvalho Chehab }
3460560f337SMauro Carvalho Chehab
3470560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */
em28xx_set_alternate(struct em28xx * dev)34801c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev)
3490560f337SMauro Carvalho Chehab {
350753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
351c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf);
352f9fe90a4SMauro Carvalho Chehab int err;
3530560f337SMauro Carvalho Chehab int i;
354753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4;
3550560f337SMauro Carvalho Chehab
356f9fe90a4SMauro Carvalho Chehab /*
357f9fe90a4SMauro Carvalho Chehab * NOTE: for isoc transfers, only alt settings > 0 are allowed
358f9fe90a4SMauro Carvalho Chehab * bulk transfers seem to work only with alt=0 !
359f9fe90a4SMauro Carvalho Chehab */
3600560f337SMauro Carvalho Chehab dev->alt = 0;
361f9fe90a4SMauro Carvalho Chehab if (alt > 0 && alt < dev->num_alt) {
3620560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt);
3630560f337SMauro Carvalho Chehab dev->alt = alt;
3640560f337SMauro Carvalho Chehab goto set_alt;
3650560f337SMauro Carvalho Chehab }
3660560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk)
3670560f337SMauro Carvalho Chehab goto set_alt;
3680560f337SMauro Carvalho Chehab
369f9fe90a4SMauro Carvalho Chehab /*
370f9fe90a4SMauro Carvalho Chehab * When image size is bigger than a certain value,
371f9fe90a4SMauro Carvalho Chehab * the frame size should be increased, otherwise, only
372f9fe90a4SMauro Carvalho Chehab * green screen will be received.
3730560f337SMauro Carvalho Chehab */
374753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2)
3750560f337SMauro Carvalho Chehab min_pkt_size *= 2;
3760560f337SMauro Carvalho Chehab
3770560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) {
3780560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */
3790560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) {
3800560f337SMauro Carvalho Chehab dev->alt = i;
3810560f337SMauro Carvalho Chehab break;
382f9fe90a4SMauro Carvalho Chehab /*
383f9fe90a4SMauro Carvalho Chehab * otherwise make sure that we end up with the maximum
384f9fe90a4SMauro Carvalho Chehab * bandwidth because the min_pkt_size equation might be wrong.
385f9fe90a4SMauro Carvalho Chehab *
3860560f337SMauro Carvalho Chehab */
3870560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] >
3880560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt])
3890560f337SMauro Carvalho Chehab dev->alt = i;
3900560f337SMauro Carvalho Chehab }
3910560f337SMauro Carvalho Chehab
3920560f337SMauro Carvalho Chehab set_alt:
393f9fe90a4SMauro Carvalho Chehab /*
394f9fe90a4SMauro Carvalho Chehab * NOTE: for bulk transfers, we need to call usb_set_interface()
3950560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming
396f9fe90a4SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW !
397f9fe90a4SMauro Carvalho Chehab */
3980560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) {
3990560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */
4000560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER;
4010560f337SMauro Carvalho Chehab } else { /* isoc */
4020560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n",
4030560f337SMauro Carvalho Chehab min_pkt_size, dev->alt);
4040560f337SMauro Carvalho Chehab dev->max_pkt_size =
4050560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt];
4060560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS;
4070560f337SMauro Carvalho Chehab }
4080560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n",
4090560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size);
410f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, dev->ifnum, dev->alt);
411f9fe90a4SMauro Carvalho Chehab if (err < 0) {
41229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
413ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n",
414f9fe90a4SMauro Carvalho Chehab dev->alt, err);
415f9fe90a4SMauro Carvalho Chehab return err;
4160560f337SMauro Carvalho Chehab }
4170560f337SMauro Carvalho Chehab return 0;
4180560f337SMauro Carvalho Chehab }
4190560f337SMauro Carvalho Chehab
420f9fe90a4SMauro Carvalho Chehab /*
421f9fe90a4SMauro Carvalho Chehab * DMA and thread functions
422f9fe90a4SMauro Carvalho Chehab */
4230c0d06caSMauro Carvalho Chehab
4240c0d06caSMauro Carvalho Chehab /*
425948a49aaSFrank Schaefer * Finish the current buffer
4260c0d06caSMauro Carvalho Chehab */
finish_buffer(struct em28xx * dev,struct em28xx_buffer * buf)427948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev,
4280c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf)
4290c0d06caSMauro Carvalho Chehab {
430d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field);
431d3829fadSDevin Heitmueller
4322d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++;
433662c97cfSFrank Schaefer if (dev->v4l2->progressive)
4342d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE;
435662c97cfSFrank Schaefer else
4362d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED;
437d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns();
438d3829fadSDevin Heitmueller
4392d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE);
4400c0d06caSMauro Carvalho Chehab }
4410c0d06caSMauro Carvalho Chehab
4420c0d06caSMauro Carvalho Chehab /*
443*f068a6ceSHans Verkuil * Copy picture data from USB buffer to video buffer
4440c0d06caSMauro Carvalho Chehab */
em28xx_copy_video(struct em28xx * dev,struct em28xx_buffer * buf,unsigned char * usb_buf,unsigned long len)4450c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev,
4460c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf,
44736016a35SFrank Schaefer unsigned char *usb_buf,
4484078d625SFrank Schaefer unsigned long len)
4490c0d06caSMauro Carvalho Chehab {
45058159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
4510c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread;
4520c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain;
45358159171SFrank Schaefer int bytesperline = v4l2->width << 1;
4540c0d06caSMauro Carvalho Chehab
455d3829fadSDevin Heitmueller if (buf->pos + len > buf->length)
456d3829fadSDevin Heitmueller len = buf->length - buf->pos;
4570c0d06caSMauro Carvalho Chehab
45836016a35SFrank Schaefer startread = usb_buf;
4590c0d06caSMauro Carvalho Chehab remain = len;
4600c0d06caSMauro Carvalho Chehab
46158159171SFrank Schaefer if (v4l2->progressive || buf->top_field)
46236016a35SFrank Schaefer fieldstart = buf->vb_buf;
463c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */
46436016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline;
4650c0d06caSMauro Carvalho Chehab
4668732533bSFrank Schaefer linesdone = buf->pos / bytesperline;
4678732533bSFrank Schaefer currlinedone = buf->pos % bytesperline;
4680c0d06caSMauro Carvalho Chehab
46958159171SFrank Schaefer if (v4l2->progressive)
4700c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone;
4710c0d06caSMauro Carvalho Chehab else
4720c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone;
4730c0d06caSMauro Carvalho Chehab
4740c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset;
4750c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone;
4760c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy;
4770c0d06caSMauro Carvalho Chehab
478d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) {
4797983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n",
4800c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) -
481d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length));
482d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length -
48336016a35SFrank Schaefer (char *)startwrite;
4840c0d06caSMauro Carvalho Chehab lencopy = remain;
4850c0d06caSMauro Carvalho Chehab }
4860c0d06caSMauro Carvalho Chehab if (lencopy <= 0)
4870c0d06caSMauro Carvalho Chehab return;
4880c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy);
4890c0d06caSMauro Carvalho Chehab
4900c0d06caSMauro Carvalho Chehab remain -= lencopy;
4910c0d06caSMauro Carvalho Chehab
4920c0d06caSMauro Carvalho Chehab while (remain > 0) {
49358159171SFrank Schaefer if (v4l2->progressive)
494c02ec71bSFrank Schaefer startwrite += lencopy;
495c02ec71bSFrank Schaefer else
4960c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline;
4970c0d06caSMauro Carvalho Chehab startread += lencopy;
4980c0d06caSMauro Carvalho Chehab if (bytesperline > remain)
4990c0d06caSMauro Carvalho Chehab lencopy = remain;
5000c0d06caSMauro Carvalho Chehab else
5010c0d06caSMauro Carvalho Chehab lencopy = bytesperline;
5020c0d06caSMauro Carvalho Chehab
50336016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf +
504d3829fadSDevin Heitmueller buf->length) {
5055ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n",
5060c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) -
507d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length));
508f9fe90a4SMauro Carvalho Chehab remain = (char *)buf->vb_buf + buf->length -
5090c0d06caSMauro Carvalho Chehab (char *)startwrite;
510f9fe90a4SMauro Carvalho Chehab lencopy = remain;
5110c0d06caSMauro Carvalho Chehab }
5120c0d06caSMauro Carvalho Chehab if (lencopy <= 0)
5130c0d06caSMauro Carvalho Chehab break;
5140c0d06caSMauro Carvalho Chehab
5150c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy);
5160c0d06caSMauro Carvalho Chehab
5170c0d06caSMauro Carvalho Chehab remain -= lencopy;
5180c0d06caSMauro Carvalho Chehab }
5190c0d06caSMauro Carvalho Chehab
5208732533bSFrank Schaefer buf->pos += len;
5210c0d06caSMauro Carvalho Chehab }
5220c0d06caSMauro Carvalho Chehab
52336016a35SFrank Schaefer /*
524*f068a6ceSHans Verkuil * Copy VBI data from USB buffer to video buffer
52536016a35SFrank Schaefer */
em28xx_copy_vbi(struct em28xx * dev,struct em28xx_buffer * buf,unsigned char * usb_buf,unsigned long len)5260c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev,
5270c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf,
52836016a35SFrank Schaefer unsigned char *usb_buf,
5294078d625SFrank Schaefer unsigned long len)
5300c0d06caSMauro Carvalho Chehab {
53136016a35SFrank Schaefer unsigned int offset;
5320c0d06caSMauro Carvalho Chehab
533d3829fadSDevin Heitmueller if (buf->pos + len > buf->length)
534d3829fadSDevin Heitmueller len = buf->length - buf->pos;
5350c0d06caSMauro Carvalho Chehab
5368732533bSFrank Schaefer offset = buf->pos;
5370c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */
53836016a35SFrank Schaefer if (buf->top_field == 0)
539753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height;
5400c0d06caSMauro Carvalho Chehab
54136016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len);
5428732533bSFrank Schaefer buf->pos += len;
5430c0d06caSMauro Carvalho Chehab }
5440c0d06caSMauro Carvalho Chehab
print_err_status(struct em28xx * dev,int packet,int status)5450c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev,
5460c0d06caSMauro Carvalho Chehab int packet, int status)
5470c0d06caSMauro Carvalho Chehab {
5480c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown";
5490c0d06caSMauro Carvalho Chehab
5500c0d06caSMauro Carvalho Chehab switch (status) {
5510c0d06caSMauro Carvalho Chehab case -ENOENT:
552b436e26eSColin Ian King errmsg = "unlinked synchronously";
5530c0d06caSMauro Carvalho Chehab break;
5540c0d06caSMauro Carvalho Chehab case -ECONNRESET:
555b436e26eSColin Ian King errmsg = "unlinked asynchronously";
5560c0d06caSMauro Carvalho Chehab break;
5570c0d06caSMauro Carvalho Chehab case -ENOSR:
5580c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)";
5590c0d06caSMauro Carvalho Chehab break;
5600c0d06caSMauro Carvalho Chehab case -EPIPE:
5610c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)";
5620c0d06caSMauro Carvalho Chehab break;
5630c0d06caSMauro Carvalho Chehab case -EOVERFLOW:
5640c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)";
5650c0d06caSMauro Carvalho Chehab break;
5660c0d06caSMauro Carvalho Chehab case -EPROTO:
5670c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)";
5680c0d06caSMauro Carvalho Chehab break;
5690c0d06caSMauro Carvalho Chehab case -EILSEQ:
5700c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)";
5710c0d06caSMauro Carvalho Chehab break;
5720c0d06caSMauro Carvalho Chehab case -ETIME:
5730c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond";
5740c0d06caSMauro Carvalho Chehab break;
5750c0d06caSMauro Carvalho Chehab }
5760c0d06caSMauro Carvalho Chehab if (packet < 0) {
5770c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg);
5780c0d06caSMauro Carvalho Chehab } else {
5790c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n",
5800c0d06caSMauro Carvalho Chehab packet, status, errmsg);
5810c0d06caSMauro Carvalho Chehab }
5820c0d06caSMauro Carvalho Chehab }
5830c0d06caSMauro Carvalho Chehab
5840c0d06caSMauro Carvalho Chehab /*
58524a6d849SFrank Schaefer * get the next available buffer from dma queue
5860c0d06caSMauro Carvalho Chehab */
get_next_buf(struct em28xx * dev,struct em28xx_dmaqueue * dma_q)58724a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev,
58824a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q)
5890c0d06caSMauro Carvalho Chehab {
59024a6d849SFrank Schaefer struct em28xx_buffer *buf;
5910c0d06caSMauro Carvalho Chehab
5920c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) {
5930c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n");
59424a6d849SFrank Schaefer return NULL;
5950c0d06caSMauro Carvalho Chehab }
5960c0d06caSMauro Carvalho Chehab
5970c0d06caSMauro Carvalho Chehab /* Get the next buffer */
598d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list);
5990c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */
600d3829fadSDevin Heitmueller list_del(&buf->list);
6018732533bSFrank Schaefer buf->pos = 0;
602d3829fadSDevin Heitmueller buf->vb_buf = buf->mem;
6030c0d06caSMauro Carvalho Chehab
60424a6d849SFrank Schaefer return buf;
6050c0d06caSMauro Carvalho Chehab }
6060c0d06caSMauro Carvalho Chehab
607e04c00d9SFrank Schaefer /*
608e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field
609e04c00d9SFrank Schaefer */
610e04c00d9SFrank Schaefer static struct em28xx_buffer *
finish_field_prepare_next(struct em28xx * dev,struct em28xx_buffer * buf,struct em28xx_dmaqueue * dma_q)611e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev,
612e04c00d9SFrank Schaefer struct em28xx_buffer *buf,
613e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q)
614e04c00d9SFrank Schaefer {
61558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
61658159171SFrank Schaefer
617f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */
618f9fe90a4SMauro Carvalho Chehab if (buf)
619e04c00d9SFrank Schaefer finish_buffer(dev, buf);
620e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q);
621e04c00d9SFrank Schaefer }
622f9fe90a4SMauro Carvalho Chehab if (buf) {
623f0e38230SFrank Schaefer buf->top_field = v4l2->top_field;
624e04c00d9SFrank Schaefer buf->pos = 0;
625e04c00d9SFrank Schaefer }
626e04c00d9SFrank Schaefer
627e04c00d9SFrank Schaefer return buf;
628e04c00d9SFrank Schaefer }
629e04c00d9SFrank Schaefer
630227b7c90SFrank Schaefer /*
631227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format
632227b7c90SFrank Schaefer */
process_frame_data_em28xx(struct em28xx * dev,unsigned char * data_pkt,unsigned int data_len)633227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev,
634227b7c90SFrank Schaefer unsigned char *data_pkt,
635227b7c90SFrank Schaefer unsigned int data_len)
636227b7c90SFrank Schaefer {
637753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
638227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf;
639227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf;
640227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq;
641227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq;
642227b7c90SFrank Schaefer
643f9fe90a4SMauro Carvalho Chehab /*
644f9fe90a4SMauro Carvalho Chehab * capture type 0 = vbi start
645f9fe90a4SMauro Carvalho Chehab * capture type 1 = vbi in progress
646f9fe90a4SMauro Carvalho Chehab * capture type 2 = video start
647f9fe90a4SMauro Carvalho Chehab * capture type 3 = video in progress
648f9fe90a4SMauro Carvalho Chehab */
649227b7c90SFrank Schaefer if (data_len >= 4) {
650f9fe90a4SMauro Carvalho Chehab /*
651f9fe90a4SMauro Carvalho Chehab * NOTE: Headers are always 4 bytes and
652f9fe90a4SMauro Carvalho Chehab * never split across packets
653f9fe90a4SMauro Carvalho Chehab */
654227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 &&
655227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) {
656227b7c90SFrank Schaefer /* Continuation */
657227b7c90SFrank Schaefer data_pkt += 4;
658227b7c90SFrank Schaefer data_len -= 4;
659227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) {
660227b7c90SFrank Schaefer /* Field start (VBI mode) */
661f0e38230SFrank Schaefer v4l2->capture_type = 0;
662f0e38230SFrank Schaefer v4l2->vbi_read = 0;
663227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n");
664f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1);
665227b7c90SFrank Schaefer data_pkt += 4;
666227b7c90SFrank Schaefer data_len -= 4;
667227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) {
668227b7c90SFrank Schaefer /* Field start (VBI disabled) */
669f0e38230SFrank Schaefer v4l2->capture_type = 2;
670227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n");
671f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1);
672227b7c90SFrank Schaefer data_pkt += 4;
673227b7c90SFrank Schaefer data_len -= 4;
674227b7c90SFrank Schaefer }
675227b7c90SFrank Schaefer }
676f9fe90a4SMauro Carvalho Chehab /*
677f9fe90a4SMauro Carvalho Chehab * NOTE: With bulk transfers, intermediate data packets
678f9fe90a4SMauro Carvalho Chehab * have no continuation header
679f9fe90a4SMauro Carvalho Chehab */
680227b7c90SFrank Schaefer
681f0e38230SFrank Schaefer if (v4l2->capture_type == 0) {
682227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q);
683227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf;
684f0e38230SFrank Schaefer v4l2->capture_type = 1;
685227b7c90SFrank Schaefer }
686227b7c90SFrank Schaefer
687f0e38230SFrank Schaefer if (v4l2->capture_type == 1) {
688753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height;
689f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ?
690f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len;
691227b7c90SFrank Schaefer
692227b7c90SFrank Schaefer /* Copy VBI data */
693f9fe90a4SMauro Carvalho Chehab if (vbi_buf)
694227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len);
695f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len;
696227b7c90SFrank Schaefer
697227b7c90SFrank Schaefer if (vbi_data_len < data_len) {
698227b7c90SFrank Schaefer /* Continue with copying video data */
699f0e38230SFrank Schaefer v4l2->capture_type = 2;
700227b7c90SFrank Schaefer data_pkt += vbi_data_len;
701227b7c90SFrank Schaefer data_len -= vbi_data_len;
702227b7c90SFrank Schaefer }
703227b7c90SFrank Schaefer }
704227b7c90SFrank Schaefer
705f0e38230SFrank Schaefer if (v4l2->capture_type == 2) {
706227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q);
707227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf;
708f0e38230SFrank Schaefer v4l2->capture_type = 3;
709227b7c90SFrank Schaefer }
710227b7c90SFrank Schaefer
711f9fe90a4SMauro Carvalho Chehab if (v4l2->capture_type == 3 && buf && data_len > 0)
712227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len);
713227b7c90SFrank Schaefer }
714227b7c90SFrank Schaefer
715e507e0e5SFrank Schaefer /*
716e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format
717e507e0e5SFrank Schaefer */
process_frame_data_em25xx(struct em28xx * dev,unsigned char * data_pkt,unsigned int data_len)718e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev,
719e507e0e5SFrank Schaefer unsigned char *data_pkt,
720e507e0e5SFrank Schaefer unsigned int data_len)
721e507e0e5SFrank Schaefer {
722e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf;
723e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq;
724f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
7257e6c8c19SMauro Carvalho Chehab bool frame_end = false;
726e507e0e5SFrank Schaefer
727e507e0e5SFrank Schaefer /* Check for header */
728f9fe90a4SMauro Carvalho Chehab /*
729f9fe90a4SMauro Carvalho Chehab * NOTE: at least with bulk transfers, only the first packet
730f9fe90a4SMauro Carvalho Chehab * has a header and has always set the FRAME_END bit
731f9fe90a4SMauro Carvalho Chehab */
732e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */
733e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) &&
734e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) {
735f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] &
736e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID);
737e507e0e5SFrank Schaefer frame_end = data_pkt[1] &
738e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END;
739e507e0e5SFrank Schaefer data_pkt += 2;
740e507e0e5SFrank Schaefer data_len -= 2;
741e507e0e5SFrank Schaefer }
742e507e0e5SFrank Schaefer
743e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */
744e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) {
745e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq);
746e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf;
747e507e0e5SFrank Schaefer }
748f9fe90a4SMauro Carvalho Chehab /*
749f9fe90a4SMauro Carvalho Chehab * NOTE: in ISOC mode when a new frame starts and buf==NULL,
750e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the
751e507e0e5SFrank Schaefer * first frame.
752e507e0e5SFrank Schaefer */
753e507e0e5SFrank Schaefer }
754e507e0e5SFrank Schaefer
755e507e0e5SFrank Schaefer /* Copy data */
756f9fe90a4SMauro Carvalho Chehab if (buf && data_len > 0)
757e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len);
758e507e0e5SFrank Schaefer
759e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */
760e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) {
761e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq);
762e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf;
763e507e0e5SFrank Schaefer }
764e507e0e5SFrank Schaefer
765f9fe90a4SMauro Carvalho Chehab /*
766f9fe90a4SMauro Carvalho Chehab * NOTES:
767f9fe90a4SMauro Carvalho Chehab *
768f9fe90a4SMauro Carvalho Chehab * 1) Tested with USB bulk transfers only !
769e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different.
770e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a
771e507e0e5SFrank Schaefer * header like with the other em28xx devices.
772f9fe90a4SMauro Carvalho Chehab *
773f9fe90a4SMauro Carvalho Chehab * 2) Support for interlaced mode is pure theory. It has not been
774f9fe90a4SMauro Carvalho Chehab * tested and it is unknown if these devices actually support it.
775e507e0e5SFrank Schaefer */
776e507e0e5SFrank Schaefer }
777e507e0e5SFrank Schaefer
778960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */
em28xx_urb_data_copy(struct em28xx * dev,struct urb * urb)7790fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb)
7800c0d06caSMauro Carvalho Chehab {
781227b7c90SFrank Schaefer int xfer_bulk, num_packets, i;
782227b7c90SFrank Schaefer unsigned char *usb_data_pkt;
783227b7c90SFrank Schaefer unsigned int usb_data_len;
7840c0d06caSMauro Carvalho Chehab
7850c0d06caSMauro Carvalho Chehab if (!dev)
7860c0d06caSMauro Carvalho Chehab return 0;
7870c0d06caSMauro Carvalho Chehab
7882665c299SFrank Schaefer if (dev->disconnected)
7890c0d06caSMauro Carvalho Chehab return 0;
7900c0d06caSMauro Carvalho Chehab
7911653cb0cSFrank Schaefer if (urb->status < 0)
7920c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status);
7930c0d06caSMauro Carvalho Chehab
7944601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe);
7954601cc39SFrank Schaefer
7964601cc39SFrank Schaefer if (xfer_bulk) /* bulk */
7974601cc39SFrank Schaefer num_packets = 1;
7984601cc39SFrank Schaefer else /* isoc */
7994601cc39SFrank Schaefer num_packets = urb->number_of_packets;
8000c0d06caSMauro Carvalho Chehab
8014601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) {
8024601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */
803227b7c90SFrank Schaefer usb_data_len = urb->actual_length;
8044601cc39SFrank Schaefer
805227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer;
8064601cc39SFrank Schaefer } else { /* isoc */
8074601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) {
8084601cc39SFrank Schaefer print_err_status(dev, i,
8094601cc39SFrank Schaefer urb->iso_frame_desc[i].status);
8100c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO)
8110c0d06caSMauro Carvalho Chehab continue;
8120c0d06caSMauro Carvalho Chehab }
8130c0d06caSMauro Carvalho Chehab
814227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length;
815227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) {
8160c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size");
8170c0d06caSMauro Carvalho Chehab continue;
8180c0d06caSMauro Carvalho Chehab }
8190c0d06caSMauro Carvalho Chehab
820227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer +
8214601cc39SFrank Schaefer urb->iso_frame_desc[i].offset;
8224601cc39SFrank Schaefer }
8234601cc39SFrank Schaefer
824227b7c90SFrank Schaefer if (usb_data_len == 0) {
8254601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */
8264601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */
8274601cc39SFrank Schaefer continue;
8284601cc39SFrank Schaefer }
8290c0d06caSMauro Carvalho Chehab
830e507e0e5SFrank Schaefer if (dev->is_em25xx)
831e507e0e5SFrank Schaefer process_frame_data_em25xx(dev,
832e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len);
833e507e0e5SFrank Schaefer else
834e507e0e5SFrank Schaefer process_frame_data_em28xx(dev,
835e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len);
8360c0d06caSMauro Carvalho Chehab }
837227b7c90SFrank Schaefer return 1;
8380c0d06caSMauro Carvalho Chehab }
8390c0d06caSMauro Carvalho Chehab
get_resource(enum v4l2_buf_type f_type)840f9fe90a4SMauro Carvalho Chehab static int get_resource(enum v4l2_buf_type f_type)
841d3829fadSDevin Heitmueller {
842d3829fadSDevin Heitmueller switch (f_type) {
843d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE:
844d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO;
845d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE:
846d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI;
847d3829fadSDevin Heitmueller default:
848f9fe90a4SMauro Carvalho Chehab WARN_ON(1);
849f9fe90a4SMauro Carvalho Chehab return -1; /* Indicate that device is busy */
850d3829fadSDevin Heitmueller }
851d3829fadSDevin Heitmueller }
852d3829fadSDevin Heitmueller
853d3829fadSDevin Heitmueller /* Usage lock check functions */
res_get(struct em28xx * dev,enum v4l2_buf_type f_type)854d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type)
855d3829fadSDevin Heitmueller {
856f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type);
857d3829fadSDevin Heitmueller
858d3829fadSDevin Heitmueller /* is it free? */
859d3829fadSDevin Heitmueller if (dev->resources & res_type) {
860d3829fadSDevin Heitmueller /* no, someone else uses it */
861d3829fadSDevin Heitmueller return -EBUSY;
862d3829fadSDevin Heitmueller }
863d3829fadSDevin Heitmueller
864d3829fadSDevin Heitmueller /* it's free, grab it */
865d3829fadSDevin Heitmueller dev->resources |= res_type;
866d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type);
867d3829fadSDevin Heitmueller return 0;
868d3829fadSDevin Heitmueller }
869d3829fadSDevin Heitmueller
res_free(struct em28xx * dev,enum v4l2_buf_type f_type)870d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type)
871d3829fadSDevin Heitmueller {
872f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type);
873d3829fadSDevin Heitmueller
874d3829fadSDevin Heitmueller dev->resources &= ~res_type;
875d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type);
876d3829fadSDevin Heitmueller }
877d3829fadSDevin Heitmueller
em28xx_v4l2_media_release(struct em28xx * dev)87837ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev)
87937ecc7b1SMauro Carvalho Chehab {
88037ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER
88137ecc7b1SMauro Carvalho Chehab int i;
88237ecc7b1SMauro Carvalho Chehab
88337ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) {
88437ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type)
88537ecc7b1SMauro Carvalho Chehab return;
88637ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]);
88737ecc7b1SMauro Carvalho Chehab }
88837ecc7b1SMauro Carvalho Chehab #endif
88937ecc7b1SMauro Carvalho Chehab }
89037ecc7b1SMauro Carvalho Chehab
89137ecc7b1SMauro Carvalho Chehab /*
89237ecc7b1SMauro Carvalho Chehab * Media Controller helper functions
89337ecc7b1SMauro Carvalho Chehab */
89437ecc7b1SMauro Carvalho Chehab
em28xx_enable_analog_tuner(struct em28xx * dev)89537ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev)
89637ecc7b1SMauro Carvalho Chehab {
89737ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER
89837ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev;
89937ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2;
90037ecc7b1SMauro Carvalho Chehab struct media_entity *source;
90137ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL;
90237ecc7b1SMauro Carvalho Chehab int ret, active_links = 0;
90337ecc7b1SMauro Carvalho Chehab
90437ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder)
90537ecc7b1SMauro Carvalho Chehab return 0;
90637ecc7b1SMauro Carvalho Chehab
90737ecc7b1SMauro Carvalho Chehab /*
90837ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder.
90937ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be
91037ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't
91137ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2,
91237ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs.
91337ecc7b1SMauro Carvalho Chehab */
91437ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) {
91537ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) {
91637ecc7b1SMauro Carvalho Chehab found_link = link;
91737ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED)
91837ecc7b1SMauro Carvalho Chehab active_links++;
91937ecc7b1SMauro Carvalho Chehab break;
92037ecc7b1SMauro Carvalho Chehab }
92137ecc7b1SMauro Carvalho Chehab }
92237ecc7b1SMauro Carvalho Chehab
92337ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link)
92437ecc7b1SMauro Carvalho Chehab return 0;
92537ecc7b1SMauro Carvalho Chehab
92637ecc7b1SMauro Carvalho Chehab source = found_link->source->entity;
92737ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) {
92837ecc7b1SMauro Carvalho Chehab struct media_entity *sink;
92937ecc7b1SMauro Carvalho Chehab int flags = 0;
93037ecc7b1SMauro Carvalho Chehab
93137ecc7b1SMauro Carvalho Chehab sink = link->sink->entity;
93237ecc7b1SMauro Carvalho Chehab
93337ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder)
93437ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED;
93537ecc7b1SMauro Carvalho Chehab
93637ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags);
93737ecc7b1SMauro Carvalho Chehab if (ret) {
93829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
939ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n",
94037ecc7b1SMauro Carvalho Chehab source->name, sink->name,
94137ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled",
94237ecc7b1SMauro Carvalho Chehab ret);
94337ecc7b1SMauro Carvalho Chehab return ret;
944f9fe90a4SMauro Carvalho Chehab }
945f9fe90a4SMauro Carvalho Chehab
94637ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n",
94737ecc7b1SMauro Carvalho Chehab source->name, sink->name,
94837ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled");
94937ecc7b1SMauro Carvalho Chehab }
95037ecc7b1SMauro Carvalho Chehab #endif
95137ecc7b1SMauro Carvalho Chehab return 0;
95237ecc7b1SMauro Carvalho Chehab }
95337ecc7b1SMauro Carvalho Chehab
95437ecc7b1SMauro Carvalho Chehab static const char * const iname[] = {
95537ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite",
95637ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video",
95737ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television",
95837ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio",
95937ecc7b1SMauro Carvalho Chehab };
96037ecc7b1SMauro Carvalho Chehab
em28xx_v4l2_create_entities(struct em28xx * dev)96137ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev)
96237ecc7b1SMauro Carvalho Chehab {
96337ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER)
96437ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2;
96537ecc7b1SMauro Carvalho Chehab int ret, i;
96637ecc7b1SMauro Carvalho Chehab
96737ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */
96837ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK;
96937ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad);
97037ecc7b1SMauro Carvalho Chehab if (ret < 0)
97129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
972ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n");
97337ecc7b1SMauro Carvalho Chehab
97437ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) {
97537ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK;
97637ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1,
97737ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad);
97837ecc7b1SMauro Carvalho Chehab if (ret < 0)
97929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
980ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n");
98137ecc7b1SMauro Carvalho Chehab }
98237ecc7b1SMauro Carvalho Chehab
98337ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */
984aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
98537ecc7b1SMauro Carvalho Chehab return;
98637ecc7b1SMauro Carvalho Chehab
98737ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */
98837ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) {
98937ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i];
99037ecc7b1SMauro Carvalho Chehab
99137ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type)
99237ecc7b1SMauro Carvalho Chehab break;
99337ecc7b1SMauro Carvalho Chehab
99437ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type];
99537ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR;
99637ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE;
99737ecc7b1SMauro Carvalho Chehab
99837ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) {
99937ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE:
100037ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE;
100137ecc7b1SMauro Carvalho Chehab break;
100237ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO:
100337ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO;
100437ecc7b1SMauro Carvalho Chehab break;
100537ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */
1006e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT)
100737ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF;
100837ecc7b1SMauro Carvalho Chehab break;
100937ecc7b1SMauro Carvalho Chehab }
101037ecc7b1SMauro Carvalho Chehab
101137ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]);
101237ecc7b1SMauro Carvalho Chehab if (ret < 0)
101329b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
1014ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i);
101537ecc7b1SMauro Carvalho Chehab
101637ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent);
101737ecc7b1SMauro Carvalho Chehab if (ret < 0)
101829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
1019ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i);
102037ecc7b1SMauro Carvalho Chehab }
102137ecc7b1SMauro Carvalho Chehab #endif
102237ecc7b1SMauro Carvalho Chehab }
102337ecc7b1SMauro Carvalho Chehab
1024f9fe90a4SMauro Carvalho Chehab /*
1025f9fe90a4SMauro Carvalho Chehab * Videobuf2 operations
1026f9fe90a4SMauro Carvalho Chehab */
10270c0d06caSMauro Carvalho Chehab
queue_setup(struct vb2_queue * vq,unsigned int * nbuffers,unsigned int * nplanes,unsigned int sizes[],struct device * alloc_devs[])1028df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq,
1029d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes,
103036c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[])
10310c0d06caSMauro Carvalho Chehab {
1032d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq);
1033753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1034df9ecb0cSHans Verkuil unsigned long size =
103506e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3;
10360c0d06caSMauro Carvalho Chehab
1037df9ecb0cSHans Verkuil if (*nplanes)
1038df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0;
1039d3829fadSDevin Heitmueller *nplanes = 1;
1040d3829fadSDevin Heitmueller sizes[0] = size;
104137ecc7b1SMauro Carvalho Chehab
104237ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev);
104337ecc7b1SMauro Carvalho Chehab
10440c0d06caSMauro Carvalho Chehab return 0;
10450c0d06caSMauro Carvalho Chehab }
10460c0d06caSMauro Carvalho Chehab
10470c0d06caSMauro Carvalho Chehab static int
buffer_prepare(struct vb2_buffer * vb)1048d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb)
10490c0d06caSMauro Carvalho Chehab {
10502d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1051d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue);
1052753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1053d3829fadSDevin Heitmueller unsigned long size;
10540c0d06caSMauro Carvalho Chehab
10552d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field);
10560c0d06caSMauro Carvalho Chehab
105706e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3;
1058d3829fadSDevin Heitmueller
1059d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) {
1060d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n",
1061d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size);
10620c0d06caSMauro Carvalho Chehab return -EINVAL;
1063d3829fadSDevin Heitmueller }
10642d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size);
10650c0d06caSMauro Carvalho Chehab
1066d3829fadSDevin Heitmueller return 0;
10670c0d06caSMauro Carvalho Chehab }
10680c0d06caSMauro Carvalho Chehab
em28xx_start_analog_streaming(struct vb2_queue * vq,unsigned int count)1069d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count)
1070d3829fadSDevin Heitmueller {
1071d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq);
1072f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1073d3829fadSDevin Heitmueller struct v4l2_frequency f;
10742d700715SJunghak Sung struct v4l2_fh *owner;
1075d3829fadSDevin Heitmueller int rc = 0;
10760c0d06caSMauro Carvalho Chehab
1077d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__);
1078d3829fadSDevin Heitmueller
1079afeaade9SMauro Carvalho Chehab dev->v4l2->field_count = 0;
1080afeaade9SMauro Carvalho Chehab
1081f9fe90a4SMauro Carvalho Chehab /*
1082f9fe90a4SMauro Carvalho Chehab * Make sure streaming is not already in progress for this type
1083f9fe90a4SMauro Carvalho Chehab * of filehandle (e.g. video, vbi)
1084f9fe90a4SMauro Carvalho Chehab */
1085d3829fadSDevin Heitmueller rc = res_get(dev, vq->type);
1086d3829fadSDevin Heitmueller if (rc)
1087d3829fadSDevin Heitmueller return rc;
1088d3829fadSDevin Heitmueller
10898139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) {
1090d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */
1091d3829fadSDevin Heitmueller
1092d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */
1093d3829fadSDevin Heitmueller em28xx_set_alternate(dev);
1094d3829fadSDevin Heitmueller
1095f9fe90a4SMauro Carvalho Chehab /*
1096f9fe90a4SMauro Carvalho Chehab * Needed, since GPIO might have disabled power of
1097f9fe90a4SMauro Carvalho Chehab * some i2c device
1098d3829fadSDevin Heitmueller */
1099d3829fadSDevin Heitmueller em28xx_wake_i2c(dev);
1100d3829fadSDevin Heitmueller
1101f0e38230SFrank Schaefer v4l2->capture_type = -1;
1102c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE,
1103c647a91aSFrank Schaefer dev->analog_xfer_bulk,
11040c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS,
11050c0d06caSMauro Carvalho Chehab dev->max_pkt_size,
1106c647a91aSFrank Schaefer dev->packet_multiplier,
11070fa4a402SFrank Schaefer em28xx_urb_data_copy);
11080c0d06caSMauro Carvalho Chehab if (rc < 0)
1109032f1ddfSFrank Schaefer return rc;
1110d3829fadSDevin Heitmueller
1111d3829fadSDevin Heitmueller /*
1112d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm
1113d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for
1114d3829fadSDevin Heitmueller * backward compatibility (the old code did it)
1115d3829fadSDevin Heitmueller */
1116d3829fadSDevin Heitmueller
1117d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */
1118d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f));
11193854b0d8SFrank Schaefer f.frequency = v4l2->frequency;
11202d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner;
11212d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO)
1122d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO;
1123d3829fadSDevin Heitmueller else
1124d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV;
1125f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev,
112695d2608bSFrank Schaefer 0, tuner, s_frequency, &f);
112713d52fe4SMauro Carvalho Chehab
112813d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */
112913d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1);
11300c0d06caSMauro Carvalho Chehab }
11310c0d06caSMauro Carvalho Chehab
11328139a4d5SFrank Schaefer v4l2->streaming_users++;
1133032f1ddfSFrank Schaefer
11340c0d06caSMauro Carvalho Chehab return rc;
11350c0d06caSMauro Carvalho Chehab }
11360c0d06caSMauro Carvalho Chehab
em28xx_stop_streaming(struct vb2_queue * vq)1137e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq)
11380c0d06caSMauro Carvalho Chehab {
1139d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq);
11408139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
11410c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq;
1142d3829fadSDevin Heitmueller unsigned long flags = 0;
11430c0d06caSMauro Carvalho Chehab
1144d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__);
11450c0d06caSMauro Carvalho Chehab
1146d3829fadSDevin Heitmueller res_free(dev, vq->type);
1147d3829fadSDevin Heitmueller
11488139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) {
114913d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */
115013d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0);
115113d52fe4SMauro Carvalho Chehab
1152d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */
1153d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE);
11540c0d06caSMauro Carvalho Chehab }
11550c0d06caSMauro Carvalho Chehab
1156d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags);
1157f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vid_buf) {
11582d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf,
11592d700715SJunghak Sung VB2_BUF_STATE_ERROR);
1160627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL;
1161627530c3SFrank Schaefer }
1162d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) {
1163d3829fadSDevin Heitmueller struct em28xx_buffer *buf;
1164fdf1bc9fSMauro Carvalho Chehab
1165d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list);
1166d3829fadSDevin Heitmueller list_del(&buf->list);
11672d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR);
1168d3829fadSDevin Heitmueller }
1169d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags);
1170d3829fadSDevin Heitmueller }
1171d3829fadSDevin Heitmueller
em28xx_stop_vbi_streaming(struct vb2_queue * vq)1172e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq)
11730c0d06caSMauro Carvalho Chehab {
1174d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq);
11758139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1176d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq;
1177d3829fadSDevin Heitmueller unsigned long flags = 0;
11780c0d06caSMauro Carvalho Chehab
1179d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__);
11800c0d06caSMauro Carvalho Chehab
1181d3829fadSDevin Heitmueller res_free(dev, vq->type);
1182d3829fadSDevin Heitmueller
11838139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) {
118413d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */
118513d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0);
118613d52fe4SMauro Carvalho Chehab
1187d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */
1188d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE);
11890c0d06caSMauro Carvalho Chehab }
11900c0d06caSMauro Carvalho Chehab
1191d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags);
1192f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vbi_buf) {
11932d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf,
11942d700715SJunghak Sung VB2_BUF_STATE_ERROR);
1195627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL;
1196627530c3SFrank Schaefer }
1197d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) {
1198d3829fadSDevin Heitmueller struct em28xx_buffer *buf;
1199fdf1bc9fSMauro Carvalho Chehab
1200d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list);
1201d3829fadSDevin Heitmueller list_del(&buf->list);
12022d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR);
1203d3829fadSDevin Heitmueller }
1204d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags);
1205d3829fadSDevin Heitmueller }
1206d3829fadSDevin Heitmueller
1207d3829fadSDevin Heitmueller static void
buffer_queue(struct vb2_buffer * vb)1208d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb)
1209d3829fadSDevin Heitmueller {
12102d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1211d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue);
12122d700715SJunghak Sung struct em28xx_buffer *buf =
12132d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb);
1214d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq;
1215d3829fadSDevin Heitmueller unsigned long flags = 0;
1216d3829fadSDevin Heitmueller
1217d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__);
1218d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0);
1219d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0);
1220d3829fadSDevin Heitmueller
1221d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags);
1222d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active);
1223d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags);
1224d3829fadSDevin Heitmueller }
1225d3829fadSDevin Heitmueller
12261bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = {
1227d3829fadSDevin Heitmueller .queue_setup = queue_setup,
12280c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare,
12290c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue,
1230d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming,
1231d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming,
1232d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare,
1233d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish,
12340c0d06caSMauro Carvalho Chehab };
12350c0d06caSMauro Carvalho Chehab
em28xx_vb2_setup(struct em28xx * dev)123601c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev)
1237d3829fadSDevin Heitmueller {
1238d3829fadSDevin Heitmueller int rc;
1239d3829fadSDevin Heitmueller struct vb2_queue *q;
124027a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1241d3829fadSDevin Heitmueller
1242d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */
124327a36df6SFrank Schaefer q = &v4l2->vb_vidq;
1244d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1245ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF;
1246ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
1247d3829fadSDevin Heitmueller q->drv_priv = dev;
1248d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer);
1249d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops;
1250d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops;
1251d3829fadSDevin Heitmueller
1252d3829fadSDevin Heitmueller rc = vb2_queue_init(q);
1253d3829fadSDevin Heitmueller if (rc < 0)
1254d3829fadSDevin Heitmueller return rc;
1255d3829fadSDevin Heitmueller
1256d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */
125727a36df6SFrank Schaefer q = &v4l2->vb_vbiq;
1258d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE;
1259d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR;
1260ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
1261d3829fadSDevin Heitmueller q->drv_priv = dev;
1262d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer);
1263d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops;
1264d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops;
1265d3829fadSDevin Heitmueller
1266d3829fadSDevin Heitmueller rc = vb2_queue_init(q);
1267d3829fadSDevin Heitmueller if (rc < 0)
1268d3829fadSDevin Heitmueller return rc;
1269d3829fadSDevin Heitmueller
1270d3829fadSDevin Heitmueller return 0;
1271d3829fadSDevin Heitmueller }
1272d3829fadSDevin Heitmueller
1273f9fe90a4SMauro Carvalho Chehab /*
1274f9fe90a4SMauro Carvalho Chehab * v4l2 interface
1275f9fe90a4SMauro Carvalho Chehab */
12760c0d06caSMauro Carvalho Chehab
video_mux(struct em28xx * dev,int index)12770c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index)
12780c0d06caSMauro Carvalho Chehab {
127995d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev;
1280fdf1bc9fSMauro Carvalho Chehab
12810c0d06caSMauro Carvalho Chehab dev->ctl_input = index;
12820c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux;
12830c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout;
12840c0d06caSMauro Carvalho Chehab
12850c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput)
12860c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER;
12870c0d06caSMauro Carvalho Chehab
128895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing,
12890c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0);
12900c0d06caSMauro Carvalho Chehab
1291aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) {
12920c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) {
129395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio,
12940c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed);
12950c0d06caSMauro Carvalho Chehab }
12960c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */
129795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing,
1298fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput,
1299fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0);
13000c0d06caSMauro Carvalho Chehab }
13010c0d06caSMauro Carvalho Chehab
13020c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) {
130395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing,
13040c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0);
13050c0d06caSMauro Carvalho Chehab }
13060c0d06caSMauro Carvalho Chehab
13070c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev);
13080c0d06caSMauro Carvalho Chehab }
13090c0d06caSMauro Carvalho Chehab
em28xx_ctrl_notify(struct v4l2_ctrl * ctrl,void * priv)131001c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv)
13110c0d06caSMauro Carvalho Chehab {
1312081b945eSHans Verkuil struct em28xx *dev = priv;
13130c0d06caSMauro Carvalho Chehab
13140c0d06caSMauro Carvalho Chehab /*
1315081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need
1316081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute
1317081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges
1318081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver.
13190c0d06caSMauro Carvalho Chehab */
13200c0d06caSMauro Carvalho Chehab switch (ctrl->id) {
13210c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE:
1322081b945eSHans Verkuil dev->mute = ctrl->val;
1323081b945eSHans Verkuil em28xx_audio_analog_set(dev);
13240c0d06caSMauro Carvalho Chehab break;
13250c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME:
1326081b945eSHans Verkuil dev->volume = ctrl->val;
1327081b945eSHans Verkuil em28xx_audio_analog_set(dev);
1328081b945eSHans Verkuil break;
1329081b945eSHans Verkuil }
1330081b945eSHans Verkuil }
1331081b945eSHans Verkuil
em28xx_s_ctrl(struct v4l2_ctrl * ctrl)1332081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl)
1333081b945eSHans Verkuil {
1334abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 =
1335abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler);
1336abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev;
13378f8b113aSFrank Schaefer int ret = -EINVAL;
1338081b945eSHans Verkuil
1339081b945eSHans Verkuil switch (ctrl->id) {
1340081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE:
1341081b945eSHans Verkuil dev->mute = ctrl->val;
13428f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev);
1343081b945eSHans Verkuil break;
1344081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME:
1345081b945eSHans Verkuil dev->volume = ctrl->val;
13468f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev);
13478f8b113aSFrank Schaefer break;
13488f8b113aSFrank Schaefer case V4L2_CID_CONTRAST:
13498f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val);
13508f8b113aSFrank Schaefer break;
13518f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS:
13528f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val);
13538f8b113aSFrank Schaefer break;
13548f8b113aSFrank Schaefer case V4L2_CID_SATURATION:
13558f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val);
13568f8b113aSFrank Schaefer break;
13578f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE:
13588f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val);
13598f8b113aSFrank Schaefer break;
13608f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE:
13618f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val);
13628f8b113aSFrank Schaefer break;
13638f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS:
13648f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val);
13650c0d06caSMauro Carvalho Chehab break;
13660c0d06caSMauro Carvalho Chehab }
13670c0d06caSMauro Carvalho Chehab
13688f8b113aSFrank Schaefer return (ret < 0) ? ret : 0;
13690c0d06caSMauro Carvalho Chehab }
13700c0d06caSMauro Carvalho Chehab
13718068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = {
1372081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl,
1373081b945eSHans Verkuil };
1374081b945eSHans Verkuil
size_to_scale(struct em28xx * dev,unsigned int width,unsigned int height,unsigned int * hscale,unsigned int * vscale)13756b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev,
13760c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height,
13770c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale)
13780c0d06caSMauro Carvalho Chehab {
13790c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev);
13800c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev);
13810c0d06caSMauro Carvalho Chehab
13820c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L;
138381685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX)
138481685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX;
13850c0d06caSMauro Carvalho Chehab
13860c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L;
138781685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX)
138881685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX;
13890c0d06caSMauro Carvalho Chehab }
13900c0d06caSMauro Carvalho Chehab
scale_to_size(struct em28xx * dev,unsigned int hscale,unsigned int vscale,unsigned int * width,unsigned int * height)1391b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev,
1392b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale,
1393b8374138SFrank Schaefer unsigned int *width, unsigned int *height)
1394b8374138SFrank Schaefer {
1395b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev);
1396b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev);
1397b8374138SFrank Schaefer
1398b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L);
1399b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L);
14000962a763SMauro Carvalho Chehab
14010962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */
14020962a763SMauro Carvalho Chehab if (*width < 1)
14030962a763SMauro Carvalho Chehab *width = 1;
14040962a763SMauro Carvalho Chehab if (*height < 1)
14050962a763SMauro Carvalho Chehab *height = 1;
1406b8374138SFrank Schaefer }
1407b8374138SFrank Schaefer
1408f9fe90a4SMauro Carvalho Chehab /*
1409f9fe90a4SMauro Carvalho Chehab * IOCTL vidioc handling
1410f9fe90a4SMauro Carvalho Chehab */
14110c0d06caSMauro Carvalho Chehab
vidioc_g_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)14120c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
14130c0d06caSMauro Carvalho Chehab struct v4l2_format *f)
14140c0d06caSMauro Carvalho Chehab {
1415917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
1416753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
14170c0d06caSMauro Carvalho Chehab
1418753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width;
1419753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height;
142006e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc;
142106e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3;
1422753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height;
14230c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
14240c0d06caSMauro Carvalho Chehab
14250c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */
142658159171SFrank Schaefer if (v4l2->progressive)
14270c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE;
14280c0d06caSMauro Carvalho Chehab else
142958159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ?
14300c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP;
14310c0d06caSMauro Carvalho Chehab return 0;
14320c0d06caSMauro Carvalho Chehab }
14330c0d06caSMauro Carvalho Chehab
format_by_fourcc(unsigned int fourcc)14340c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc)
14350c0d06caSMauro Carvalho Chehab {
14360c0d06caSMauro Carvalho Chehab unsigned int i;
14370c0d06caSMauro Carvalho Chehab
14380c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++)
14390c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc)
14400c0d06caSMauro Carvalho Chehab return &format[i];
14410c0d06caSMauro Carvalho Chehab
14420c0d06caSMauro Carvalho Chehab return NULL;
14430c0d06caSMauro Carvalho Chehab }
14440c0d06caSMauro Carvalho Chehab
vidioc_try_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)14450c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
14460c0d06caSMauro Carvalho Chehab struct v4l2_format *f)
14470c0d06caSMauro Carvalho Chehab {
1448917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
144958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
14500c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width;
14510c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height;
14520c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev);
14530c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev);
14540c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale;
14550c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt;
14560c0d06caSMauro Carvalho Chehab
14570c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat);
14580c0d06caSMauro Carvalho Chehab if (!fmt) {
1459f823ce2aSMauro Carvalho Chehab fmt = &format[0];
1460f823ce2aSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid. Using default (%08x).\n",
1461f823ce2aSMauro Carvalho Chehab f->fmt.pix.pixelformat, fmt->fourcc);
14620c0d06caSMauro Carvalho Chehab }
14630c0d06caSMauro Carvalho Chehab
14640c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) {
14650c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */
14660c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2;
14670c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2;
1468d3829fadSDevin Heitmueller /*
1469d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full
1470d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale
1471d3829fadSDevin Heitmueller * to 50%
1472d3829fadSDevin Heitmueller */
14730c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh)
14740c0d06caSMauro Carvalho Chehab width /= 2;
14750c0d06caSMauro Carvalho Chehab } else {
1476f9fe90a4SMauro Carvalho Chehab /*
1477f9fe90a4SMauro Carvalho Chehab * width must even because of the YUYV format
1478f9fe90a4SMauro Carvalho Chehab * height must be even because of interlacing
1479f9fe90a4SMauro Carvalho Chehab */
14800c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh,
14810c0d06caSMauro Carvalho Chehab 1, 0);
14820c0d06caSMauro Carvalho Chehab }
14830962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */
14840962a763SMauro Carvalho Chehab if (width < 1)
14850962a763SMauro Carvalho Chehab width = 1;
14860962a763SMauro Carvalho Chehab if (height < 1)
14870962a763SMauro Carvalho Chehab height = 1;
14880c0d06caSMauro Carvalho Chehab
14896b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale);
149046f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height);
14910c0d06caSMauro Carvalho Chehab
14920c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width;
14930c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height;
14940c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc;
1495e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3;
14960c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height;
14970c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
149858159171SFrank Schaefer if (v4l2->progressive)
14990c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE;
15000c0d06caSMauro Carvalho Chehab else
150158159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ?
15020c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP;
15030c0d06caSMauro Carvalho Chehab
15040c0d06caSMauro Carvalho Chehab return 0;
15050c0d06caSMauro Carvalho Chehab }
15060c0d06caSMauro Carvalho Chehab
em28xx_set_video_format(struct em28xx * dev,unsigned int fourcc,unsigned int width,unsigned int height)15070c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc,
1508f9fe90a4SMauro Carvalho Chehab unsigned int width, unsigned int height)
15090c0d06caSMauro Carvalho Chehab {
15100c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt;
1511753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
15120c0d06caSMauro Carvalho Chehab
15130c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc);
15140c0d06caSMauro Carvalho Chehab if (!fmt)
15150c0d06caSMauro Carvalho Chehab return -EINVAL;
15160c0d06caSMauro Carvalho Chehab
151706e20672SFrank Schaefer v4l2->format = fmt;
1518753aee77SFrank Schaefer v4l2->width = width;
1519753aee77SFrank Schaefer v4l2->height = height;
15200c0d06caSMauro Carvalho Chehab
15210c0d06caSMauro Carvalho Chehab /* set new image size */
1522753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height,
1523753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale);
15240c0d06caSMauro Carvalho Chehab
15250c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev);
15260c0d06caSMauro Carvalho Chehab
15270c0d06caSMauro Carvalho Chehab return 0;
15280c0d06caSMauro Carvalho Chehab }
15290c0d06caSMauro Carvalho Chehab
vidioc_s_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)15300c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
15310c0d06caSMauro Carvalho Chehab struct v4l2_format *f)
15320c0d06caSMauro Carvalho Chehab {
1533d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file);
15348139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
15350c0d06caSMauro Carvalho Chehab
1536c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq))
1537d3829fadSDevin Heitmueller return -EBUSY;
15380c0d06caSMauro Carvalho Chehab
15390c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f);
15400c0d06caSMauro Carvalho Chehab
15410c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat,
15420c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height);
15430c0d06caSMauro Carvalho Chehab }
15440c0d06caSMauro Carvalho Chehab
vidioc_g_std(struct file * file,void * priv,v4l2_std_id * norm)15450c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm)
15460c0d06caSMauro Carvalho Chehab {
1547917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
15480c0d06caSMauro Carvalho Chehab
154952faaf78SFrank Schaefer *norm = dev->v4l2->norm;
15500c0d06caSMauro Carvalho Chehab
15510c0d06caSMauro Carvalho Chehab return 0;
15520c0d06caSMauro Carvalho Chehab }
15530c0d06caSMauro Carvalho Chehab
vidioc_querystd(struct file * file,void * priv,v4l2_std_id * norm)15540c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm)
15550c0d06caSMauro Carvalho Chehab {
1556917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
15570c0d06caSMauro Carvalho Chehab
155895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm);
15590c0d06caSMauro Carvalho Chehab
15600c0d06caSMauro Carvalho Chehab return 0;
15610c0d06caSMauro Carvalho Chehab }
15620c0d06caSMauro Carvalho Chehab
vidioc_s_std(struct file * file,void * priv,v4l2_std_id norm)1563314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm)
15640c0d06caSMauro Carvalho Chehab {
1565917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
1566753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
15670c0d06caSMauro Carvalho Chehab struct v4l2_format f;
15680c0d06caSMauro Carvalho Chehab
156952faaf78SFrank Schaefer if (norm == v4l2->norm)
1570d8c95c08SHans Verkuil return 0;
15710c0d06caSMauro Carvalho Chehab
15728139a4d5SFrank Schaefer if (v4l2->streaming_users > 0)
1573d8c95c08SHans Verkuil return -EBUSY;
1574d8c95c08SHans Verkuil
157552faaf78SFrank Schaefer v4l2->norm = norm;
15760c0d06caSMauro Carvalho Chehab
15770c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */
1578d8c95c08SHans Verkuil f.fmt.pix.width = 720;
1579314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576;
15800c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f);
15810c0d06caSMauro Carvalho Chehab
15820c0d06caSMauro Carvalho Chehab /* set new image size */
1583753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width;
1584753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height;
1585753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height,
1586753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale);
15870c0d06caSMauro Carvalho Chehab
15880c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev);
15898774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm);
15900c0d06caSMauro Carvalho Chehab
15910c0d06caSMauro Carvalho Chehab return 0;
15920c0d06caSMauro Carvalho Chehab }
15930c0d06caSMauro Carvalho Chehab
vidioc_g_parm(struct file * file,void * priv,struct v4l2_streamparm * p)15940c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv,
15950c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p)
15960c0d06caSMauro Carvalho Chehab {
15974471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 };
1598917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
159952faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
16000c0d06caSMauro Carvalho Chehab int rc = 0;
16010c0d06caSMauro Carvalho Chehab
16024471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
16034471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
16044471109eSHans Verkuil return -EINVAL;
16054471109eSHans Verkuil
160686ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF;
16074471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME;
1608aa62980bSMauro Carvalho Chehab if (dev->is_webcam) {
160952faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0,
16104471109eSHans Verkuil video, g_frame_interval, &ival);
16114471109eSHans Verkuil if (!rc)
16124471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval;
16134471109eSHans Verkuil } else {
161452faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm,
16150c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe);
16164471109eSHans Verkuil }
16170c0d06caSMauro Carvalho Chehab
16180c0d06caSMauro Carvalho Chehab return rc;
16190c0d06caSMauro Carvalho Chehab }
16200c0d06caSMauro Carvalho Chehab
vidioc_s_parm(struct file * file,void * priv,struct v4l2_streamparm * p)16210c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv,
16220c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p)
16230c0d06caSMauro Carvalho Chehab {
1624917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
16254471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = {
16264471109eSHans Verkuil 0,
16274471109eSHans Verkuil p->parm.capture.timeperframe
16284471109eSHans Verkuil };
16294471109eSHans Verkuil int rc = 0;
16300c0d06caSMauro Carvalho Chehab
1631aa62980bSMauro Carvalho Chehab if (!dev->is_webcam)
16324471109eSHans Verkuil return -ENOTTY;
16334471109eSHans Verkuil
16344471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
16354471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
16364471109eSHans Verkuil return -EINVAL;
16374471109eSHans Verkuil
16384471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm));
163986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF;
16404471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME;
16414471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0,
16424471109eSHans Verkuil video, s_frame_interval, &ival);
16434471109eSHans Verkuil if (!rc)
16444471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval;
16454471109eSHans Verkuil return rc;
16460c0d06caSMauro Carvalho Chehab }
16470c0d06caSMauro Carvalho Chehab
vidioc_enum_input(struct file * file,void * priv,struct v4l2_input * i)16480c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv,
16490c0d06caSMauro Carvalho Chehab struct v4l2_input *i)
16500c0d06caSMauro Carvalho Chehab {
1651917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
16520c0d06caSMauro Carvalho Chehab unsigned int n;
1653258c4304SMauro Carvalho Chehab int j;
16540c0d06caSMauro Carvalho Chehab
16550c0d06caSMauro Carvalho Chehab n = i->index;
16560c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT)
16570c0d06caSMauro Carvalho Chehab return -EINVAL;
1658f9fe90a4SMauro Carvalho Chehab if (!INPUT(n)->type)
16590c0d06caSMauro Carvalho Chehab return -EINVAL;
16600c0d06caSMauro Carvalho Chehab
16610c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA;
16620c0d06caSMauro Carvalho Chehab
1663cc1e6315SMauro Carvalho Chehab strscpy(i->name, iname[INPUT(n)->type], sizeof(i->name));
16640c0d06caSMauro Carvalho Chehab
1665f9fe90a4SMauro Carvalho Chehab if (INPUT(n)->type == EM28XX_VMUX_TELEVISION)
16660c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER;
16670c0d06caSMauro Carvalho Chehab
1668d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms;
1669d8c95c08SHans Verkuil /* webcams do not have the STD API */
1670aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
1671d8c95c08SHans Verkuil i->capabilities = 0;
16720c0d06caSMauro Carvalho Chehab
1673258c4304SMauro Carvalho Chehab /* Dynamically generates an audioset bitmask */
1674258c4304SMauro Carvalho Chehab i->audioset = 0;
1675258c4304SMauro Carvalho Chehab for (j = 0; j < MAX_EM28XX_INPUT; j++)
1676258c4304SMauro Carvalho Chehab if (dev->amux_map[j] != EM28XX_AMUX_UNUSED)
1677258c4304SMauro Carvalho Chehab i->audioset |= 1 << j;
1678258c4304SMauro Carvalho Chehab
16790c0d06caSMauro Carvalho Chehab return 0;
16800c0d06caSMauro Carvalho Chehab }
16810c0d06caSMauro Carvalho Chehab
vidioc_g_input(struct file * file,void * priv,unsigned int * i)16820c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
16830c0d06caSMauro Carvalho Chehab {
1684917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
16850c0d06caSMauro Carvalho Chehab
16860c0d06caSMauro Carvalho Chehab *i = dev->ctl_input;
16870c0d06caSMauro Carvalho Chehab
16880c0d06caSMauro Carvalho Chehab return 0;
16890c0d06caSMauro Carvalho Chehab }
16900c0d06caSMauro Carvalho Chehab
vidioc_s_input(struct file * file,void * priv,unsigned int i)16910c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
16920c0d06caSMauro Carvalho Chehab {
1693917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
16940c0d06caSMauro Carvalho Chehab
16950c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT)
16960c0d06caSMauro Carvalho Chehab return -EINVAL;
1697f9fe90a4SMauro Carvalho Chehab if (!INPUT(i)->type)
16980c0d06caSMauro Carvalho Chehab return -EINVAL;
16990c0d06caSMauro Carvalho Chehab
17000c0d06caSMauro Carvalho Chehab video_mux(dev, i);
17010c0d06caSMauro Carvalho Chehab return 0;
17020c0d06caSMauro Carvalho Chehab }
17030c0d06caSMauro Carvalho Chehab
em28xx_fill_audio_input(struct em28xx * dev,const char * s,struct v4l2_audio * a,unsigned int index)1704258c4304SMauro Carvalho Chehab static int em28xx_fill_audio_input(struct em28xx *dev,
1705258c4304SMauro Carvalho Chehab const char *s,
1706258c4304SMauro Carvalho Chehab struct v4l2_audio *a,
1707258c4304SMauro Carvalho Chehab unsigned int index)
17080c0d06caSMauro Carvalho Chehab {
1709258c4304SMauro Carvalho Chehab unsigned int idx = dev->amux_map[index];
17100c0d06caSMauro Carvalho Chehab
1711258c4304SMauro Carvalho Chehab /*
1712258c4304SMauro Carvalho Chehab * With msp3400, almost all mappings use the default (amux = 0).
1713258c4304SMauro Carvalho Chehab * The only one may use a different value is WinTV USB2, where it
1714258c4304SMauro Carvalho Chehab * can also be SCART1 input.
1715258c4304SMauro Carvalho Chehab * As it is very doubtful that we would see new boards with msp3400,
1716258c4304SMauro Carvalho Chehab * let's just reuse the existing switch.
1717258c4304SMauro Carvalho Chehab */
1718258c4304SMauro Carvalho Chehab if (dev->has_msp34xx && idx != EM28XX_AMUX_UNUSED)
1719258c4304SMauro Carvalho Chehab idx = EM28XX_AMUX_LINE_IN;
1720258c4304SMauro Carvalho Chehab
1721258c4304SMauro Carvalho Chehab switch (idx) {
17220c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO:
1723cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television", sizeof(a->name));
17240c0d06caSMauro Carvalho Chehab break;
17250c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN:
1726cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Line In", sizeof(a->name));
17270c0d06caSMauro Carvalho Chehab break;
17280c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2:
1729cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television alt", sizeof(a->name));
17300c0d06caSMauro Carvalho Chehab break;
17310c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE:
1732cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Phone", sizeof(a->name));
17330c0d06caSMauro Carvalho Chehab break;
17340c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC:
1735cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Mic", sizeof(a->name));
17360c0d06caSMauro Carvalho Chehab break;
17370c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD:
1738cc1e6315SMauro Carvalho Chehab strscpy(a->name, "CD", sizeof(a->name));
17390c0d06caSMauro Carvalho Chehab break;
17400c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX:
1741cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Aux", sizeof(a->name));
17420c0d06caSMauro Carvalho Chehab break;
17430c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT:
1744cc1e6315SMauro Carvalho Chehab strscpy(a->name, "PCM", sizeof(a->name));
17450c0d06caSMauro Carvalho Chehab break;
1746258c4304SMauro Carvalho Chehab case EM28XX_AMUX_UNUSED:
17470c0d06caSMauro Carvalho Chehab default:
17480c0d06caSMauro Carvalho Chehab return -EINVAL;
17490c0d06caSMauro Carvalho Chehab }
1750258c4304SMauro Carvalho Chehab a->index = index;
17510c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO;
17520c0d06caSMauro Carvalho Chehab
1753258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: audio input index %d is '%s'\n",
1754258c4304SMauro Carvalho Chehab s, a->index, a->name);
1755258c4304SMauro Carvalho Chehab
17560c0d06caSMauro Carvalho Chehab return 0;
17570c0d06caSMauro Carvalho Chehab }
17580c0d06caSMauro Carvalho Chehab
vidioc_enumaudio(struct file * file,void * fh,struct v4l2_audio * a)1759258c4304SMauro Carvalho Chehab static int vidioc_enumaudio(struct file *file, void *fh, struct v4l2_audio *a)
1760258c4304SMauro Carvalho Chehab {
1761258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file);
1762258c4304SMauro Carvalho Chehab
1763258c4304SMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT)
1764258c4304SMauro Carvalho Chehab return -EINVAL;
1765258c4304SMauro Carvalho Chehab
1766258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, a->index);
1767258c4304SMauro Carvalho Chehab }
1768258c4304SMauro Carvalho Chehab
vidioc_g_audio(struct file * file,void * priv,struct v4l2_audio * a)1769258c4304SMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a)
1770258c4304SMauro Carvalho Chehab {
1771258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file);
1772258c4304SMauro Carvalho Chehab int i;
1773258c4304SMauro Carvalho Chehab
1774258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++)
1775258c4304SMauro Carvalho Chehab if (dev->ctl_ainput == dev->amux_map[i])
1776258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, i);
1777258c4304SMauro Carvalho Chehab
1778258c4304SMauro Carvalho Chehab /* Should never happen! */
1779258c4304SMauro Carvalho Chehab return -EINVAL;
1780258c4304SMauro Carvalho Chehab }
1781258c4304SMauro Carvalho Chehab
vidioc_s_audio(struct file * file,void * priv,const struct v4l2_audio * a)1782f9fe90a4SMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv,
1783f9fe90a4SMauro Carvalho Chehab const struct v4l2_audio *a)
17840c0d06caSMauro Carvalho Chehab {
1785917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
1786258c4304SMauro Carvalho Chehab int idx, i;
17870c0d06caSMauro Carvalho Chehab
17880c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT)
17890c0d06caSMauro Carvalho Chehab return -EINVAL;
1790258c4304SMauro Carvalho Chehab
1791258c4304SMauro Carvalho Chehab idx = dev->amux_map[a->index];
1792258c4304SMauro Carvalho Chehab
1793258c4304SMauro Carvalho Chehab if (idx == EM28XX_AMUX_UNUSED)
17940c0d06caSMauro Carvalho Chehab return -EINVAL;
17950c0d06caSMauro Carvalho Chehab
1796258c4304SMauro Carvalho Chehab dev->ctl_ainput = idx;
1797258c4304SMauro Carvalho Chehab
1798258c4304SMauro Carvalho Chehab /*
1799258c4304SMauro Carvalho Chehab * FIXME: This is wrong, as different inputs at em28xx_cards
1800258c4304SMauro Carvalho Chehab * may have different audio outputs. So, the right thing
1801258c4304SMauro Carvalho Chehab * to do is to implement VIDIOC_G_AUDOUT/VIDIOC_S_AUDOUT.
1802258c4304SMauro Carvalho Chehab * With the current board definitions, this would work fine,
1803258c4304SMauro Carvalho Chehab * as, currently, all boards fit.
1804258c4304SMauro Carvalho Chehab */
1805258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++)
1806258c4304SMauro Carvalho Chehab if (idx == dev->amux_map[i])
1807258c4304SMauro Carvalho Chehab break;
1808258c4304SMauro Carvalho Chehab if (i == MAX_EM28XX_INPUT)
1809258c4304SMauro Carvalho Chehab return -EINVAL;
1810258c4304SMauro Carvalho Chehab
1811258c4304SMauro Carvalho Chehab dev->ctl_aoutput = INPUT(i)->aout;
18120c0d06caSMauro Carvalho Chehab
18130c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput)
18140c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER;
18150c0d06caSMauro Carvalho Chehab
1816258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: set audio input to %d\n", __func__,
1817258c4304SMauro Carvalho Chehab dev->ctl_ainput);
1818258c4304SMauro Carvalho Chehab
18190c0d06caSMauro Carvalho Chehab return 0;
18200c0d06caSMauro Carvalho Chehab }
18210c0d06caSMauro Carvalho Chehab
vidioc_g_tuner(struct file * file,void * priv,struct v4l2_tuner * t)18220c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv,
18230c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t)
18240c0d06caSMauro Carvalho Chehab {
1825917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
18260c0d06caSMauro Carvalho Chehab
1827f9fe90a4SMauro Carvalho Chehab if (t->index != 0)
18280c0d06caSMauro Carvalho Chehab return -EINVAL;
18290c0d06caSMauro Carvalho Chehab
1830cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Tuner", sizeof(t->name));
18310c0d06caSMauro Carvalho Chehab
183295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t);
18330c0d06caSMauro Carvalho Chehab return 0;
18340c0d06caSMauro Carvalho Chehab }
18350c0d06caSMauro Carvalho Chehab
vidioc_s_tuner(struct file * file,void * priv,const struct v4l2_tuner * t)18360c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv,
18372f73c7c5SHans Verkuil const struct v4l2_tuner *t)
18380c0d06caSMauro Carvalho Chehab {
1839917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
18400c0d06caSMauro Carvalho Chehab
1841f9fe90a4SMauro Carvalho Chehab if (t->index != 0)
18420c0d06caSMauro Carvalho Chehab return -EINVAL;
18430c0d06caSMauro Carvalho Chehab
184495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t);
18450c0d06caSMauro Carvalho Chehab return 0;
18460c0d06caSMauro Carvalho Chehab }
18470c0d06caSMauro Carvalho Chehab
vidioc_g_frequency(struct file * file,void * priv,struct v4l2_frequency * f)18480c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv,
18490c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f)
18500c0d06caSMauro Carvalho Chehab {
1851917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
18523854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
18530c0d06caSMauro Carvalho Chehab
1854f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0)
185520deebfeSHans Verkuil return -EINVAL;
185620deebfeSHans Verkuil
18573854b0d8SFrank Schaefer f->frequency = v4l2->frequency;
18580c0d06caSMauro Carvalho Chehab return 0;
18590c0d06caSMauro Carvalho Chehab }
18600c0d06caSMauro Carvalho Chehab
vidioc_s_frequency(struct file * file,void * priv,const struct v4l2_frequency * f)18610c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv,
1862b530a447SHans Verkuil const struct v4l2_frequency *f)
18630c0d06caSMauro Carvalho Chehab {
1864b530a447SHans Verkuil struct v4l2_frequency new_freq = *f;
1865917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
186695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
18670c0d06caSMauro Carvalho Chehab
1868f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0)
18690c0d06caSMauro Carvalho Chehab return -EINVAL;
18700c0d06caSMauro Carvalho Chehab
187195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f);
187295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq);
18733854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency;
18740c0d06caSMauro Carvalho Chehab
18750c0d06caSMauro Carvalho Chehab return 0;
18760c0d06caSMauro Carvalho Chehab }
18770c0d06caSMauro Carvalho Chehab
1878cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG
vidioc_g_chip_info(struct file * file,void * priv,struct v4l2_dbg_chip_info * chip)187996b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv,
188096b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip)
18813b2d17b4SHans Verkuil {
1882917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
18833b2d17b4SHans Verkuil
18843b2d17b4SHans Verkuil if (chip->match.addr > 1)
18853b2d17b4SHans Verkuil return -EINVAL;
18863b2d17b4SHans Verkuil if (chip->match.addr == 1)
1887c0decac1SMauro Carvalho Chehab strscpy(chip->name, "ac97", sizeof(chip->name));
18883b2d17b4SHans Verkuil else
1889c0decac1SMauro Carvalho Chehab strscpy(chip->name,
189095d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name));
18913b2d17b4SHans Verkuil return 0;
18923b2d17b4SHans Verkuil }
18933b2d17b4SHans Verkuil
em28xx_reg_len(int reg)189435deba32SFrank Schaefer static int em28xx_reg_len(int reg)
189535deba32SFrank Schaefer {
189635deba32SFrank Schaefer switch (reg) {
189735deba32SFrank Schaefer case EM28XX_R40_AC97LSB:
189835deba32SFrank Schaefer case EM28XX_R30_HSCALELOW:
189935deba32SFrank Schaefer case EM28XX_R32_VSCALELOW:
190035deba32SFrank Schaefer return 2;
190135deba32SFrank Schaefer default:
190235deba32SFrank Schaefer return 1;
190335deba32SFrank Schaefer }
190435deba32SFrank Schaefer }
19050c0d06caSMauro Carvalho Chehab
vidioc_g_register(struct file * file,void * priv,struct v4l2_dbg_register * reg)19060c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv,
19070c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg)
19080c0d06caSMauro Carvalho Chehab {
1909917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
19100c0d06caSMauro Carvalho Chehab int ret;
19110c0d06caSMauro Carvalho Chehab
19123b2d17b4SHans Verkuil if (reg->match.addr > 1)
19133b2d17b4SHans Verkuil return -EINVAL;
1914abca2056SHans Verkuil if (reg->match.addr) {
19150c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg);
19160c0d06caSMauro Carvalho Chehab if (ret < 0)
19170c0d06caSMauro Carvalho Chehab return ret;
19180c0d06caSMauro Carvalho Chehab
19190c0d06caSMauro Carvalho Chehab reg->val = ret;
19200c0d06caSMauro Carvalho Chehab reg->size = 1;
19210c0d06caSMauro Carvalho Chehab return 0;
19220c0d06caSMauro Carvalho Chehab }
19230c0d06caSMauro Carvalho Chehab
19240c0d06caSMauro Carvalho Chehab /* Match host */
19250c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg);
19260c0d06caSMauro Carvalho Chehab if (reg->size == 1) {
19270c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg);
19280c0d06caSMauro Carvalho Chehab
19290c0d06caSMauro Carvalho Chehab if (ret < 0)
19300c0d06caSMauro Carvalho Chehab return ret;
19310c0d06caSMauro Carvalho Chehab
19320c0d06caSMauro Carvalho Chehab reg->val = ret;
19330c0d06caSMauro Carvalho Chehab } else {
19340c0d06caSMauro Carvalho Chehab __le16 val = 0;
1935fdf1bc9fSMauro Carvalho Chehab
193601c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS,
19370c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2);
19380c0d06caSMauro Carvalho Chehab if (ret < 0)
19390c0d06caSMauro Carvalho Chehab return ret;
19400c0d06caSMauro Carvalho Chehab
19410c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val);
19420c0d06caSMauro Carvalho Chehab }
19430c0d06caSMauro Carvalho Chehab
19440c0d06caSMauro Carvalho Chehab return 0;
19450c0d06caSMauro Carvalho Chehab }
19460c0d06caSMauro Carvalho Chehab
vidioc_s_register(struct file * file,void * priv,const struct v4l2_dbg_register * reg)19470c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv,
1948977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg)
19490c0d06caSMauro Carvalho Chehab {
1950917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
19510c0d06caSMauro Carvalho Chehab __le16 buf;
19520c0d06caSMauro Carvalho Chehab
19533b2d17b4SHans Verkuil if (reg->match.addr > 1)
19543b2d17b4SHans Verkuil return -EINVAL;
1955abca2056SHans Verkuil if (reg->match.addr)
19560c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val);
19570c0d06caSMauro Carvalho Chehab
19580c0d06caSMauro Carvalho Chehab /* Match host */
19590c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val);
19600c0d06caSMauro Carvalho Chehab
19610c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf,
19620c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg));
19630c0d06caSMauro Carvalho Chehab }
19640c0d06caSMauro Carvalho Chehab #endif
19650c0d06caSMauro Carvalho Chehab
vidioc_querycap(struct file * file,void * priv,struct v4l2_capability * cap)19660c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv,
19670c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap)
19680c0d06caSMauro Carvalho Chehab {
1969917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
1970ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
1971c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf);
19720c0d06caSMauro Carvalho Chehab
1973c0decac1SMauro Carvalho Chehab strscpy(cap->driver, "em28xx", sizeof(cap->driver));
1974c0decac1SMauro Carvalho Chehab strscpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card));
1975c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info));
19760c0d06caSMauro Carvalho Chehab
19778c3854d0SHans Verkuil cap->capabilities = V4L2_CAP_DEVICE_CAPS | V4L2_CAP_READWRITE |
1978a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING;
1979920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE)
19808c3854d0SHans Verkuil cap->capabilities |= V4L2_CAP_AUDIO;
19810c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT)
19828c3854d0SHans Verkuil cap->capabilities |= V4L2_CAP_TUNER;
1983d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev))
19841d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE;
1985d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev))
1986a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO;
19870c0d06caSMauro Carvalho Chehab return 0;
19880c0d06caSMauro Carvalho Chehab }
19890c0d06caSMauro Carvalho Chehab
vidioc_enum_fmt_vid_cap(struct file * file,void * priv,struct v4l2_fmtdesc * f)19900c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
19910c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f)
19920c0d06caSMauro Carvalho Chehab {
19930c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format)))
19940c0d06caSMauro Carvalho Chehab return -EINVAL;
19950c0d06caSMauro Carvalho Chehab
19960c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc;
19970c0d06caSMauro Carvalho Chehab
19980c0d06caSMauro Carvalho Chehab return 0;
19990c0d06caSMauro Carvalho Chehab }
20000c0d06caSMauro Carvalho Chehab
vidioc_enum_framesizes(struct file * file,void * priv,struct v4l2_frmsizeenum * fsize)20010c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv,
20020c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize)
20030c0d06caSMauro Carvalho Chehab {
2004917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
20050c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt;
20060c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev);
20070c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev);
20080c0d06caSMauro Carvalho Chehab
20090c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format);
20100c0d06caSMauro Carvalho Chehab if (!fmt) {
20110c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n",
20120c0d06caSMauro Carvalho Chehab fsize->pixel_format);
20130c0d06caSMauro Carvalho Chehab return -EINVAL;
20140c0d06caSMauro Carvalho Chehab }
20150c0d06caSMauro Carvalho Chehab
20160c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) {
20170c0d06caSMauro Carvalho Chehab if (fsize->index > 1)
20180c0d06caSMauro Carvalho Chehab return -EINVAL;
20190c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
20200c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index);
20210c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index);
20220c0d06caSMauro Carvalho Chehab return 0;
20230c0d06caSMauro Carvalho Chehab }
20240c0d06caSMauro Carvalho Chehab
20250c0d06caSMauro Carvalho Chehab if (fsize->index != 0)
20260c0d06caSMauro Carvalho Chehab return -EINVAL;
20270c0d06caSMauro Carvalho Chehab
20280c0d06caSMauro Carvalho Chehab /* Report a continuous range */
20290c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
20306c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX,
20316c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height);
20326c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48)
20330c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48;
20346c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38)
20356c3598e6SFrank Schaefer fsize->stepwise.min_height = 38;
20360c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw;
20370c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh;
20380c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1;
20390c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1;
20400c0d06caSMauro Carvalho Chehab return 0;
20410c0d06caSMauro Carvalho Chehab }
20420c0d06caSMauro Carvalho Chehab
20430c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */
20440c0d06caSMauro Carvalho Chehab
vidioc_g_fmt_vbi_cap(struct file * file,void * priv,struct v4l2_format * format)20450c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv,
20460c0d06caSMauro Carvalho Chehab struct v4l2_format *format)
20470c0d06caSMauro Carvalho Chehab {
2048917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
2049753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
20500c0d06caSMauro Carvalho Chehab
2051753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width;
20520c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
20530c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0;
20540c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0;
20550c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2;
2056753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height;
2057753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height;
20582a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved));
20590c0d06caSMauro Carvalho Chehab
20600c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */
206152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) {
20620c0d06caSMauro Carvalho Chehab /* NTSC */
20630c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10;
20640c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273;
206552faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) {
20660c0d06caSMauro Carvalho Chehab /* PAL */
20670c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6;
20680c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318;
20690c0d06caSMauro Carvalho Chehab }
20700c0d06caSMauro Carvalho Chehab
20710c0d06caSMauro Carvalho Chehab return 0;
20720c0d06caSMauro Carvalho Chehab }
20730c0d06caSMauro Carvalho Chehab
2074f9fe90a4SMauro Carvalho Chehab /*
2075f9fe90a4SMauro Carvalho Chehab * RADIO ESPECIFIC IOCTLS
2076f9fe90a4SMauro Carvalho Chehab */
20770c0d06caSMauro Carvalho Chehab
radio_g_tuner(struct file * file,void * priv,struct v4l2_tuner * t)20780c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv,
20790c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t)
20800c0d06caSMauro Carvalho Chehab {
2081917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
20820c0d06caSMauro Carvalho Chehab
20830c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0))
20840c0d06caSMauro Carvalho Chehab return -EINVAL;
20850c0d06caSMauro Carvalho Chehab
2086cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Radio", sizeof(t->name));
20870c0d06caSMauro Carvalho Chehab
208895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t);
20890c0d06caSMauro Carvalho Chehab
20900c0d06caSMauro Carvalho Chehab return 0;
20910c0d06caSMauro Carvalho Chehab }
20920c0d06caSMauro Carvalho Chehab
radio_s_tuner(struct file * file,void * priv,const struct v4l2_tuner * t)20930c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv,
20942f73c7c5SHans Verkuil const struct v4l2_tuner *t)
20950c0d06caSMauro Carvalho Chehab {
2096917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file);
20970c0d06caSMauro Carvalho Chehab
2098f9fe90a4SMauro Carvalho Chehab if (t->index != 0)
20990c0d06caSMauro Carvalho Chehab return -EINVAL;
21000c0d06caSMauro Carvalho Chehab
210195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t);
21020c0d06caSMauro Carvalho Chehab
21030c0d06caSMauro Carvalho Chehab return 0;
21040c0d06caSMauro Carvalho Chehab }
21050c0d06caSMauro Carvalho Chehab
21060c0d06caSMauro Carvalho Chehab /*
210795d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2
210895d2608bSFrank Schaefer *
210995d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2
211095d2608bSFrank Schaefer *
211195d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone
211295d2608bSFrank Schaefer */
em28xx_free_v4l2(struct kref * ref)2113f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref)
211495d2608bSFrank Schaefer {
211595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref);
211695d2608bSFrank Schaefer
2117abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL;
211895d2608bSFrank Schaefer kfree(v4l2);
211995d2608bSFrank Schaefer }
212095d2608bSFrank Schaefer
212195d2608bSFrank Schaefer /*
21220c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open()
21230c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer
21240c0d06caSMauro Carvalho Chehab */
em28xx_v4l2_open(struct file * filp)21250c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp)
21260c0d06caSMauro Carvalho Chehab {
21270c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp);
21280c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp);
212995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
21300c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0;
21313c0f90e1SFrank Schaefer int ret;
21320c0d06caSMauro Carvalho Chehab
21330c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) {
21347fbbbc78SHans Verkuil case VFL_TYPE_VIDEO:
21350c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
21360c0d06caSMauro Carvalho Chehab break;
21370c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI:
21380c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE;
21390c0d06caSMauro Carvalho Chehab break;
21404e170240SFrank Schaefer case VFL_TYPE_RADIO:
21414e170240SFrank Schaefer break;
21424e170240SFrank Schaefer default:
21434e170240SFrank Schaefer return -EINVAL;
21440c0d06caSMauro Carvalho Chehab }
21450c0d06caSMauro Carvalho Chehab
21468e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n",
21478e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type],
21488e2c8717SFrank Schaefer v4l2->users);
21490c0d06caSMauro Carvalho Chehab
21500c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock))
21510c0d06caSMauro Carvalho Chehab return -ERESTARTSYS;
21523c0f90e1SFrank Schaefer
21533c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp);
21543c0f90e1SFrank Schaefer if (ret) {
215529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2156ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n",
21573c0f90e1SFrank Schaefer __func__, ret);
21580c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock);
21593c0f90e1SFrank Schaefer return ret;
21600c0d06caSMauro Carvalho Chehab }
21610c0d06caSMauro Carvalho Chehab
21628e2c8717SFrank Schaefer if (v4l2->users == 0) {
21630c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE);
21644e170240SFrank Schaefer
21654e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO)
21660c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev);
21670c0d06caSMauro Carvalho Chehab
21684e170240SFrank Schaefer /*
21694e170240SFrank Schaefer * Needed, since GPIO might have disabled power
21704e170240SFrank Schaefer * of some i2c devices
21710c0d06caSMauro Carvalho Chehab */
21720c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev);
21730c0d06caSMauro Carvalho Chehab }
2174d3829fadSDevin Heitmueller
2175d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) {
21760c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n");
217795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio);
21780c0d06caSMauro Carvalho Chehab }
21790c0d06caSMauro Carvalho Chehab
218047677e51SMauro Carvalho Chehab kref_get(&dev->ref);
218195d2608bSFrank Schaefer kref_get(&v4l2->ref);
21828e2c8717SFrank Schaefer v4l2->users++;
21830c0d06caSMauro Carvalho Chehab
21840c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock);
21850c0d06caSMauro Carvalho Chehab
2186d3829fadSDevin Heitmueller return 0;
21870c0d06caSMauro Carvalho Chehab }
21880c0d06caSMauro Carvalho Chehab
21890c0d06caSMauro Carvalho Chehab /*
219001c28193SMauro Carvalho Chehab * em28xx_v4l2_fini()
21910c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices
21926b338c72SGeert Uytterhoeven * called when the device gets disconnected or at module unload
21930c0d06caSMauro Carvalho Chehab */
em28xx_v4l2_fini(struct em28xx * dev)219401c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev)
21950c0d06caSMauro Carvalho Chehab {
219695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
219795d2608bSFrank Schaefer
2198822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) {
2199822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */
2200822b8deaSMauro Carvalho Chehab return 0;
2201822b8deaSMauro Carvalho Chehab }
2202822b8deaSMauro Carvalho Chehab
220301c28193SMauro Carvalho Chehab if (!dev->has_video) {
220401c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */
220501c28193SMauro Carvalho Chehab return 0;
220601c28193SMauro Carvalho Chehab }
22070c0d06caSMauro Carvalho Chehab
2208f9fe90a4SMauro Carvalho Chehab if (!v4l2)
220995d2608bSFrank Schaefer return 0;
221095d2608bSFrank Schaefer
221129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n");
2212aa929ad7SMauro Carvalho Chehab
2213ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock);
2214ebbfbc20SMauro Carvalho Chehab
221595d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev);
22165ad10de6SFrank Schaefer
221723e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE);
221823e8642cSFrank Schaefer
221937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev);
222037ecc7b1SMauro Carvalho Chehab
2221d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) {
222229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n",
2223d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev));
2224d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev);
22250c0d06caSMauro Carvalho Chehab }
2226d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) {
222729b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n",
2228d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev));
2229d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev);
22300c0d06caSMauro Carvalho Chehab }
2231d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) {
223229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n",
2233d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev));
2234d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev);
22350c0d06caSMauro Carvalho Chehab }
223601c28193SMauro Carvalho Chehab
2237abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler);
223895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev);
2239103f18a2SFrank Schaefer
224095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2);
224195d2608bSFrank Schaefer
2242ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock);
224395d2608bSFrank Schaefer
224447677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device);
22455ad10de6SFrank Schaefer
224601c28193SMauro Carvalho Chehab return 0;
22470c0d06caSMauro Carvalho Chehab }
22480c0d06caSMauro Carvalho Chehab
em28xx_v4l2_suspend(struct em28xx * dev)2249a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev)
2250a61f6811SShuah Khan {
2251a61f6811SShuah Khan if (dev->is_audio_only)
2252a61f6811SShuah Khan return 0;
2253a61f6811SShuah Khan
2254a61f6811SShuah Khan if (!dev->has_video)
2255a61f6811SShuah Khan return 0;
2256a61f6811SShuah Khan
225729b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n");
2258a61f6811SShuah Khan em28xx_stop_urbs(dev);
2259a61f6811SShuah Khan return 0;
2260a61f6811SShuah Khan }
2261a61f6811SShuah Khan
em28xx_v4l2_resume(struct em28xx * dev)2262a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev)
2263a61f6811SShuah Khan {
2264a61f6811SShuah Khan if (dev->is_audio_only)
2265a61f6811SShuah Khan return 0;
2266a61f6811SShuah Khan
2267a61f6811SShuah Khan if (!dev->has_video)
2268a61f6811SShuah Khan return 0;
2269a61f6811SShuah Khan
227029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n");
2271a61f6811SShuah Khan /* what do we do here */
2272a61f6811SShuah Khan return 0;
2273a61f6811SShuah Khan }
2274a61f6811SShuah Khan
22750c0d06caSMauro Carvalho Chehab /*
22760c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close()
22770c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2
22780c0d06caSMauro Carvalho Chehab * calls and ioctls
22790c0d06caSMauro Carvalho Chehab */
em28xx_v4l2_close(struct file * filp)22800c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp)
22810c0d06caSMauro Carvalho Chehab {
2282917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp);
228395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
2284c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf);
2285f9fe90a4SMauro Carvalho Chehab int err;
22860c0d06caSMauro Carvalho Chehab
22878e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users);
22888e2c8717SFrank Schaefer
22898e2c8717SFrank Schaefer vb2_fop_release(filp);
229098c24dcdSRicardo Ribalda mutex_lock(&dev->lock);
22910c0d06caSMauro Carvalho Chehab
22928e2c8717SFrank Schaefer if (v4l2->users == 1) {
229347677e51SMauro Carvalho Chehab /* No sense to try to write to the device */
229447677e51SMauro Carvalho Chehab if (dev->disconnected)
229501c28193SMauro Carvalho Chehab goto exit;
22960c0d06caSMauro Carvalho Chehab
22970c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */
22983aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby);
22990c0d06caSMauro Carvalho Chehab
23000c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */
23010c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND);
23020c0d06caSMauro Carvalho Chehab
23030c0d06caSMauro Carvalho Chehab /* set alternate 0 */
23040c0d06caSMauro Carvalho Chehab dev->alt = 0;
23050c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n");
2306f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, 0, 0);
2307f9fe90a4SMauro Carvalho Chehab if (err < 0) {
230829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2309ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n",
2310f9fe90a4SMauro Carvalho Chehab err);
23110c0d06caSMauro Carvalho Chehab }
23120c0d06caSMauro Carvalho Chehab }
23130c0d06caSMauro Carvalho Chehab
231401c28193SMauro Carvalho Chehab exit:
23158e2c8717SFrank Schaefer v4l2->users--;
231695d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2);
23170c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock);
231847677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device);
231947677e51SMauro Carvalho Chehab
23200c0d06caSMauro Carvalho Chehab return 0;
23210c0d06caSMauro Carvalho Chehab }
23220c0d06caSMauro Carvalho Chehab
23230c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = {
23240c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE,
23250c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open,
23260c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close,
2327d3829fadSDevin Heitmueller .read = vb2_fop_read,
2328d3829fadSDevin Heitmueller .poll = vb2_fop_poll,
2329d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap,
23300c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2,
23310c0d06caSMauro Carvalho Chehab };
23320c0d06caSMauro Carvalho Chehab
23330c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = {
23340c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap,
23350c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
23360c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
23370c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
23380c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
23390c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap,
23402a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap,
2341aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap,
23420c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes,
2343258c4304SMauro Carvalho Chehab .vidioc_enumaudio = vidioc_enumaudio,
23440c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio,
23450c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio,
23460c0d06caSMauro Carvalho Chehab
2347d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs,
2348d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs,
2349d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
2350d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf,
2351d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf,
2352d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf,
2353d3829fadSDevin Heitmueller
23540c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std,
23550c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd,
23560c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std,
23570c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm,
23580c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm,
23590c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input,
23600c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input,
23610c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input,
2362d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon,
2363d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff,
23640c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner,
23650c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner,
23660c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency,
23670c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency,
236850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
236950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
23700c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG
237196b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info,
23720c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register,
23730c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register,
23740c0d06caSMauro Carvalho Chehab #endif
23750c0d06caSMauro Carvalho Chehab };
23760c0d06caSMauro Carvalho Chehab
23770c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = {
23780c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops,
23790c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops,
2380d4352f36SHans Verkuil .release = video_device_release_empty,
23810c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL,
23820c0d06caSMauro Carvalho Chehab };
23830c0d06caSMauro Carvalho Chehab
23840c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = {
23850c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE,
23860c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open,
23870c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close,
23880c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2,
23890c0d06caSMauro Carvalho Chehab };
23900c0d06caSMauro Carvalho Chehab
23910c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = {
2392a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap,
23930c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner,
23940c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner,
23950c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency,
23960c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency,
239750fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
239850fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
23990c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG
2400430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info,
24010c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register,
24020c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register,
24030c0d06caSMauro Carvalho Chehab #endif
24040c0d06caSMauro Carvalho Chehab };
24050c0d06caSMauro Carvalho Chehab
24060c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = {
24070c0d06caSMauro Carvalho Chehab .fops = &radio_fops,
24080c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops,
2409d4352f36SHans Verkuil .release = video_device_release_empty,
24100c0d06caSMauro Carvalho Chehab };
24110c0d06caSMauro Carvalho Chehab
2412b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */
2413b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = {
2414b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */
2415b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */
2416b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END };
2417b64f8e9aSMauro Carvalho Chehab
2418b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = {
2419b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1,
2420b64f8e9aSMauro Carvalho Chehab 0xba >> 1,
2421b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END
2422b64f8e9aSMauro Carvalho Chehab };
2423b64f8e9aSMauro Carvalho Chehab
2424b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = {
2425b64f8e9aSMauro Carvalho Chehab 0x80 >> 1,
2426b64f8e9aSMauro Carvalho Chehab 0x88 >> 1,
2427b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END
2428b64f8e9aSMauro Carvalho Chehab };
2429b64f8e9aSMauro Carvalho Chehab
24300c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/
24310c0d06caSMauro Carvalho Chehab
em28xx_vdev_init(struct em28xx * dev,struct video_device * vfd,const struct video_device * template,const char * type_name)2432d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev,
2433d4352f36SHans Verkuil struct video_device *vfd,
24340c0d06caSMauro Carvalho Chehab const struct video_device *template,
24350c0d06caSMauro Carvalho Chehab const char *type_name)
24360c0d06caSMauro Carvalho Chehab {
24370c0d06caSMauro Carvalho Chehab *vfd = *template;
243895d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev;
24390c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock;
2440aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
2441d8c95c08SHans Verkuil vfd->tvnorms = 0;
24420c0d06caSMauro Carvalho Chehab
24430c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s",
244429b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name);
24450c0d06caSMauro Carvalho Chehab
24460c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev);
24470c0d06caSMauro Carvalho Chehab }
24480c0d06caSMauro Carvalho Chehab
em28xx_tuner_setup(struct em28xx * dev,unsigned short tuner_addr)24493319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr)
24500560f337SMauro Carvalho Chehab {
24513854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2;
24523854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev;
24530560f337SMauro Carvalho Chehab struct tuner_setup tun_setup;
24540560f337SMauro Carvalho Chehab struct v4l2_frequency f;
24550560f337SMauro Carvalho Chehab
24560560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup));
24570560f337SMauro Carvalho Chehab
24580560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO;
24590560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback;
24600560f337SMauro Carvalho Chehab
24610560f337SMauro Carvalho Chehab if (dev->board.radio.type) {
24620560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type;
24630560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr;
24640560f337SMauro Carvalho Chehab
246595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev,
246695d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup);
24670560f337SMauro Carvalho Chehab }
24680560f337SMauro Carvalho Chehab
2469f9fe90a4SMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT && dev->tuner_type) {
24700560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type;
24713319e6f8SFrank Schaefer tun_setup.addr = tuner_addr;
24720560f337SMauro Carvalho Chehab
247395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev,
247495d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup);
24750560f337SMauro Carvalho Chehab }
24760560f337SMauro Carvalho Chehab
24776867bd5aSFrank Schaefer if (dev->board.tda9887_conf) {
24780560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg;
24790560f337SMauro Carvalho Chehab
24800560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887;
24816867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf;
24820560f337SMauro Carvalho Chehab
248395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev,
248495d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg);
24850560f337SMauro Carvalho Chehab }
24860560f337SMauro Carvalho Chehab
24870560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) {
24880560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg;
24890560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl;
24900560f337SMauro Carvalho Chehab
24910560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg));
24920560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl));
24930560f337SMauro Carvalho Chehab
24940560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl);
24950560f337SMauro Carvalho Chehab
24960560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028;
24970560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl;
24980560f337SMauro Carvalho Chehab
249995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg);
25000560f337SMauro Carvalho Chehab }
25010560f337SMauro Carvalho Chehab
25020560f337SMauro Carvalho Chehab /* configure tuner */
25030560f337SMauro Carvalho Chehab f.tuner = 0;
25040560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV;
25050560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */
25063854b0d8SFrank Schaefer v4l2->frequency = f.frequency;
250795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f);
25080560f337SMauro Carvalho Chehab }
25090560f337SMauro Carvalho Chehab
em28xx_v4l2_init(struct em28xx * dev)251001c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev)
25110c0d06caSMauro Carvalho Chehab {
25120c0d06caSMauro Carvalho Chehab u8 val;
25130c0d06caSMauro Carvalho Chehab int ret;
25140c0d06caSMauro Carvalho Chehab unsigned int maxw;
2515abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl;
251695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2;
2517b64f8e9aSMauro Carvalho Chehab
2518822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) {
2519822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */
2520822b8deaSMauro Carvalho Chehab return 0;
2521822b8deaSMauro Carvalho Chehab }
2522822b8deaSMauro Carvalho Chehab
252301c28193SMauro Carvalho Chehab if (!dev->has_video) {
2524b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */
2525b64f8e9aSMauro Carvalho Chehab return 0;
2526b64f8e9aSMauro Carvalho Chehab }
25270c0d06caSMauro Carvalho Chehab
252829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n");
25290c0d06caSMauro Carvalho Chehab
253001c28193SMauro Carvalho Chehab mutex_lock(&dev->lock);
253101c28193SMauro Carvalho Chehab
2532f9fe90a4SMauro Carvalho Chehab v4l2 = kzalloc(sizeof(*v4l2), GFP_KERNEL);
25338314d402SMauro Carvalho Chehab if (!v4l2) {
253495d2608bSFrank Schaefer mutex_unlock(&dev->lock);
253595d2608bSFrank Schaefer return -ENOMEM;
253695d2608bSFrank Schaefer }
253795d2608bSFrank Schaefer kref_init(&v4l2->ref);
2538abc1308fSFrank Schaefer v4l2->dev = dev;
253995d2608bSFrank Schaefer dev->v4l2 = v4l2;
254095d2608bSFrank Schaefer
254137ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER
254237ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev;
254337ecc7b1SMauro Carvalho Chehab #endif
254429b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev);
2545b64f8e9aSMauro Carvalho Chehab if (ret < 0) {
254629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2547ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n");
2548b64f8e9aSMauro Carvalho Chehab goto err;
2549b64f8e9aSMauro Carvalho Chehab }
2550b64f8e9aSMauro Carvalho Chehab
2551abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler;
2552b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8);
255395d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl;
2554b64f8e9aSMauro Carvalho Chehab
2555aa62980bSMauro Carvalho Chehab if (dev->is_webcam)
25567e6c8c19SMauro Carvalho Chehab v4l2->progressive = true;
255758159171SFrank Schaefer
2558b64f8e9aSMauro Carvalho Chehab /*
2559b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats
2560b64f8e9aSMauro Carvalho Chehab */
2561a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY;
25629297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED |
2563b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE;
2564b64f8e9aSMauro Carvalho Chehab
2565b64f8e9aSMauro Carvalho Chehab /* request some modules */
2566b64f8e9aSMauro Carvalho Chehab
2567aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx)
256895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
256995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
2570b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs);
2571b64f8e9aSMauro Carvalho Chehab
2572b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X)
257395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
257495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
2575b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs);
2576b64f8e9aSMauro Carvalho Chehab
2577b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150)
257895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
257995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
2580b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs);
2581b64f8e9aSMauro Carvalho Chehab
2582b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO)
258395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
258495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
2585b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL);
2586b64f8e9aSMauro Carvalho Chehab
2587b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */
2588b64f8e9aSMauro Carvalho Chehab
2589b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) {
25903319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr;
25916867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT);
2592b64f8e9aSMauro Carvalho Chehab
2593b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type)
259495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
259595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
2596fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr,
2597fdf1bc9fSMauro Carvalho Chehab NULL);
2598b64f8e9aSMauro Carvalho Chehab
2599b64f8e9aSMauro Carvalho Chehab if (has_demod)
260095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
2601fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus],
2602fdf1bc9fSMauro Carvalho Chehab "tuner", 0,
2603fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD));
26043319e6f8SFrank Schaefer if (tuner_addr == 0) {
2605b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type =
2606b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV;
2607b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd;
2608b64f8e9aSMauro Carvalho Chehab
260995d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
2610fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus],
2611fdf1bc9fSMauro Carvalho Chehab "tuner", 0,
2612fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type));
2613b64f8e9aSMauro Carvalho Chehab
2614b64f8e9aSMauro Carvalho Chehab if (sd)
26153319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd);
2616b64f8e9aSMauro Carvalho Chehab } else {
261795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev,
261895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus],
26193319e6f8SFrank Schaefer "tuner", tuner_addr, NULL);
2620b64f8e9aSMauro Carvalho Chehab }
2621b64f8e9aSMauro Carvalho Chehab
26223319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr);
26233319e6f8SFrank Schaefer }
26243319e6f8SFrank Schaefer
2625d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR)
2626b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev);
2627b64f8e9aSMauro Carvalho Chehab
2628b64f8e9aSMauro Carvalho Chehab /* Configure audio */
2629b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev);
2630b64f8e9aSMauro Carvalho Chehab if (ret < 0) {
263129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2632ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n",
2633b64f8e9aSMauro Carvalho Chehab __func__, ret);
2634b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
2635b64f8e9aSMauro Carvalho Chehab }
2636b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) {
2637b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
2638b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
2639b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
2640b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f);
2641b64f8e9aSMauro Carvalho Chehab } else {
2642b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */
2643b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE),
2644b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev);
2645b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME),
2646b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev);
2647b64f8e9aSMauro Carvalho Chehab }
2648b64f8e9aSMauro Carvalho Chehab
2649b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */
2650b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev);
2651b64f8e9aSMauro Carvalho Chehab
2652b64f8e9aSMauro Carvalho Chehab /* init video dma queues */
2653b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active);
2654b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active);
2655b64f8e9aSMauro Carvalho Chehab
2656aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) {
2657b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */
2658b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7);
2659b64f8e9aSMauro Carvalho Chehab if (ret < 0) {
266029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2661ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n",
2662b64f8e9aSMauro Carvalho Chehab __func__, ret);
2663b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
2664b64f8e9aSMauro Carvalho Chehab }
2665f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000);
2666b64f8e9aSMauro Carvalho Chehab
2667b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff);
2668b64f8e9aSMauro Carvalho Chehab if (ret < 0) {
266929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2670ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n",
2671b64f8e9aSMauro Carvalho Chehab __func__, ret);
2672b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
2673b64f8e9aSMauro Carvalho Chehab }
2674f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000);
2675b64f8e9aSMauro Carvalho Chehab }
2676b64f8e9aSMauro Carvalho Chehab
26770c0d06caSMauro Carvalho Chehab /* set default norm */
267852faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL;
26798774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm);
268058159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT;
26810c0d06caSMauro Carvalho Chehab
26820c0d06caSMauro Carvalho Chehab /* Analog specific initialization */
268306e20672SFrank Schaefer v4l2->format = &format[0];
26840c0d06caSMauro Carvalho Chehab
26850c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev);
2686f9fe90a4SMauro Carvalho Chehab /*
2687f9fe90a4SMauro Carvalho Chehab * MaxPacketSize for em2800 is too small to capture at full resolution
2688f9fe90a4SMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50%
2689f9fe90a4SMauro Carvalho Chehab */
26900c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800)
26910c0d06caSMauro Carvalho Chehab maxw /= 2;
26920c0d06caSMauro Carvalho Chehab
26930c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc,
26940c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev));
26950c0d06caSMauro Carvalho Chehab
26960c0d06caSMauro Carvalho Chehab video_mux(dev, 0);
26970c0d06caSMauro Carvalho Chehab
26980c0d06caSMauro Carvalho Chehab /* Audio defaults */
26990c0d06caSMauro Carvalho Chehab dev->mute = 1;
27000c0d06caSMauro Carvalho Chehab dev->volume = 0x1f;
27010c0d06caSMauro Carvalho Chehab
27020c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */
27030c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK);
27040c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK,
27050c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val));
27060c0d06caSMauro Carvalho Chehab
27070c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev);
27080c0d06caSMauro Carvalho Chehab
27098f8b113aSFrank Schaefer /* Add image controls */
2710f9fe90a4SMauro Carvalho Chehab
2711f9fe90a4SMauro Carvalho Chehab /*
2712f9fe90a4SMauro Carvalho Chehab * NOTE: at this point, the subdevices are already registered, so
2713f9fe90a4SMauro Carvalho Chehab * bridge controls are only added/enabled when no subdevice provides
2714f9fe90a4SMauro Carvalho Chehab * them
2715f9fe90a4SMauro Carvalho Chehab */
2716f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST))
2717ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27188f8b113aSFrank Schaefer V4L2_CID_CONTRAST,
27198f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT);
2720f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS))
2721ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27228f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS,
27238f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT);
2724f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SATURATION))
2725ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27268f8b113aSFrank Schaefer V4L2_CID_SATURATION,
27278f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT);
2728f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE))
2729ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27308f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE,
27318f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT);
2732f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE))
2733ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27348f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE,
27358f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT);
2736f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS))
2737ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops,
27388f8b113aSFrank Schaefer V4L2_CID_SHARPNESS,
27398f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT);
27408f8b113aSFrank Schaefer
27418f8b113aSFrank Schaefer /* Reset image controls */
27428f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev);
2743ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl);
2744ad298055SFrank Schaefer ret = hdl->error;
2745b64f8e9aSMauro Carvalho Chehab if (ret)
2746b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
27478f8b113aSFrank Schaefer
27480c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */
2749d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video");
275027a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock);
275127a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock);
2752d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq;
2753d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock;
27548c3854d0SHans Verkuil v4l2->vdev.device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE |
27558c3854d0SHans Verkuil V4L2_CAP_STREAMING;
27568c3854d0SHans Verkuil if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE)
27578c3854d0SHans Verkuil v4l2->vdev.device_caps |= V4L2_CAP_AUDIO;
27588c3854d0SHans Verkuil if (dev->tuner_type != TUNER_ABSENT)
27598c3854d0SHans Verkuil v4l2->vdev.device_caps |= V4L2_CAP_TUNER;
27608c3854d0SHans Verkuil
27610c0d06caSMauro Carvalho Chehab
27626e46dabaSFrank Schaefer /* disable inapplicable ioctls */
2763aa62980bSMauro Carvalho Chehab if (dev->is_webcam) {
2764d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD);
2765d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD);
2766d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD);
27673bc85cceSFrank Schaefer } else {
2768d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM);
27696e46dabaSFrank Schaefer }
277066df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) {
2771d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER);
2772d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER);
2773d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY);
2774d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY);
277566df67b7SFrank Schaefer }
2776920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) {
2777d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO);
2778d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO);
2779c2dcef83SFrank Schaefer }
27806e46dabaSFrank Schaefer
27810c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */
27827fbbbc78SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_VIDEO,
27830c0d06caSMauro Carvalho Chehab video_nr[dev->devno]);
27840c0d06caSMauro Carvalho Chehab if (ret) {
278529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2786ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret);
2787b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
27880c0d06caSMauro Carvalho Chehab }
27890c0d06caSMauro Carvalho Chehab
27900c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */
27910c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) {
2792d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template,
27930c0d06caSMauro Carvalho Chehab "vbi");
27940c0d06caSMauro Carvalho Chehab
2795d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq;
2796d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock;
27978c3854d0SHans Verkuil v4l2->vbi_dev.device_caps = V4L2_CAP_STREAMING |
27988c3854d0SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE;
27998c3854d0SHans Verkuil if (dev->tuner_type != TUNER_ABSENT)
28008c3854d0SHans Verkuil v4l2->vbi_dev.device_caps |= V4L2_CAP_TUNER;
2801d3829fadSDevin Heitmueller
280266df67b7SFrank Schaefer /* disable inapplicable ioctls */
2803d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM);
280466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) {
2805d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER);
2806d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER);
2807d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY);
2808d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY);
280966df67b7SFrank Schaefer }
2810920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) {
2811d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO);
2812d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO);
2813c2dcef83SFrank Schaefer }
281466df67b7SFrank Schaefer
28150c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */
2816d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI,
28170c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]);
28180c0d06caSMauro Carvalho Chehab if (ret < 0) {
281929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2820ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n");
2821b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
28220c0d06caSMauro Carvalho Chehab }
28230c0d06caSMauro Carvalho Chehab }
28240c0d06caSMauro Carvalho Chehab
28250c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) {
2826d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template,
28270c0d06caSMauro Carvalho Chehab "radio");
28288c3854d0SHans Verkuil v4l2->radio_dev.device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER;
2829d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO,
28300c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]);
28310c0d06caSMauro Carvalho Chehab if (ret < 0) {
283229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2833ce8591ffSMauro Carvalho Chehab "can't register radio device\n");
2834b64f8e9aSMauro Carvalho Chehab goto unregister_dev;
28350c0d06caSMauro Carvalho Chehab }
283629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2837ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n",
2838d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev));
28390c0d06caSMauro Carvalho Chehab }
28400c0d06caSMauro Carvalho Chehab
284137ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */
284237ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev);
284337ecc7b1SMauro Carvalho Chehab
28440d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER
2845de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev);
284637ecc7b1SMauro Carvalho Chehab if (ret) {
284729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev,
2848ce8591ffSMauro Carvalho Chehab "failed to create media graph\n");
284937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev);
285037ecc7b1SMauro Carvalho Chehab goto unregister_dev;
285137ecc7b1SMauro Carvalho Chehab }
28520d37ba62SArnd Bergmann #endif
285337ecc7b1SMauro Carvalho Chehab
285429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2855ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n",
2856d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev));
28570c0d06caSMauro Carvalho Chehab
2858d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev))
285929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2860ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n",
2861d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev));
28620c0d06caSMauro Carvalho Chehab
2863b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */
28643aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby);
2865b64f8e9aSMauro Carvalho Chehab
2866b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */
2867b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev);
2868b64f8e9aSMauro Carvalho Chehab
286929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2870ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n");
28719634614fSMauro Carvalho Chehab
287247677e51SMauro Carvalho Chehab kref_get(&dev->ref);
287347677e51SMauro Carvalho Chehab
287401c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock);
28750c0d06caSMauro Carvalho Chehab return 0;
2876b64f8e9aSMauro Carvalho Chehab
2877b64f8e9aSMauro Carvalho Chehab unregister_dev:
287856a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) {
287929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2880ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n",
288156a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev));
288256a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev);
288356a7f515SMauro Carvalho Chehab }
288456a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) {
288529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2886ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n",
288756a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev));
288856a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev);
288956a7f515SMauro Carvalho Chehab }
289056a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) {
289129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev,
2892ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n",
289356a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev));
289456a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev);
289556a7f515SMauro Carvalho Chehab }
289656a7f515SMauro Carvalho Chehab
2897abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler);
289895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev);
2899b64f8e9aSMauro Carvalho Chehab err:
290095d2608bSFrank Schaefer dev->v4l2 = NULL;
290195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2);
290201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock);
2903b64f8e9aSMauro Carvalho Chehab return ret;
29040c0d06caSMauro Carvalho Chehab }
290501c28193SMauro Carvalho Chehab
290601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = {
290701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2,
290801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension",
290901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init,
291001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini,
2911a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend,
2912a61f6811SShuah Khan .resume = em28xx_v4l2_resume,
291301c28193SMauro Carvalho Chehab };
291401c28193SMauro Carvalho Chehab
em28xx_video_register(void)291501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void)
291601c28193SMauro Carvalho Chehab {
291701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops);
291801c28193SMauro Carvalho Chehab }
291901c28193SMauro Carvalho Chehab
em28xx_video_unregister(void)292001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void)
292101c28193SMauro Carvalho Chehab {
292201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops);
292301c28193SMauro Carvalho Chehab }
292401c28193SMauro Carvalho Chehab
292501c28193SMauro Carvalho Chehab module_init(em28xx_video_register);
292601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister);
2927