10c0d06caSMauro Carvalho Chehab /* 20c0d06caSMauro Carvalho Chehab em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB 30c0d06caSMauro Carvalho Chehab video capture devices 40c0d06caSMauro Carvalho Chehab 50c0d06caSMauro Carvalho Chehab Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> 60c0d06caSMauro Carvalho Chehab Markus Rechberger <mrechberger@gmail.com> 70c0d06caSMauro Carvalho Chehab Mauro Carvalho Chehab <mchehab@infradead.org> 80c0d06caSMauro Carvalho Chehab Sascha Sommer <saschasommer@freenet.de> 90fa4a402SFrank Schaefer Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com> 100c0d06caSMauro Carvalho Chehab 110c0d06caSMauro Carvalho Chehab Some parts based on SN9C10x PC Camera Controllers GPL driver made 120c0d06caSMauro Carvalho Chehab by Luca Risolia <luca.risolia@studio.unibo.it> 130c0d06caSMauro Carvalho Chehab 140c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 150c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 160c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 170c0d06caSMauro Carvalho Chehab (at your option) any later version. 180c0d06caSMauro Carvalho Chehab 190c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 200c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 210c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 220c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 230c0d06caSMauro Carvalho Chehab 240c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 250c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 260c0d06caSMauro Carvalho Chehab Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 270c0d06caSMauro Carvalho Chehab */ 280c0d06caSMauro Carvalho Chehab 290c0d06caSMauro Carvalho Chehab #include <linux/init.h> 300c0d06caSMauro Carvalho Chehab #include <linux/list.h> 310c0d06caSMauro Carvalho Chehab #include <linux/module.h> 320c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 330c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 340c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 350c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 360c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 370c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 380c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 390c0d06caSMauro Carvalho Chehab 400c0d06caSMauro Carvalho Chehab #include "em28xx.h" 410c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 430c0d06caSMauro Carvalho Chehab #include <media/v4l2-chip-ident.h> 440c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 450c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 460c0d06caSMauro Carvalho Chehab 470c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 480c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 490c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 500c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 510c0d06caSMauro Carvalho Chehab 520c0d06caSMauro Carvalho Chehab #define DRIVER_DESC "Empia em28xx based USB video device driver" 530c0d06caSMauro Carvalho Chehab 540c0d06caSMauro Carvalho Chehab #define EM28XX_VERSION "0.1.3" 550c0d06caSMauro Carvalho Chehab 560c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 570c0d06caSMauro Carvalho Chehab if (video_debug) \ 580c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 590c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 600c0d06caSMauro Carvalho Chehab 610c0d06caSMauro Carvalho Chehab static unsigned int isoc_debug; 620c0d06caSMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 630c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 640c0d06caSMauro Carvalho Chehab 650c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 660c0d06caSMauro Carvalho Chehab do {\ 670c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 680c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 690c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 700c0d06caSMauro Carvalho Chehab } \ 710c0d06caSMauro Carvalho Chehab } while (0) 720c0d06caSMauro Carvalho Chehab 730c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 740c0d06caSMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC); 750c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 760c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 770c0d06caSMauro Carvalho Chehab 780c0d06caSMauro Carvalho Chehab static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 790c0d06caSMauro Carvalho Chehab static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 800c0d06caSMauro Carvalho Chehab static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 810c0d06caSMauro Carvalho Chehab 820c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 830c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 840c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 850c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 860c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 870c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 880c0d06caSMauro Carvalho Chehab 890c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 900c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 910c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 920c0d06caSMauro Carvalho Chehab 930c0d06caSMauro Carvalho Chehab /* supported video standards */ 940c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 950c0d06caSMauro Carvalho Chehab { 960c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 970c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 980c0d06caSMauro Carvalho Chehab .depth = 16, 990c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1000c0d06caSMauro Carvalho Chehab }, { 1010c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1020c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1030c0d06caSMauro Carvalho Chehab .depth = 16, 1040c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1050c0d06caSMauro Carvalho Chehab }, { 1060c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 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 .name = "8 bpp Bayer GRGR..BGBG", 1120c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1130c0d06caSMauro Carvalho Chehab .depth = 8, 1140c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1150c0d06caSMauro Carvalho Chehab }, { 1160c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1170c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1180c0d06caSMauro Carvalho Chehab .depth = 8, 1190c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1200c0d06caSMauro Carvalho Chehab }, { 1210c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1220c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1230c0d06caSMauro Carvalho Chehab .depth = 12, 1240c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1250c0d06caSMauro Carvalho Chehab }, 1260c0d06caSMauro Carvalho Chehab }; 1270c0d06caSMauro Carvalho Chehab 1280c0d06caSMauro Carvalho Chehab /* supported controls */ 1290c0d06caSMauro Carvalho Chehab /* Common to all boards */ 1300c0d06caSMauro Carvalho Chehab static struct v4l2_queryctrl ac97_qctrl[] = { 1310c0d06caSMauro Carvalho Chehab { 1320c0d06caSMauro Carvalho Chehab .id = V4L2_CID_AUDIO_VOLUME, 1330c0d06caSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 1340c0d06caSMauro Carvalho Chehab .name = "Volume", 1350c0d06caSMauro Carvalho Chehab .minimum = 0x0, 1360c0d06caSMauro Carvalho Chehab .maximum = 0x1f, 1370c0d06caSMauro Carvalho Chehab .step = 0x1, 1380c0d06caSMauro Carvalho Chehab .default_value = 0x1f, 1390c0d06caSMauro Carvalho Chehab .flags = V4L2_CTRL_FLAG_SLIDER, 1400c0d06caSMauro Carvalho Chehab }, { 1410c0d06caSMauro Carvalho Chehab .id = V4L2_CID_AUDIO_MUTE, 1420c0d06caSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 1430c0d06caSMauro Carvalho Chehab .name = "Mute", 1440c0d06caSMauro Carvalho Chehab .minimum = 0, 1450c0d06caSMauro Carvalho Chehab .maximum = 1, 1460c0d06caSMauro Carvalho Chehab .step = 1, 1470c0d06caSMauro Carvalho Chehab .default_value = 1, 1480c0d06caSMauro Carvalho Chehab .flags = 0, 1490c0d06caSMauro Carvalho Chehab } 1500c0d06caSMauro Carvalho Chehab }; 1510c0d06caSMauro Carvalho Chehab 1520c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1530c0d06caSMauro Carvalho Chehab DMA and thread functions 1540c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 1550c0d06caSMauro Carvalho Chehab 1560c0d06caSMauro Carvalho Chehab /* 157948a49aaSFrank Schaefer * Finish the current buffer 1580c0d06caSMauro Carvalho Chehab */ 159948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 1600c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 1610c0d06caSMauro Carvalho Chehab { 1620c0d06caSMauro Carvalho Chehab em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->vb.i); 1630c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_DONE; 1640c0d06caSMauro Carvalho Chehab buf->vb.field_count++; 1658e6057b5SSakari Ailus v4l2_get_timestamp(&buf->vb.ts); 1660c0d06caSMauro Carvalho Chehab list_del(&buf->vb.queue); 1670c0d06caSMauro Carvalho Chehab wake_up(&buf->vb.done); 1680c0d06caSMauro Carvalho Chehab } 1690c0d06caSMauro Carvalho Chehab 1700c0d06caSMauro Carvalho Chehab /* 17136016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 1720c0d06caSMauro Carvalho Chehab */ 1730c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 1740c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 17536016a35SFrank Schaefer unsigned char *usb_buf, 1764078d625SFrank Schaefer unsigned long len) 1770c0d06caSMauro Carvalho Chehab { 1780c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 1790c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 1800c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 1810c0d06caSMauro Carvalho Chehab 1828732533bSFrank Schaefer if (buf->pos + len > buf->vb.size) 1838732533bSFrank Schaefer len = buf->vb.size - buf->pos; 1840c0d06caSMauro Carvalho Chehab 18536016a35SFrank Schaefer startread = usb_buf; 1860c0d06caSMauro Carvalho Chehab remain = len; 1870c0d06caSMauro Carvalho Chehab 188c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 18936016a35SFrank Schaefer fieldstart = buf->vb_buf; 190c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 19136016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 1920c0d06caSMauro Carvalho Chehab 1938732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 1948732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 1950c0d06caSMauro Carvalho Chehab 1960c0d06caSMauro Carvalho Chehab if (dev->progressive) 1970c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 1980c0d06caSMauro Carvalho Chehab else 1990c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 2000c0d06caSMauro Carvalho Chehab 2010c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 2020c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 2030c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 2040c0d06caSMauro Carvalho Chehab 20536016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->vb.size) { 2060c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 2070c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 20836016a35SFrank Schaefer ((char *)buf->vb_buf + buf->vb.size)); 20936016a35SFrank Schaefer remain = (char *)buf->vb_buf + buf->vb.size - 21036016a35SFrank Schaefer (char *)startwrite; 2110c0d06caSMauro Carvalho Chehab lencopy = remain; 2120c0d06caSMauro Carvalho Chehab } 2130c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2140c0d06caSMauro Carvalho Chehab return; 2150c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2160c0d06caSMauro Carvalho Chehab 2170c0d06caSMauro Carvalho Chehab remain -= lencopy; 2180c0d06caSMauro Carvalho Chehab 2190c0d06caSMauro Carvalho Chehab while (remain > 0) { 220c02ec71bSFrank Schaefer if (dev->progressive) 221c02ec71bSFrank Schaefer startwrite += lencopy; 222c02ec71bSFrank Schaefer else 2230c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 2240c0d06caSMauro Carvalho Chehab startread += lencopy; 2250c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 2260c0d06caSMauro Carvalho Chehab lencopy = remain; 2270c0d06caSMauro Carvalho Chehab else 2280c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 2290c0d06caSMauro Carvalho Chehab 23036016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 2310c0d06caSMauro Carvalho Chehab buf->vb.size) { 2320c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 2330c0d06caSMauro Carvalho Chehab "(2)\n", 2340c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 23536016a35SFrank Schaefer ((char *)buf->vb_buf + buf->vb.size)); 23636016a35SFrank Schaefer lencopy = remain = (char *)buf->vb_buf + buf->vb.size - 2370c0d06caSMauro Carvalho Chehab (char *)startwrite; 2380c0d06caSMauro Carvalho Chehab } 2390c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2400c0d06caSMauro Carvalho Chehab break; 2410c0d06caSMauro Carvalho Chehab 2420c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2430c0d06caSMauro Carvalho Chehab 2440c0d06caSMauro Carvalho Chehab remain -= lencopy; 2450c0d06caSMauro Carvalho Chehab } 2460c0d06caSMauro Carvalho Chehab 2478732533bSFrank Schaefer buf->pos += len; 2480c0d06caSMauro Carvalho Chehab } 2490c0d06caSMauro Carvalho Chehab 25036016a35SFrank Schaefer /* 25136016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 25236016a35SFrank Schaefer */ 2530c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 2540c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 25536016a35SFrank Schaefer unsigned char *usb_buf, 2564078d625SFrank Schaefer unsigned long len) 2570c0d06caSMauro Carvalho Chehab { 25836016a35SFrank Schaefer unsigned int offset; 2590c0d06caSMauro Carvalho Chehab 2608732533bSFrank Schaefer if (buf->pos + len > buf->vb.size) 2618732533bSFrank Schaefer len = buf->vb.size - buf->pos; 2620c0d06caSMauro Carvalho Chehab 2638732533bSFrank Schaefer offset = buf->pos; 2640c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 26536016a35SFrank Schaefer if (buf->top_field == 0) 26636016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 2670c0d06caSMauro Carvalho Chehab 26836016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 2698732533bSFrank Schaefer buf->pos += len; 2700c0d06caSMauro Carvalho Chehab } 2710c0d06caSMauro Carvalho Chehab 2720c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 2730c0d06caSMauro Carvalho Chehab int packet, int status) 2740c0d06caSMauro Carvalho Chehab { 2750c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 2760c0d06caSMauro Carvalho Chehab 2770c0d06caSMauro Carvalho Chehab switch (status) { 2780c0d06caSMauro Carvalho Chehab case -ENOENT: 2790c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 2800c0d06caSMauro Carvalho Chehab break; 2810c0d06caSMauro Carvalho Chehab case -ECONNRESET: 2820c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 2830c0d06caSMauro Carvalho Chehab break; 2840c0d06caSMauro Carvalho Chehab case -ENOSR: 2850c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 2860c0d06caSMauro Carvalho Chehab break; 2870c0d06caSMauro Carvalho Chehab case -EPIPE: 2880c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 2890c0d06caSMauro Carvalho Chehab break; 2900c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 2910c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 2920c0d06caSMauro Carvalho Chehab break; 2930c0d06caSMauro Carvalho Chehab case -EPROTO: 2940c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 2950c0d06caSMauro Carvalho Chehab break; 2960c0d06caSMauro Carvalho Chehab case -EILSEQ: 2970c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 2980c0d06caSMauro Carvalho Chehab break; 2990c0d06caSMauro Carvalho Chehab case -ETIME: 3000c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 3010c0d06caSMauro Carvalho Chehab break; 3020c0d06caSMauro Carvalho Chehab } 3030c0d06caSMauro Carvalho Chehab if (packet < 0) { 3040c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 3050c0d06caSMauro Carvalho Chehab } else { 3060c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 3070c0d06caSMauro Carvalho Chehab packet, status, errmsg); 3080c0d06caSMauro Carvalho Chehab } 3090c0d06caSMauro Carvalho Chehab } 3100c0d06caSMauro Carvalho Chehab 3110c0d06caSMauro Carvalho Chehab /* 31224a6d849SFrank Schaefer * get the next available buffer from dma queue 3130c0d06caSMauro Carvalho Chehab */ 31424a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 31524a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 3160c0d06caSMauro Carvalho Chehab { 31724a6d849SFrank Schaefer struct em28xx_buffer *buf; 3180c0d06caSMauro Carvalho Chehab char *outp; 3190c0d06caSMauro Carvalho Chehab 3200c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 3210c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 32224a6d849SFrank Schaefer return NULL; 3230c0d06caSMauro Carvalho Chehab } 3240c0d06caSMauro Carvalho Chehab 3250c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 32624a6d849SFrank Schaefer buf = list_entry(dma_q->active.next, struct em28xx_buffer, vb.queue); 3270c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 32824a6d849SFrank Schaefer outp = videobuf_to_vmalloc(&buf->vb); 32924a6d849SFrank Schaefer memset(outp, 0, buf->vb.size); 3308732533bSFrank Schaefer buf->pos = 0; 3314078d625SFrank Schaefer buf->vb_buf = outp; 3320c0d06caSMauro Carvalho Chehab 33324a6d849SFrank Schaefer return buf; 3340c0d06caSMauro Carvalho Chehab } 3350c0d06caSMauro Carvalho Chehab 336e04c00d9SFrank Schaefer /* 337e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 338e04c00d9SFrank Schaefer */ 339e04c00d9SFrank Schaefer static struct em28xx_buffer * 340e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 341e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 342e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 343e04c00d9SFrank Schaefer { 344e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 345e04c00d9SFrank Schaefer if (buf != NULL) 346e04c00d9SFrank Schaefer finish_buffer(dev, buf); 347e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 348e04c00d9SFrank Schaefer } 349e04c00d9SFrank Schaefer if (buf != NULL) { 350e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 351e04c00d9SFrank Schaefer buf->pos = 0; 352e04c00d9SFrank Schaefer } 353e04c00d9SFrank Schaefer 354e04c00d9SFrank Schaefer return buf; 355e04c00d9SFrank Schaefer } 356e04c00d9SFrank Schaefer 357227b7c90SFrank Schaefer /* 358227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 359227b7c90SFrank Schaefer */ 360227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 361227b7c90SFrank Schaefer unsigned char *data_pkt, 362227b7c90SFrank Schaefer unsigned int data_len) 363227b7c90SFrank Schaefer { 364227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 365227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 366227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 367227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 368227b7c90SFrank Schaefer 369227b7c90SFrank Schaefer /* capture type 0 = vbi start 370227b7c90SFrank Schaefer capture type 1 = vbi in progress 371227b7c90SFrank Schaefer capture type 2 = video start 372227b7c90SFrank Schaefer capture type 3 = video in progress */ 373227b7c90SFrank Schaefer if (data_len >= 4) { 374227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 375227b7c90SFrank Schaefer * never split across packets */ 376227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 377227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 378227b7c90SFrank Schaefer /* Continuation */ 379227b7c90SFrank Schaefer data_pkt += 4; 380227b7c90SFrank Schaefer data_len -= 4; 381227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 382227b7c90SFrank Schaefer /* Field start (VBI mode) */ 383227b7c90SFrank Schaefer dev->capture_type = 0; 384227b7c90SFrank Schaefer dev->vbi_read = 0; 385227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 386227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 387227b7c90SFrank Schaefer data_pkt += 4; 388227b7c90SFrank Schaefer data_len -= 4; 389227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 390227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 391227b7c90SFrank Schaefer dev->capture_type = 2; 392227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 393227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 394227b7c90SFrank Schaefer data_pkt += 4; 395227b7c90SFrank Schaefer data_len -= 4; 396227b7c90SFrank Schaefer } 397227b7c90SFrank Schaefer } 398227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 399227b7c90SFrank Schaefer * have no continuation header */ 400227b7c90SFrank Schaefer 401227b7c90SFrank Schaefer if (dev->capture_type == 0) { 402227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 403227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 404227b7c90SFrank Schaefer dev->capture_type = 1; 405227b7c90SFrank Schaefer } 406227b7c90SFrank Schaefer 407227b7c90SFrank Schaefer if (dev->capture_type == 1) { 408227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 409227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 410227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 411227b7c90SFrank Schaefer 412227b7c90SFrank Schaefer /* Copy VBI data */ 413227b7c90SFrank Schaefer if (vbi_buf != NULL) 414227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 415227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 416227b7c90SFrank Schaefer 417227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 418227b7c90SFrank Schaefer /* Continue with copying video data */ 419227b7c90SFrank Schaefer dev->capture_type = 2; 420227b7c90SFrank Schaefer data_pkt += vbi_data_len; 421227b7c90SFrank Schaefer data_len -= vbi_data_len; 422227b7c90SFrank Schaefer } 423227b7c90SFrank Schaefer } 424227b7c90SFrank Schaefer 425227b7c90SFrank Schaefer if (dev->capture_type == 2) { 426227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 427227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 428227b7c90SFrank Schaefer dev->capture_type = 3; 429227b7c90SFrank Schaefer } 430227b7c90SFrank Schaefer 431227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 432227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 433227b7c90SFrank Schaefer } 434227b7c90SFrank Schaefer 435960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 4360fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 4370c0d06caSMauro Carvalho Chehab { 438227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 439227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 440227b7c90SFrank Schaefer unsigned int usb_data_len; 4410c0d06caSMauro Carvalho Chehab 4420c0d06caSMauro Carvalho Chehab if (!dev) 4430c0d06caSMauro Carvalho Chehab return 0; 4440c0d06caSMauro Carvalho Chehab 4450c0d06caSMauro Carvalho Chehab if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED)) 4460c0d06caSMauro Carvalho Chehab return 0; 4470c0d06caSMauro Carvalho Chehab 4481653cb0cSFrank Schaefer if (urb->status < 0) 4490c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 4500c0d06caSMauro Carvalho Chehab 4514601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 4524601cc39SFrank Schaefer 4534601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 4544601cc39SFrank Schaefer num_packets = 1; 4554601cc39SFrank Schaefer else /* isoc */ 4564601cc39SFrank Schaefer num_packets = urb->number_of_packets; 4570c0d06caSMauro Carvalho Chehab 4584601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 4594601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 460227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 4614601cc39SFrank Schaefer 462227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 4634601cc39SFrank Schaefer } else { /* isoc */ 4644601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 4654601cc39SFrank Schaefer print_err_status(dev, i, 4664601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 4670c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 4680c0d06caSMauro Carvalho Chehab continue; 4690c0d06caSMauro Carvalho Chehab } 4700c0d06caSMauro Carvalho Chehab 471227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 472227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 4730c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 4740c0d06caSMauro Carvalho Chehab continue; 4750c0d06caSMauro Carvalho Chehab } 4760c0d06caSMauro Carvalho Chehab 477227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 4784601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 4794601cc39SFrank Schaefer } 4804601cc39SFrank Schaefer 481227b7c90SFrank Schaefer if (usb_data_len == 0) { 4824601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 4834601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 4844601cc39SFrank Schaefer continue; 4854601cc39SFrank Schaefer } 4860c0d06caSMauro Carvalho Chehab 487227b7c90SFrank Schaefer process_frame_data_em28xx(dev, usb_data_pkt, usb_data_len); 4880c0d06caSMauro Carvalho Chehab } 489227b7c90SFrank Schaefer return 1; 4900c0d06caSMauro Carvalho Chehab } 4910c0d06caSMauro Carvalho Chehab 4920c0d06caSMauro Carvalho Chehab 4930c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4940c0d06caSMauro Carvalho Chehab Videobuf operations 4950c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4960c0d06caSMauro Carvalho Chehab 4970c0d06caSMauro Carvalho Chehab static int 4980c0d06caSMauro Carvalho Chehab buffer_setup(struct videobuf_queue *vq, unsigned int *count, unsigned int *size) 4990c0d06caSMauro Carvalho Chehab { 5000c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5010c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5020c0d06caSMauro Carvalho Chehab struct v4l2_frequency f; 5030c0d06caSMauro Carvalho Chehab 5040c0d06caSMauro Carvalho Chehab *size = (fh->dev->width * fh->dev->height * dev->format->depth + 7) 5050c0d06caSMauro Carvalho Chehab >> 3; 5060c0d06caSMauro Carvalho Chehab 5070c0d06caSMauro Carvalho Chehab if (0 == *count) 5080c0d06caSMauro Carvalho Chehab *count = EM28XX_DEF_BUF; 5090c0d06caSMauro Carvalho Chehab 5100c0d06caSMauro Carvalho Chehab if (*count < EM28XX_MIN_BUF) 5110c0d06caSMauro Carvalho Chehab *count = EM28XX_MIN_BUF; 5120c0d06caSMauro Carvalho Chehab 5130c0d06caSMauro Carvalho Chehab /* Ask tuner to go to analog or radio mode */ 5140c0d06caSMauro Carvalho Chehab memset(&f, 0, sizeof(f)); 5150c0d06caSMauro Carvalho Chehab f.frequency = dev->ctl_freq; 5160c0d06caSMauro Carvalho Chehab f.type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; 5170c0d06caSMauro Carvalho Chehab 5180c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 5190c0d06caSMauro Carvalho Chehab 5200c0d06caSMauro Carvalho Chehab return 0; 5210c0d06caSMauro Carvalho Chehab } 5220c0d06caSMauro Carvalho Chehab 5230c0d06caSMauro Carvalho Chehab /* This is called *without* dev->slock held; please keep it that way */ 5240c0d06caSMauro Carvalho Chehab static void free_buffer(struct videobuf_queue *vq, struct em28xx_buffer *buf) 5250c0d06caSMauro Carvalho Chehab { 5260c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5270c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5280c0d06caSMauro Carvalho Chehab unsigned long flags = 0; 5290c0d06caSMauro Carvalho Chehab if (in_interrupt()) 5300c0d06caSMauro Carvalho Chehab BUG(); 5310c0d06caSMauro Carvalho Chehab 5320c0d06caSMauro Carvalho Chehab /* We used to wait for the buffer to finish here, but this didn't work 5330c0d06caSMauro Carvalho Chehab because, as we were keeping the state as VIDEOBUF_QUEUED, 5340c0d06caSMauro Carvalho Chehab videobuf_queue_cancel marked it as finished for us. 5350c0d06caSMauro Carvalho Chehab (Also, it could wedge forever if the hardware was misconfigured.) 5360c0d06caSMauro Carvalho Chehab 5370c0d06caSMauro Carvalho Chehab This should be safe; by the time we get here, the buffer isn't 5380c0d06caSMauro Carvalho Chehab queued anymore. If we ever start marking the buffers as 5390c0d06caSMauro Carvalho Chehab VIDEOBUF_ACTIVE, it won't be, though. 5400c0d06caSMauro Carvalho Chehab */ 5410c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&dev->slock, flags); 54274209dc0SFrank Schaefer if (dev->usb_ctl.vid_buf == buf) 54374209dc0SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 5440c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&dev->slock, flags); 5450c0d06caSMauro Carvalho Chehab 5460c0d06caSMauro Carvalho Chehab videobuf_vmalloc_free(&buf->vb); 5470c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_NEEDS_INIT; 5480c0d06caSMauro Carvalho Chehab } 5490c0d06caSMauro Carvalho Chehab 5500c0d06caSMauro Carvalho Chehab static int 5510c0d06caSMauro Carvalho Chehab buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb, 5520c0d06caSMauro Carvalho Chehab enum v4l2_field field) 5530c0d06caSMauro Carvalho Chehab { 5540c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5550c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 5560c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5570c0d06caSMauro Carvalho Chehab int rc = 0, urb_init = 0; 5580c0d06caSMauro Carvalho Chehab 5590c0d06caSMauro Carvalho Chehab buf->vb.size = (fh->dev->width * fh->dev->height * dev->format->depth 5600c0d06caSMauro Carvalho Chehab + 7) >> 3; 5610c0d06caSMauro Carvalho Chehab 5620c0d06caSMauro Carvalho Chehab if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size) 5630c0d06caSMauro Carvalho Chehab return -EINVAL; 5640c0d06caSMauro Carvalho Chehab 5650c0d06caSMauro Carvalho Chehab buf->vb.width = dev->width; 5660c0d06caSMauro Carvalho Chehab buf->vb.height = dev->height; 5670c0d06caSMauro Carvalho Chehab buf->vb.field = field; 5680c0d06caSMauro Carvalho Chehab 5690c0d06caSMauro Carvalho Chehab if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { 5700c0d06caSMauro Carvalho Chehab rc = videobuf_iolock(vq, &buf->vb, NULL); 5710c0d06caSMauro Carvalho Chehab if (rc < 0) 5720c0d06caSMauro Carvalho Chehab goto fail; 5730c0d06caSMauro Carvalho Chehab } 5740c0d06caSMauro Carvalho Chehab 57574209dc0SFrank Schaefer if (!dev->usb_ctl.analog_bufs.num_bufs) 5760c0d06caSMauro Carvalho Chehab urb_init = 1; 5770c0d06caSMauro Carvalho Chehab 5780c0d06caSMauro Carvalho Chehab if (urb_init) { 5790455eebfSFrank Schaefer dev->capture_type = -1; 580c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 581c647a91aSFrank Schaefer dev->analog_xfer_bulk, 5820c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 5830c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 584c647a91aSFrank Schaefer dev->packet_multiplier, 5850fa4a402SFrank Schaefer em28xx_urb_data_copy); 5860c0d06caSMauro Carvalho Chehab if (rc < 0) 5870c0d06caSMauro Carvalho Chehab goto fail; 5880c0d06caSMauro Carvalho Chehab } 5890c0d06caSMauro Carvalho Chehab 5900c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_PREPARED; 5910c0d06caSMauro Carvalho Chehab return 0; 5920c0d06caSMauro Carvalho Chehab 5930c0d06caSMauro Carvalho Chehab fail: 5940c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 5950c0d06caSMauro Carvalho Chehab return rc; 5960c0d06caSMauro Carvalho Chehab } 5970c0d06caSMauro Carvalho Chehab 5980c0d06caSMauro Carvalho Chehab static void 5990c0d06caSMauro Carvalho Chehab buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb) 6000c0d06caSMauro Carvalho Chehab { 6010c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 6020c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 6030c0d06caSMauro Carvalho Chehab vb); 6040c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 6050c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 6060c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 6070c0d06caSMauro Carvalho Chehab 6080c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_QUEUED; 6090c0d06caSMauro Carvalho Chehab list_add_tail(&buf->vb.queue, &vidq->active); 6100c0d06caSMauro Carvalho Chehab 6110c0d06caSMauro Carvalho Chehab } 6120c0d06caSMauro Carvalho Chehab 6130c0d06caSMauro Carvalho Chehab static void buffer_release(struct videobuf_queue *vq, 6140c0d06caSMauro Carvalho Chehab struct videobuf_buffer *vb) 6150c0d06caSMauro Carvalho Chehab { 6160c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 6170c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 6180c0d06caSMauro Carvalho Chehab vb); 6190c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 6200c0d06caSMauro Carvalho Chehab struct em28xx *dev = (struct em28xx *)fh->dev; 6210c0d06caSMauro Carvalho Chehab 6220c0d06caSMauro Carvalho Chehab em28xx_isocdbg("em28xx: called buffer_release\n"); 6230c0d06caSMauro Carvalho Chehab 6240c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 6250c0d06caSMauro Carvalho Chehab } 6260c0d06caSMauro Carvalho Chehab 6270c0d06caSMauro Carvalho Chehab static struct videobuf_queue_ops em28xx_video_qops = { 6280c0d06caSMauro Carvalho Chehab .buf_setup = buffer_setup, 6290c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 6300c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 6310c0d06caSMauro Carvalho Chehab .buf_release = buffer_release, 6320c0d06caSMauro Carvalho Chehab }; 6330c0d06caSMauro Carvalho Chehab 6340c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 6350c0d06caSMauro Carvalho Chehab 6360c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 6370c0d06caSMauro Carvalho Chehab { 6380c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 6390c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 6400c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 6410c0d06caSMauro Carvalho Chehab 6420c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 6430c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 6440c0d06caSMauro Carvalho Chehab 6450c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 6460c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 6470c0d06caSMauro Carvalho Chehab 6480c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 6490c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 6500c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 6510c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 6520c0d06caSMauro Carvalho Chehab } 6530c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 6540c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 6550c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 6560c0d06caSMauro Carvalho Chehab } 6570c0d06caSMauro Carvalho Chehab 6580c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 6590c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 6600c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 6610c0d06caSMauro Carvalho Chehab } 6620c0d06caSMauro Carvalho Chehab 6630c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 6640c0d06caSMauro Carvalho Chehab } 6650c0d06caSMauro Carvalho Chehab 6660c0d06caSMauro Carvalho Chehab /* Usage lock check functions */ 6670c0d06caSMauro Carvalho Chehab static int res_get(struct em28xx_fh *fh, unsigned int bit) 6680c0d06caSMauro Carvalho Chehab { 6690c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 6700c0d06caSMauro Carvalho Chehab 6710c0d06caSMauro Carvalho Chehab if (fh->resources & bit) 6720c0d06caSMauro Carvalho Chehab /* have it already allocated */ 6730c0d06caSMauro Carvalho Chehab return 1; 6740c0d06caSMauro Carvalho Chehab 6750c0d06caSMauro Carvalho Chehab /* is it free? */ 6760c0d06caSMauro Carvalho Chehab if (dev->resources & bit) { 6770c0d06caSMauro Carvalho Chehab /* no, someone else uses it */ 6780c0d06caSMauro Carvalho Chehab return 0; 6790c0d06caSMauro Carvalho Chehab } 6800c0d06caSMauro Carvalho Chehab /* it's free, grab it */ 6810c0d06caSMauro Carvalho Chehab fh->resources |= bit; 6820c0d06caSMauro Carvalho Chehab dev->resources |= bit; 6830c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: get %d\n", bit); 6840c0d06caSMauro Carvalho Chehab return 1; 6850c0d06caSMauro Carvalho Chehab } 6860c0d06caSMauro Carvalho Chehab 6870c0d06caSMauro Carvalho Chehab static int res_check(struct em28xx_fh *fh, unsigned int bit) 6880c0d06caSMauro Carvalho Chehab { 6890c0d06caSMauro Carvalho Chehab return fh->resources & bit; 6900c0d06caSMauro Carvalho Chehab } 6910c0d06caSMauro Carvalho Chehab 6920c0d06caSMauro Carvalho Chehab static int res_locked(struct em28xx *dev, unsigned int bit) 6930c0d06caSMauro Carvalho Chehab { 6940c0d06caSMauro Carvalho Chehab return dev->resources & bit; 6950c0d06caSMauro Carvalho Chehab } 6960c0d06caSMauro Carvalho Chehab 6970c0d06caSMauro Carvalho Chehab static void res_free(struct em28xx_fh *fh, unsigned int bits) 6980c0d06caSMauro Carvalho Chehab { 6990c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 7000c0d06caSMauro Carvalho Chehab 7010c0d06caSMauro Carvalho Chehab BUG_ON((fh->resources & bits) != bits); 7020c0d06caSMauro Carvalho Chehab 7030c0d06caSMauro Carvalho Chehab fh->resources &= ~bits; 7040c0d06caSMauro Carvalho Chehab dev->resources &= ~bits; 7050c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: put %d\n", bits); 7060c0d06caSMauro Carvalho Chehab } 7070c0d06caSMauro Carvalho Chehab 7080c0d06caSMauro Carvalho Chehab static int get_ressource(struct em28xx_fh *fh) 7090c0d06caSMauro Carvalho Chehab { 7100c0d06caSMauro Carvalho Chehab switch (fh->type) { 7110c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VIDEO_CAPTURE: 7120c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VIDEO; 7130c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VBI_CAPTURE: 7140c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VBI; 7150c0d06caSMauro Carvalho Chehab default: 7160c0d06caSMauro Carvalho Chehab BUG(); 7170c0d06caSMauro Carvalho Chehab return 0; 7180c0d06caSMauro Carvalho Chehab } 7190c0d06caSMauro Carvalho Chehab } 7200c0d06caSMauro Carvalho Chehab 7210c0d06caSMauro Carvalho Chehab /* 7220c0d06caSMauro Carvalho Chehab * ac97_queryctrl() 7230c0d06caSMauro Carvalho Chehab * return the ac97 supported controls 7240c0d06caSMauro Carvalho Chehab */ 7250c0d06caSMauro Carvalho Chehab static int ac97_queryctrl(struct v4l2_queryctrl *qc) 7260c0d06caSMauro Carvalho Chehab { 7270c0d06caSMauro Carvalho Chehab int i; 7280c0d06caSMauro Carvalho Chehab 7290c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) { 7300c0d06caSMauro Carvalho Chehab if (qc->id && qc->id == ac97_qctrl[i].id) { 7310c0d06caSMauro Carvalho Chehab memcpy(qc, &(ac97_qctrl[i]), sizeof(*qc)); 7320c0d06caSMauro Carvalho Chehab return 0; 7330c0d06caSMauro Carvalho Chehab } 7340c0d06caSMauro Carvalho Chehab } 7350c0d06caSMauro Carvalho Chehab 7360c0d06caSMauro Carvalho Chehab /* Control is not ac97 related */ 7370c0d06caSMauro Carvalho Chehab return 1; 7380c0d06caSMauro Carvalho Chehab } 7390c0d06caSMauro Carvalho Chehab 7400c0d06caSMauro Carvalho Chehab /* 7410c0d06caSMauro Carvalho Chehab * ac97_get_ctrl() 7420c0d06caSMauro Carvalho Chehab * return the current values for ac97 mute and volume 7430c0d06caSMauro Carvalho Chehab */ 7440c0d06caSMauro Carvalho Chehab static int ac97_get_ctrl(struct em28xx *dev, struct v4l2_control *ctrl) 7450c0d06caSMauro Carvalho Chehab { 7460c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 7470c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 7480c0d06caSMauro Carvalho Chehab ctrl->value = dev->mute; 7490c0d06caSMauro Carvalho Chehab return 0; 7500c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 7510c0d06caSMauro Carvalho Chehab ctrl->value = dev->volume; 7520c0d06caSMauro Carvalho Chehab return 0; 7530c0d06caSMauro Carvalho Chehab default: 7540c0d06caSMauro Carvalho Chehab /* Control is not ac97 related */ 7550c0d06caSMauro Carvalho Chehab return 1; 7560c0d06caSMauro Carvalho Chehab } 7570c0d06caSMauro Carvalho Chehab } 7580c0d06caSMauro Carvalho Chehab 7590c0d06caSMauro Carvalho Chehab /* 7600c0d06caSMauro Carvalho Chehab * ac97_set_ctrl() 7610c0d06caSMauro Carvalho Chehab * set values for ac97 mute and volume 7620c0d06caSMauro Carvalho Chehab */ 7630c0d06caSMauro Carvalho Chehab static int ac97_set_ctrl(struct em28xx *dev, const struct v4l2_control *ctrl) 7640c0d06caSMauro Carvalho Chehab { 7650c0d06caSMauro Carvalho Chehab int i; 7660c0d06caSMauro Carvalho Chehab 7670c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) 7680c0d06caSMauro Carvalho Chehab if (ctrl->id == ac97_qctrl[i].id) 7690c0d06caSMauro Carvalho Chehab goto handle; 7700c0d06caSMauro Carvalho Chehab 7710c0d06caSMauro Carvalho Chehab /* Announce that hasn't handle it */ 7720c0d06caSMauro Carvalho Chehab return 1; 7730c0d06caSMauro Carvalho Chehab 7740c0d06caSMauro Carvalho Chehab handle: 7750c0d06caSMauro Carvalho Chehab if (ctrl->value < ac97_qctrl[i].minimum || 7760c0d06caSMauro Carvalho Chehab ctrl->value > ac97_qctrl[i].maximum) 7770c0d06caSMauro Carvalho Chehab return -ERANGE; 7780c0d06caSMauro Carvalho Chehab 7790c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 7800c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 7810c0d06caSMauro Carvalho Chehab dev->mute = ctrl->value; 7820c0d06caSMauro Carvalho Chehab break; 7830c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 7840c0d06caSMauro Carvalho Chehab dev->volume = ctrl->value; 7850c0d06caSMauro Carvalho Chehab break; 7860c0d06caSMauro Carvalho Chehab } 7870c0d06caSMauro Carvalho Chehab 7880c0d06caSMauro Carvalho Chehab return em28xx_audio_analog_set(dev); 7890c0d06caSMauro Carvalho Chehab } 7900c0d06caSMauro Carvalho Chehab 7910c0d06caSMauro Carvalho Chehab static int check_dev(struct em28xx *dev) 7920c0d06caSMauro Carvalho Chehab { 7930c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 7940c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device not present\n"); 7950c0d06caSMauro Carvalho Chehab return -ENODEV; 7960c0d06caSMauro Carvalho Chehab } 7970c0d06caSMauro Carvalho Chehab 7980c0d06caSMauro Carvalho Chehab if (dev->state & DEV_MISCONFIGURED) { 7990c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device is misconfigured; " 8000c0d06caSMauro Carvalho Chehab "close and open it again\n"); 8010c0d06caSMauro Carvalho Chehab return -EIO; 8020c0d06caSMauro Carvalho Chehab } 8030c0d06caSMauro Carvalho Chehab return 0; 8040c0d06caSMauro Carvalho Chehab } 8050c0d06caSMauro Carvalho Chehab 8060c0d06caSMauro Carvalho Chehab static void get_scale(struct em28xx *dev, 8070c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 8080c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 8090c0d06caSMauro Carvalho Chehab { 8100c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 8110c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 8120c0d06caSMauro Carvalho Chehab 8130c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 8140c0d06caSMauro Carvalho Chehab if (*hscale >= 0x4000) 8150c0d06caSMauro Carvalho Chehab *hscale = 0x3fff; 8160c0d06caSMauro Carvalho Chehab 8170c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 8180c0d06caSMauro Carvalho Chehab if (*vscale >= 0x4000) 8190c0d06caSMauro Carvalho Chehab *vscale = 0x3fff; 8200c0d06caSMauro Carvalho Chehab } 8210c0d06caSMauro Carvalho Chehab 8220c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 8230c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 8240c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8250c0d06caSMauro Carvalho Chehab 8260c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 8270c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8280c0d06caSMauro Carvalho Chehab { 8290c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8300c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8310c0d06caSMauro Carvalho Chehab 8320c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 8330c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 8340c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 8350c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 8360c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 8370c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 8380c0d06caSMauro Carvalho Chehab 8390c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 8400c0d06caSMauro Carvalho Chehab if (dev->progressive) 8410c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 8420c0d06caSMauro Carvalho Chehab else 8430c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 8440c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 8450c0d06caSMauro Carvalho Chehab return 0; 8460c0d06caSMauro Carvalho Chehab } 8470c0d06caSMauro Carvalho Chehab 8480c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 8490c0d06caSMauro Carvalho Chehab { 8500c0d06caSMauro Carvalho Chehab unsigned int i; 8510c0d06caSMauro Carvalho Chehab 8520c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 8530c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 8540c0d06caSMauro Carvalho Chehab return &format[i]; 8550c0d06caSMauro Carvalho Chehab 8560c0d06caSMauro Carvalho Chehab return NULL; 8570c0d06caSMauro Carvalho Chehab } 8580c0d06caSMauro Carvalho Chehab 8590c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 8600c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8610c0d06caSMauro Carvalho Chehab { 8620c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8630c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8640c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 8650c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 8660c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 8670c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 8680c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 8690c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 8700c0d06caSMauro Carvalho Chehab 8710c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 8720c0d06caSMauro Carvalho Chehab if (!fmt) { 8730c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 8740c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 8750c0d06caSMauro Carvalho Chehab return -EINVAL; 8760c0d06caSMauro Carvalho Chehab } 8770c0d06caSMauro Carvalho Chehab 8780c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 8790c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 8800c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 8810c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 8820c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 8830c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 8840c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 8850c0d06caSMauro Carvalho Chehab width /= 2; 8860c0d06caSMauro Carvalho Chehab } else { 8870c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 8880c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 8890c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 8900c0d06caSMauro Carvalho Chehab 1, 0); 8910c0d06caSMauro Carvalho Chehab } 8920c0d06caSMauro Carvalho Chehab 8930c0d06caSMauro Carvalho Chehab get_scale(dev, width, height, &hscale, &vscale); 8940c0d06caSMauro Carvalho Chehab 8950c0d06caSMauro Carvalho Chehab width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 8960c0d06caSMauro Carvalho Chehab height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 8970c0d06caSMauro Carvalho Chehab 8980c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 8990c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 9000c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 9010c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * fmt->depth + 7) >> 3; 9020c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 9030c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 9040c0d06caSMauro Carvalho Chehab if (dev->progressive) 9050c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 9060c0d06caSMauro Carvalho Chehab else 9070c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 9080c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 9090c0d06caSMauro Carvalho Chehab 9100c0d06caSMauro Carvalho Chehab return 0; 9110c0d06caSMauro Carvalho Chehab } 9120c0d06caSMauro Carvalho Chehab 9130c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 9140c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 9150c0d06caSMauro Carvalho Chehab { 9160c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 9170c0d06caSMauro Carvalho Chehab 9180c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 9190c0d06caSMauro Carvalho Chehab if (!fmt) 9200c0d06caSMauro Carvalho Chehab return -EINVAL; 9210c0d06caSMauro Carvalho Chehab 9220c0d06caSMauro Carvalho Chehab dev->format = fmt; 9230c0d06caSMauro Carvalho Chehab dev->width = width; 9240c0d06caSMauro Carvalho Chehab dev->height = height; 9250c0d06caSMauro Carvalho Chehab 9260c0d06caSMauro Carvalho Chehab /* set new image size */ 9270c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 9280c0d06caSMauro Carvalho Chehab 9290c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 9300c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 9310c0d06caSMauro Carvalho Chehab 9320c0d06caSMauro Carvalho Chehab return 0; 9330c0d06caSMauro Carvalho Chehab } 9340c0d06caSMauro Carvalho Chehab 9350c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 9360c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 9370c0d06caSMauro Carvalho Chehab { 9380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9400c0d06caSMauro Carvalho Chehab int rc; 9410c0d06caSMauro Carvalho Chehab 9420c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9430c0d06caSMauro Carvalho Chehab if (rc < 0) 9440c0d06caSMauro Carvalho Chehab return rc; 9450c0d06caSMauro Carvalho Chehab 9460c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 9470c0d06caSMauro Carvalho Chehab 9480c0d06caSMauro Carvalho Chehab if (videobuf_queue_is_busy(&fh->vb_vidq)) { 9490c0d06caSMauro Carvalho Chehab em28xx_errdev("%s queue busy\n", __func__); 9500c0d06caSMauro Carvalho Chehab return -EBUSY; 9510c0d06caSMauro Carvalho Chehab } 9520c0d06caSMauro Carvalho Chehab 9530c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 9540c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 9550c0d06caSMauro Carvalho Chehab } 9560c0d06caSMauro Carvalho Chehab 9570c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 9580c0d06caSMauro Carvalho Chehab { 9590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9610c0d06caSMauro Carvalho Chehab int rc; 9620c0d06caSMauro Carvalho Chehab 9630c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9640c0d06caSMauro Carvalho Chehab if (rc < 0) 9650c0d06caSMauro Carvalho Chehab return rc; 9660c0d06caSMauro Carvalho Chehab 9670c0d06caSMauro Carvalho Chehab *norm = dev->norm; 9680c0d06caSMauro Carvalho Chehab 9690c0d06caSMauro Carvalho Chehab return 0; 9700c0d06caSMauro Carvalho Chehab } 9710c0d06caSMauro Carvalho Chehab 9720c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 9730c0d06caSMauro Carvalho Chehab { 9740c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9750c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9760c0d06caSMauro Carvalho Chehab int rc; 9770c0d06caSMauro Carvalho Chehab 9780c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9790c0d06caSMauro Carvalho Chehab if (rc < 0) 9800c0d06caSMauro Carvalho Chehab return rc; 9810c0d06caSMauro Carvalho Chehab 9820c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 9830c0d06caSMauro Carvalho Chehab 9840c0d06caSMauro Carvalho Chehab return 0; 9850c0d06caSMauro Carvalho Chehab } 9860c0d06caSMauro Carvalho Chehab 9870c0d06caSMauro Carvalho Chehab static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *norm) 9880c0d06caSMauro Carvalho Chehab { 9890c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9900c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9910c0d06caSMauro Carvalho Chehab struct v4l2_format f; 9920c0d06caSMauro Carvalho Chehab int rc; 9930c0d06caSMauro Carvalho Chehab 9940c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9950c0d06caSMauro Carvalho Chehab if (rc < 0) 9960c0d06caSMauro Carvalho Chehab return rc; 9970c0d06caSMauro Carvalho Chehab 9980c0d06caSMauro Carvalho Chehab dev->norm = *norm; 9990c0d06caSMauro Carvalho Chehab 10000c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 10010c0d06caSMauro Carvalho Chehab f.fmt.pix.width = dev->width; 10020c0d06caSMauro Carvalho Chehab f.fmt.pix.height = dev->height; 10030c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 10040c0d06caSMauro Carvalho Chehab 10050c0d06caSMauro Carvalho Chehab /* set new image size */ 10060c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 10070c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 10080c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 10090c0d06caSMauro Carvalho Chehab 10100c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 10110c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 10120c0d06caSMauro Carvalho Chehab 10130c0d06caSMauro Carvalho Chehab return 0; 10140c0d06caSMauro Carvalho Chehab } 10150c0d06caSMauro Carvalho Chehab 10160c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 10170c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 10180c0d06caSMauro Carvalho Chehab { 10190c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10200c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10210c0d06caSMauro Carvalho Chehab int rc = 0; 10220c0d06caSMauro Carvalho Chehab 10230c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 10240c0d06caSMauro Carvalho Chehab return -EINVAL; 10250c0d06caSMauro Carvalho Chehab 10260c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 10270c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 10280c0d06caSMauro Carvalho Chehab video, g_parm, p); 10290c0d06caSMauro Carvalho Chehab else 10300c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 10310c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 10320c0d06caSMauro Carvalho Chehab 10330c0d06caSMauro Carvalho Chehab return rc; 10340c0d06caSMauro Carvalho Chehab } 10350c0d06caSMauro Carvalho Chehab 10360c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 10370c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 10380c0d06caSMauro Carvalho Chehab { 10390c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10400c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10410c0d06caSMauro Carvalho Chehab 10420c0d06caSMauro Carvalho Chehab if (!dev->board.is_webcam) 10430c0d06caSMauro Carvalho Chehab return -EINVAL; 10440c0d06caSMauro Carvalho Chehab 10450c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 10460c0d06caSMauro Carvalho Chehab return -EINVAL; 10470c0d06caSMauro Carvalho Chehab 10480c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 10490c0d06caSMauro Carvalho Chehab } 10500c0d06caSMauro Carvalho Chehab 10510c0d06caSMauro Carvalho Chehab static const char *iname[] = { 10520c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 10530c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 10540c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 10550c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 10560c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 10570c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 10580c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 10590c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 10600c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 10610c0d06caSMauro Carvalho Chehab }; 10620c0d06caSMauro Carvalho Chehab 10630c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 10640c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 10650c0d06caSMauro Carvalho Chehab { 10660c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10670c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10680c0d06caSMauro Carvalho Chehab unsigned int n; 10690c0d06caSMauro Carvalho Chehab 10700c0d06caSMauro Carvalho Chehab n = i->index; 10710c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 10720c0d06caSMauro Carvalho Chehab return -EINVAL; 10730c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 10740c0d06caSMauro Carvalho Chehab return -EINVAL; 10750c0d06caSMauro Carvalho Chehab 10760c0d06caSMauro Carvalho Chehab i->index = n; 10770c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 10780c0d06caSMauro Carvalho Chehab 10790c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 10800c0d06caSMauro Carvalho Chehab 10810c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 10820c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 10830c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 10840c0d06caSMauro Carvalho Chehab 10850c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 10860c0d06caSMauro Carvalho Chehab 10870c0d06caSMauro Carvalho Chehab return 0; 10880c0d06caSMauro Carvalho Chehab } 10890c0d06caSMauro Carvalho Chehab 10900c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 10910c0d06caSMauro Carvalho Chehab { 10920c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10930c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10940c0d06caSMauro Carvalho Chehab 10950c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 10960c0d06caSMauro Carvalho Chehab 10970c0d06caSMauro Carvalho Chehab return 0; 10980c0d06caSMauro Carvalho Chehab } 10990c0d06caSMauro Carvalho Chehab 11000c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 11010c0d06caSMauro Carvalho Chehab { 11020c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11030c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11040c0d06caSMauro Carvalho Chehab int rc; 11050c0d06caSMauro Carvalho Chehab 11060c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11070c0d06caSMauro Carvalho Chehab if (rc < 0) 11080c0d06caSMauro Carvalho Chehab return rc; 11090c0d06caSMauro Carvalho Chehab 11100c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 11110c0d06caSMauro Carvalho Chehab return -EINVAL; 11120c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 11130c0d06caSMauro Carvalho Chehab return -EINVAL; 11140c0d06caSMauro Carvalho Chehab 11150c0d06caSMauro Carvalho Chehab video_mux(dev, i); 11160c0d06caSMauro Carvalho Chehab return 0; 11170c0d06caSMauro Carvalho Chehab } 11180c0d06caSMauro Carvalho Chehab 11190c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 11200c0d06caSMauro Carvalho Chehab { 11210c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11220c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11230c0d06caSMauro Carvalho Chehab 11240c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 11250c0d06caSMauro Carvalho Chehab return -EINVAL; 11260c0d06caSMauro Carvalho Chehab 11270c0d06caSMauro Carvalho Chehab switch (a->index) { 11280c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 11290c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 11300c0d06caSMauro Carvalho Chehab break; 11310c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 11320c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 11330c0d06caSMauro Carvalho Chehab break; 11340c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 11350c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 11360c0d06caSMauro Carvalho Chehab break; 11370c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 11380c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 11390c0d06caSMauro Carvalho Chehab break; 11400c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 11410c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 11420c0d06caSMauro Carvalho Chehab break; 11430c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 11440c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 11450c0d06caSMauro Carvalho Chehab break; 11460c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 11470c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 11480c0d06caSMauro Carvalho Chehab break; 11490c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 11500c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 11510c0d06caSMauro Carvalho Chehab break; 11520c0d06caSMauro Carvalho Chehab default: 11530c0d06caSMauro Carvalho Chehab return -EINVAL; 11540c0d06caSMauro Carvalho Chehab } 11550c0d06caSMauro Carvalho Chehab 11560c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 11570c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 11580c0d06caSMauro Carvalho Chehab 11590c0d06caSMauro Carvalho Chehab return 0; 11600c0d06caSMauro Carvalho Chehab } 11610c0d06caSMauro Carvalho Chehab 11620e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 11630c0d06caSMauro Carvalho Chehab { 11640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11660c0d06caSMauro Carvalho Chehab 11670c0d06caSMauro Carvalho Chehab 11680c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 11690c0d06caSMauro Carvalho Chehab return -EINVAL; 11700c0d06caSMauro Carvalho Chehab 11710c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 11720c0d06caSMauro Carvalho Chehab return -EINVAL; 11730c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 11740c0d06caSMauro Carvalho Chehab return -EINVAL; 11750c0d06caSMauro Carvalho Chehab 11760c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 11770c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 11780c0d06caSMauro Carvalho Chehab 11790c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11800c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11810c0d06caSMauro Carvalho Chehab 11820c0d06caSMauro Carvalho Chehab return 0; 11830c0d06caSMauro Carvalho Chehab } 11840c0d06caSMauro Carvalho Chehab 11850c0d06caSMauro Carvalho Chehab static int vidioc_queryctrl(struct file *file, void *priv, 11860c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl *qc) 11870c0d06caSMauro Carvalho Chehab { 11880c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11890c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11900c0d06caSMauro Carvalho Chehab int id = qc->id; 11910c0d06caSMauro Carvalho Chehab int rc; 11920c0d06caSMauro Carvalho Chehab 11930c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11940c0d06caSMauro Carvalho Chehab if (rc < 0) 11950c0d06caSMauro Carvalho Chehab return rc; 11960c0d06caSMauro Carvalho Chehab 11970c0d06caSMauro Carvalho Chehab memset(qc, 0, sizeof(*qc)); 11980c0d06caSMauro Carvalho Chehab 11990c0d06caSMauro Carvalho Chehab qc->id = id; 12000c0d06caSMauro Carvalho Chehab 12010c0d06caSMauro Carvalho Chehab /* enumerate AC97 controls */ 12020c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 12030c0d06caSMauro Carvalho Chehab rc = ac97_queryctrl(qc); 12040c0d06caSMauro Carvalho Chehab if (!rc) 12050c0d06caSMauro Carvalho Chehab return 0; 12060c0d06caSMauro Carvalho Chehab } 12070c0d06caSMauro Carvalho Chehab 12080c0d06caSMauro Carvalho Chehab /* enumerate V4L2 device controls */ 12090c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, queryctrl, qc); 12100c0d06caSMauro Carvalho Chehab 12110c0d06caSMauro Carvalho Chehab if (qc->type) 12120c0d06caSMauro Carvalho Chehab return 0; 12130c0d06caSMauro Carvalho Chehab else 12140c0d06caSMauro Carvalho Chehab return -EINVAL; 12150c0d06caSMauro Carvalho Chehab } 12160c0d06caSMauro Carvalho Chehab 12170c0d06caSMauro Carvalho Chehab /* 12180c0d06caSMauro Carvalho Chehab * FIXME: This is an indirect way to check if a control exists at a 12190c0d06caSMauro Carvalho Chehab * subdev. Instead of that hack, maybe the better would be to change all 12200c0d06caSMauro Carvalho Chehab * subdevs to return -ENOIOCTLCMD, if an ioctl is not supported. 12210c0d06caSMauro Carvalho Chehab */ 12220c0d06caSMauro Carvalho Chehab static int check_subdev_ctrl(struct em28xx *dev, int id) 12230c0d06caSMauro Carvalho Chehab { 12240c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl qc; 12250c0d06caSMauro Carvalho Chehab 12260c0d06caSMauro Carvalho Chehab memset(&qc, 0, sizeof(qc)); 12270c0d06caSMauro Carvalho Chehab qc.id = id; 12280c0d06caSMauro Carvalho Chehab 12290c0d06caSMauro Carvalho Chehab /* enumerate V4L2 device controls */ 12300c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, queryctrl, &qc); 12310c0d06caSMauro Carvalho Chehab 12320c0d06caSMauro Carvalho Chehab if (qc.type) 12330c0d06caSMauro Carvalho Chehab return 0; 12340c0d06caSMauro Carvalho Chehab else 12350c0d06caSMauro Carvalho Chehab return -EINVAL; 12360c0d06caSMauro Carvalho Chehab } 12370c0d06caSMauro Carvalho Chehab 12380c0d06caSMauro Carvalho Chehab static int vidioc_g_ctrl(struct file *file, void *priv, 12390c0d06caSMauro Carvalho Chehab struct v4l2_control *ctrl) 12400c0d06caSMauro Carvalho Chehab { 12410c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12420c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12430c0d06caSMauro Carvalho Chehab int rc; 12440c0d06caSMauro Carvalho Chehab 12450c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 12460c0d06caSMauro Carvalho Chehab if (rc < 0) 12470c0d06caSMauro Carvalho Chehab return rc; 12480c0d06caSMauro Carvalho Chehab rc = 0; 12490c0d06caSMauro Carvalho Chehab 12500c0d06caSMauro Carvalho Chehab /* Set an AC97 control */ 12510c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) 12520c0d06caSMauro Carvalho Chehab rc = ac97_get_ctrl(dev, ctrl); 12530c0d06caSMauro Carvalho Chehab else 12540c0d06caSMauro Carvalho Chehab rc = 1; 12550c0d06caSMauro Carvalho Chehab 12560c0d06caSMauro Carvalho Chehab /* It were not an AC97 control. Sends it to the v4l2 dev interface */ 12570c0d06caSMauro Carvalho Chehab if (rc == 1) { 12580c0d06caSMauro Carvalho Chehab if (check_subdev_ctrl(dev, ctrl->id)) 12590c0d06caSMauro Carvalho Chehab return -EINVAL; 12600c0d06caSMauro Carvalho Chehab 12610c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_ctrl, ctrl); 12620c0d06caSMauro Carvalho Chehab rc = 0; 12630c0d06caSMauro Carvalho Chehab } 12640c0d06caSMauro Carvalho Chehab 12650c0d06caSMauro Carvalho Chehab return rc; 12660c0d06caSMauro Carvalho Chehab } 12670c0d06caSMauro Carvalho Chehab 12680c0d06caSMauro Carvalho Chehab static int vidioc_s_ctrl(struct file *file, void *priv, 12690c0d06caSMauro Carvalho Chehab struct v4l2_control *ctrl) 12700c0d06caSMauro Carvalho Chehab { 12710c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12720c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12730c0d06caSMauro Carvalho Chehab int rc; 12740c0d06caSMauro Carvalho Chehab 12750c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 12760c0d06caSMauro Carvalho Chehab if (rc < 0) 12770c0d06caSMauro Carvalho Chehab return rc; 12780c0d06caSMauro Carvalho Chehab 12790c0d06caSMauro Carvalho Chehab /* Set an AC97 control */ 12800c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) 12810c0d06caSMauro Carvalho Chehab rc = ac97_set_ctrl(dev, ctrl); 12820c0d06caSMauro Carvalho Chehab else 12830c0d06caSMauro Carvalho Chehab rc = 1; 12840c0d06caSMauro Carvalho Chehab 12850c0d06caSMauro Carvalho Chehab /* It isn't an AC97 control. Sends it to the v4l2 dev interface */ 12860c0d06caSMauro Carvalho Chehab if (rc == 1) { 12870c0d06caSMauro Carvalho Chehab rc = check_subdev_ctrl(dev, ctrl->id); 12880c0d06caSMauro Carvalho Chehab if (!rc) 12890c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, 12900c0d06caSMauro Carvalho Chehab core, s_ctrl, ctrl); 12910c0d06caSMauro Carvalho Chehab /* 12920c0d06caSMauro Carvalho Chehab * In the case of non-AC97 volume controls, we still need 12930c0d06caSMauro Carvalho Chehab * to do some setups at em28xx, in order to mute/unmute 12940c0d06caSMauro Carvalho Chehab * and to adjust audio volume. However, the value ranges 12950c0d06caSMauro Carvalho Chehab * should be checked by the corresponding V4L subdriver. 12960c0d06caSMauro Carvalho Chehab */ 12970c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 12980c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 12990c0d06caSMauro Carvalho Chehab dev->mute = ctrl->value; 13000c0d06caSMauro Carvalho Chehab rc = em28xx_audio_analog_set(dev); 13010c0d06caSMauro Carvalho Chehab break; 13020c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 13030c0d06caSMauro Carvalho Chehab dev->volume = ctrl->value; 13040c0d06caSMauro Carvalho Chehab rc = em28xx_audio_analog_set(dev); 13050c0d06caSMauro Carvalho Chehab } 13060c0d06caSMauro Carvalho Chehab } 13070c0d06caSMauro Carvalho Chehab return (rc < 0) ? rc : 0; 13080c0d06caSMauro Carvalho Chehab } 13090c0d06caSMauro Carvalho Chehab 13100c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 13110c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 13120c0d06caSMauro Carvalho Chehab { 13130c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13140c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13150c0d06caSMauro Carvalho Chehab int rc; 13160c0d06caSMauro Carvalho Chehab 13170c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13180c0d06caSMauro Carvalho Chehab if (rc < 0) 13190c0d06caSMauro Carvalho Chehab return rc; 13200c0d06caSMauro Carvalho Chehab 13210c0d06caSMauro Carvalho Chehab if (0 != t->index) 13220c0d06caSMauro Carvalho Chehab return -EINVAL; 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 13250c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_ANALOG_TV; 13260c0d06caSMauro Carvalho Chehab 13270c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 13280c0d06caSMauro Carvalho Chehab return 0; 13290c0d06caSMauro Carvalho Chehab } 13300c0d06caSMauro Carvalho Chehab 13310c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 13320c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 13330c0d06caSMauro Carvalho Chehab { 13340c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13350c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13360c0d06caSMauro Carvalho Chehab int rc; 13370c0d06caSMauro Carvalho Chehab 13380c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13390c0d06caSMauro Carvalho Chehab if (rc < 0) 13400c0d06caSMauro Carvalho Chehab return rc; 13410c0d06caSMauro Carvalho Chehab 13420c0d06caSMauro Carvalho Chehab if (0 != t->index) 13430c0d06caSMauro Carvalho Chehab return -EINVAL; 13440c0d06caSMauro Carvalho Chehab 13450c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 13460c0d06caSMauro Carvalho Chehab return 0; 13470c0d06caSMauro Carvalho Chehab } 13480c0d06caSMauro Carvalho Chehab 13490c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 13500c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 13510c0d06caSMauro Carvalho Chehab { 13520c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13530c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13540c0d06caSMauro Carvalho Chehab 13550c0d06caSMauro Carvalho Chehab f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; 13560c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 13570c0d06caSMauro Carvalho Chehab return 0; 13580c0d06caSMauro Carvalho Chehab } 13590c0d06caSMauro Carvalho Chehab 13600c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 13610c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 13620c0d06caSMauro Carvalho Chehab { 13630c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13640c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13650c0d06caSMauro Carvalho Chehab int rc; 13660c0d06caSMauro Carvalho Chehab 13670c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13680c0d06caSMauro Carvalho Chehab if (rc < 0) 13690c0d06caSMauro Carvalho Chehab return rc; 13700c0d06caSMauro Carvalho Chehab 13710c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 13720c0d06caSMauro Carvalho Chehab return -EINVAL; 13730c0d06caSMauro Carvalho Chehab 13740c0d06caSMauro Carvalho Chehab if (unlikely(0 == fh->radio && f->type != V4L2_TUNER_ANALOG_TV)) 13750c0d06caSMauro Carvalho Chehab return -EINVAL; 13760c0d06caSMauro Carvalho Chehab if (unlikely(1 == fh->radio && f->type != V4L2_TUNER_RADIO)) 13770c0d06caSMauro Carvalho Chehab return -EINVAL; 13780c0d06caSMauro Carvalho Chehab 13790c0d06caSMauro Carvalho Chehab dev->ctl_freq = f->frequency; 13800c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 13810c0d06caSMauro Carvalho Chehab 13820c0d06caSMauro Carvalho Chehab return 0; 13830c0d06caSMauro Carvalho Chehab } 13840c0d06caSMauro Carvalho Chehab 13850c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 13860c0d06caSMauro Carvalho Chehab static int em28xx_reg_len(int reg) 13870c0d06caSMauro Carvalho Chehab { 13880c0d06caSMauro Carvalho Chehab switch (reg) { 13890c0d06caSMauro Carvalho Chehab case EM28XX_R40_AC97LSB: 13900c0d06caSMauro Carvalho Chehab case EM28XX_R30_HSCALELOW: 13910c0d06caSMauro Carvalho Chehab case EM28XX_R32_VSCALELOW: 13920c0d06caSMauro Carvalho Chehab return 2; 13930c0d06caSMauro Carvalho Chehab default: 13940c0d06caSMauro Carvalho Chehab return 1; 13950c0d06caSMauro Carvalho Chehab } 13960c0d06caSMauro Carvalho Chehab } 13970c0d06caSMauro Carvalho Chehab 13980c0d06caSMauro Carvalho Chehab static int vidioc_g_chip_ident(struct file *file, void *priv, 13990c0d06caSMauro Carvalho Chehab struct v4l2_dbg_chip_ident *chip) 14000c0d06caSMauro Carvalho Chehab { 14010c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14020c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14030c0d06caSMauro Carvalho Chehab 14040c0d06caSMauro Carvalho Chehab chip->ident = V4L2_IDENT_NONE; 14050c0d06caSMauro Carvalho Chehab chip->revision = 0; 14060c0d06caSMauro Carvalho Chehab 14070c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_chip_ident, chip); 14080c0d06caSMauro Carvalho Chehab 14090c0d06caSMauro Carvalho Chehab return 0; 14100c0d06caSMauro Carvalho Chehab } 14110c0d06caSMauro Carvalho Chehab 14120c0d06caSMauro Carvalho Chehab 14130c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 14140c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 14150c0d06caSMauro Carvalho Chehab { 14160c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14170c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14180c0d06caSMauro Carvalho Chehab int ret; 14190c0d06caSMauro Carvalho Chehab 14200c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 14210c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 14220c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 14230c0d06caSMauro Carvalho Chehab if (ret < 0) 14240c0d06caSMauro Carvalho Chehab return ret; 14250c0d06caSMauro Carvalho Chehab 14260c0d06caSMauro Carvalho Chehab reg->val = ret; 14270c0d06caSMauro Carvalho Chehab reg->size = 1; 14280c0d06caSMauro Carvalho Chehab return 0; 14290c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 14300c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 14310c0d06caSMauro Carvalho Chehab return 0; 14320c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 14330c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 14340c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 14350c0d06caSMauro Carvalho Chehab return 0; 14360c0d06caSMauro Carvalho Chehab default: 14370c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 14380c0d06caSMauro Carvalho Chehab return -EINVAL; 14390c0d06caSMauro Carvalho Chehab } 14400c0d06caSMauro Carvalho Chehab 14410c0d06caSMauro Carvalho Chehab /* Match host */ 14420c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 14430c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 14440c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 14450c0d06caSMauro Carvalho Chehab 14460c0d06caSMauro Carvalho Chehab if (ret < 0) 14470c0d06caSMauro Carvalho Chehab return ret; 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab reg->val = ret; 14500c0d06caSMauro Carvalho Chehab } else { 14510c0d06caSMauro Carvalho Chehab __le16 val = 0; 14520c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 14530c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 14540c0d06caSMauro Carvalho Chehab if (ret < 0) 14550c0d06caSMauro Carvalho Chehab return ret; 14560c0d06caSMauro Carvalho Chehab 14570c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 14580c0d06caSMauro Carvalho Chehab } 14590c0d06caSMauro Carvalho Chehab 14600c0d06caSMauro Carvalho Chehab return 0; 14610c0d06caSMauro Carvalho Chehab } 14620c0d06caSMauro Carvalho Chehab 14630c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 14640c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 14650c0d06caSMauro Carvalho Chehab { 14660c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14670c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14680c0d06caSMauro Carvalho Chehab __le16 buf; 14690c0d06caSMauro Carvalho Chehab 14700c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 14710c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 14720c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 14730c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 14740c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 14750c0d06caSMauro Carvalho Chehab return 0; 14760c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 14770c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 14780c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 14790c0d06caSMauro Carvalho Chehab return 0; 14800c0d06caSMauro Carvalho Chehab default: 14810c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 14820c0d06caSMauro Carvalho Chehab return -EINVAL; 14830c0d06caSMauro Carvalho Chehab } 14840c0d06caSMauro Carvalho Chehab 14850c0d06caSMauro Carvalho Chehab /* Match host */ 14860c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 14870c0d06caSMauro Carvalho Chehab 14880c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 14890c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 14900c0d06caSMauro Carvalho Chehab } 14910c0d06caSMauro Carvalho Chehab #endif 14920c0d06caSMauro Carvalho Chehab 14930c0d06caSMauro Carvalho Chehab 14940c0d06caSMauro Carvalho Chehab static int vidioc_cropcap(struct file *file, void *priv, 14950c0d06caSMauro Carvalho Chehab struct v4l2_cropcap *cc) 14960c0d06caSMauro Carvalho Chehab { 14970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14990c0d06caSMauro Carvalho Chehab 15000c0d06caSMauro Carvalho Chehab if (cc->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 15010c0d06caSMauro Carvalho Chehab return -EINVAL; 15020c0d06caSMauro Carvalho Chehab 15030c0d06caSMauro Carvalho Chehab cc->bounds.left = 0; 15040c0d06caSMauro Carvalho Chehab cc->bounds.top = 0; 15050c0d06caSMauro Carvalho Chehab cc->bounds.width = dev->width; 15060c0d06caSMauro Carvalho Chehab cc->bounds.height = dev->height; 15070c0d06caSMauro Carvalho Chehab cc->defrect = cc->bounds; 15080c0d06caSMauro Carvalho Chehab cc->pixelaspect.numerator = 54; /* 4:3 FIXME: remove magic numbers */ 15090c0d06caSMauro Carvalho Chehab cc->pixelaspect.denominator = 59; 15100c0d06caSMauro Carvalho Chehab 15110c0d06caSMauro Carvalho Chehab return 0; 15120c0d06caSMauro Carvalho Chehab } 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab static int vidioc_streamon(struct file *file, void *priv, 15150c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 15160c0d06caSMauro Carvalho Chehab { 15170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15190c0d06caSMauro Carvalho Chehab int rc = -EINVAL; 15200c0d06caSMauro Carvalho Chehab 15210c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15220c0d06caSMauro Carvalho Chehab if (rc < 0) 15230c0d06caSMauro Carvalho Chehab return rc; 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab if (unlikely(type != fh->type)) 15260c0d06caSMauro Carvalho Chehab return -EINVAL; 15270c0d06caSMauro Carvalho Chehab 15280c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamon fh=%p t=%d fh->res=%d dev->res=%d\n", 15290c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 15300c0d06caSMauro Carvalho Chehab 15310c0d06caSMauro Carvalho Chehab if (unlikely(!res_get(fh, get_ressource(fh)))) 15320c0d06caSMauro Carvalho Chehab return -EBUSY; 15330c0d06caSMauro Carvalho Chehab 15340c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 15350c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vidq); 15360c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 15370c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vbiq); 15380c0d06caSMauro Carvalho Chehab 15390c0d06caSMauro Carvalho Chehab return rc; 15400c0d06caSMauro Carvalho Chehab } 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab static int vidioc_streamoff(struct file *file, void *priv, 15430c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 15440c0d06caSMauro Carvalho Chehab { 15450c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15470c0d06caSMauro Carvalho Chehab int rc; 15480c0d06caSMauro Carvalho Chehab 15490c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15500c0d06caSMauro Carvalho Chehab if (rc < 0) 15510c0d06caSMauro Carvalho Chehab return rc; 15520c0d06caSMauro Carvalho Chehab 15530c0d06caSMauro Carvalho Chehab if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 15540c0d06caSMauro Carvalho Chehab fh->type != V4L2_BUF_TYPE_VBI_CAPTURE) 15550c0d06caSMauro Carvalho Chehab return -EINVAL; 15560c0d06caSMauro Carvalho Chehab if (type != fh->type) 15570c0d06caSMauro Carvalho Chehab return -EINVAL; 15580c0d06caSMauro Carvalho Chehab 15590c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamoff fh=%p t=%d fh->res=%d dev->res=%d\n", 15600c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 15610c0d06caSMauro Carvalho Chehab 15620c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 15630c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 15640c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vidq); 15650c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 15660c0d06caSMauro Carvalho Chehab } 15670c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 15680c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 15690c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vbiq); 15700c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 15710c0d06caSMauro Carvalho Chehab } 15720c0d06caSMauro Carvalho Chehab } 15730c0d06caSMauro Carvalho Chehab 15740c0d06caSMauro Carvalho Chehab return 0; 15750c0d06caSMauro Carvalho Chehab } 15760c0d06caSMauro Carvalho Chehab 15770c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 15780c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 15790c0d06caSMauro Carvalho Chehab { 15800c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15810c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15820c0d06caSMauro Carvalho Chehab 15830c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 15840c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 15850c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 15860c0d06caSMauro Carvalho Chehab 15870c0d06caSMauro Carvalho Chehab cap->capabilities = 15880c0d06caSMauro Carvalho Chehab V4L2_CAP_SLICED_VBI_CAPTURE | 15890c0d06caSMauro Carvalho Chehab V4L2_CAP_VIDEO_CAPTURE | 15900c0d06caSMauro Carvalho Chehab V4L2_CAP_READWRITE | V4L2_CAP_STREAMING; 15910c0d06caSMauro Carvalho Chehab 15920c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 15930c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 15940c0d06caSMauro Carvalho Chehab 15950c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 15960c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_AUDIO; 15970c0d06caSMauro Carvalho Chehab 15980c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 15990c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_TUNER; 16000c0d06caSMauro Carvalho Chehab 16010c0d06caSMauro Carvalho Chehab return 0; 16020c0d06caSMauro Carvalho Chehab } 16030c0d06caSMauro Carvalho Chehab 16040c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 16050c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 16060c0d06caSMauro Carvalho Chehab { 16070c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 16080c0d06caSMauro Carvalho Chehab return -EINVAL; 16090c0d06caSMauro Carvalho Chehab 16100c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 16110c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 16120c0d06caSMauro Carvalho Chehab 16130c0d06caSMauro Carvalho Chehab return 0; 16140c0d06caSMauro Carvalho Chehab } 16150c0d06caSMauro Carvalho Chehab 16160c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 16170c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 16180c0d06caSMauro Carvalho Chehab { 16190c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16200c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16210c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 16220c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 16230c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 16240c0d06caSMauro Carvalho Chehab 16250c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 16260c0d06caSMauro Carvalho Chehab if (!fmt) { 16270c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 16280c0d06caSMauro Carvalho Chehab fsize->pixel_format); 16290c0d06caSMauro Carvalho Chehab return -EINVAL; 16300c0d06caSMauro Carvalho Chehab } 16310c0d06caSMauro Carvalho Chehab 16320c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 16330c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 16340c0d06caSMauro Carvalho Chehab return -EINVAL; 16350c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 16360c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 16370c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 16380c0d06caSMauro Carvalho Chehab return 0; 16390c0d06caSMauro Carvalho Chehab } 16400c0d06caSMauro Carvalho Chehab 16410c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 16420c0d06caSMauro Carvalho Chehab return -EINVAL; 16430c0d06caSMauro Carvalho Chehab 16440c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 16450c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 16460c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 16470c0d06caSMauro Carvalho Chehab fsize->stepwise.min_height = 32; 16480c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 16490c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 16500c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 16510c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 16520c0d06caSMauro Carvalho Chehab return 0; 16530c0d06caSMauro Carvalho Chehab } 16540c0d06caSMauro Carvalho Chehab 16550c0d06caSMauro Carvalho Chehab /* Sliced VBI ioctls */ 16560c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_sliced_vbi_cap(struct file *file, void *priv, 16570c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 16580c0d06caSMauro Carvalho Chehab { 16590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16610c0d06caSMauro Carvalho Chehab int rc; 16620c0d06caSMauro Carvalho Chehab 16630c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16640c0d06caSMauro Carvalho Chehab if (rc < 0) 16650c0d06caSMauro Carvalho Chehab return rc; 16660c0d06caSMauro Carvalho Chehab 16670c0d06caSMauro Carvalho Chehab f->fmt.sliced.service_set = 0; 16680c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 16690c0d06caSMauro Carvalho Chehab 16700c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 16710c0d06caSMauro Carvalho Chehab rc = -EINVAL; 16720c0d06caSMauro Carvalho Chehab 16730c0d06caSMauro Carvalho Chehab return rc; 16740c0d06caSMauro Carvalho Chehab } 16750c0d06caSMauro Carvalho Chehab 16760c0d06caSMauro Carvalho Chehab static int vidioc_try_set_sliced_vbi_cap(struct file *file, void *priv, 16770c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 16780c0d06caSMauro Carvalho Chehab { 16790c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16800c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16810c0d06caSMauro Carvalho Chehab int rc; 16820c0d06caSMauro Carvalho Chehab 16830c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16840c0d06caSMauro Carvalho Chehab if (rc < 0) 16850c0d06caSMauro Carvalho Chehab return rc; 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 16880c0d06caSMauro Carvalho Chehab 16890c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 16900c0d06caSMauro Carvalho Chehab return -EINVAL; 16910c0d06caSMauro Carvalho Chehab 16920c0d06caSMauro Carvalho Chehab return 0; 16930c0d06caSMauro Carvalho Chehab } 16940c0d06caSMauro Carvalho Chehab 16950c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 16960c0d06caSMauro Carvalho Chehab 16970c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 16980c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 16990c0d06caSMauro Carvalho Chehab { 17000c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17010c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17020c0d06caSMauro Carvalho Chehab 17030c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 17040c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 17050c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 17060c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 17070c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 17080c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 17090c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 17100c0d06caSMauro Carvalho Chehab 17110c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 17120c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 17130c0d06caSMauro Carvalho Chehab /* NTSC */ 17140c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 17150c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 17160c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 17170c0d06caSMauro Carvalho Chehab /* PAL */ 17180c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 17190c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 17200c0d06caSMauro Carvalho Chehab } 17210c0d06caSMauro Carvalho Chehab 17220c0d06caSMauro Carvalho Chehab return 0; 17230c0d06caSMauro Carvalho Chehab } 17240c0d06caSMauro Carvalho Chehab 17250c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vbi_cap(struct file *file, void *priv, 17260c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 17270c0d06caSMauro Carvalho Chehab { 17280c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17290c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17300c0d06caSMauro Carvalho Chehab 17310c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 17320c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 17330c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 17340c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 17350c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 17360c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 17370c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 17380c0d06caSMauro Carvalho Chehab 17390c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 17400c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 17410c0d06caSMauro Carvalho Chehab /* NTSC */ 17420c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 17430c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 17440c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 17450c0d06caSMauro Carvalho Chehab /* PAL */ 17460c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 17470c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 17480c0d06caSMauro Carvalho Chehab } 17490c0d06caSMauro Carvalho Chehab 17500c0d06caSMauro Carvalho Chehab return 0; 17510c0d06caSMauro Carvalho Chehab } 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab static int vidioc_reqbufs(struct file *file, void *priv, 17540c0d06caSMauro Carvalho Chehab struct v4l2_requestbuffers *rb) 17550c0d06caSMauro Carvalho Chehab { 17560c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17570c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17580c0d06caSMauro Carvalho Chehab int rc; 17590c0d06caSMauro Carvalho Chehab 17600c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 17610c0d06caSMauro Carvalho Chehab if (rc < 0) 17620c0d06caSMauro Carvalho Chehab return rc; 17630c0d06caSMauro Carvalho Chehab 17640c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 17650c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vidq, rb); 17660c0d06caSMauro Carvalho Chehab else 17670c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vbiq, rb); 17680c0d06caSMauro Carvalho Chehab } 17690c0d06caSMauro Carvalho Chehab 17700c0d06caSMauro Carvalho Chehab static int vidioc_querybuf(struct file *file, void *priv, 17710c0d06caSMauro Carvalho Chehab struct v4l2_buffer *b) 17720c0d06caSMauro Carvalho Chehab { 17730c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17740c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17750c0d06caSMauro Carvalho Chehab int rc; 17760c0d06caSMauro Carvalho Chehab 17770c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 17780c0d06caSMauro Carvalho Chehab if (rc < 0) 17790c0d06caSMauro Carvalho Chehab return rc; 17800c0d06caSMauro Carvalho Chehab 17810c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 17820c0d06caSMauro Carvalho Chehab return videobuf_querybuf(&fh->vb_vidq, b); 17830c0d06caSMauro Carvalho Chehab else { 17840c0d06caSMauro Carvalho Chehab /* FIXME: I'm not sure yet whether this is a bug in zvbi or 17850c0d06caSMauro Carvalho Chehab the videobuf framework, but we probably shouldn't be 17860c0d06caSMauro Carvalho Chehab returning a buffer larger than that which was asked for. 17870c0d06caSMauro Carvalho Chehab At a minimum, it causes a crash in zvbi since it does 17880c0d06caSMauro Carvalho Chehab a memcpy based on the source buffer length */ 17890c0d06caSMauro Carvalho Chehab int result = videobuf_querybuf(&fh->vb_vbiq, b); 17900c0d06caSMauro Carvalho Chehab b->length = dev->vbi_width * dev->vbi_height * 2; 17910c0d06caSMauro Carvalho Chehab 17920c0d06caSMauro Carvalho Chehab return result; 17930c0d06caSMauro Carvalho Chehab } 17940c0d06caSMauro Carvalho Chehab } 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab static int vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *b) 17970c0d06caSMauro Carvalho Chehab { 17980c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17990c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18000c0d06caSMauro Carvalho Chehab int rc; 18010c0d06caSMauro Carvalho Chehab 18020c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 18030c0d06caSMauro Carvalho Chehab if (rc < 0) 18040c0d06caSMauro Carvalho Chehab return rc; 18050c0d06caSMauro Carvalho Chehab 18060c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 18070c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vidq, b); 18080c0d06caSMauro Carvalho Chehab else 18090c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vbiq, b); 18100c0d06caSMauro Carvalho Chehab } 18110c0d06caSMauro Carvalho Chehab 18120c0d06caSMauro Carvalho Chehab static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b) 18130c0d06caSMauro Carvalho Chehab { 18140c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18150c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18160c0d06caSMauro Carvalho Chehab int rc; 18170c0d06caSMauro Carvalho Chehab 18180c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 18190c0d06caSMauro Carvalho Chehab if (rc < 0) 18200c0d06caSMauro Carvalho Chehab return rc; 18210c0d06caSMauro Carvalho Chehab 18220c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 18230c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vidq, b, file->f_flags & 18240c0d06caSMauro Carvalho Chehab O_NONBLOCK); 18250c0d06caSMauro Carvalho Chehab else 18260c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vbiq, b, file->f_flags & 18270c0d06caSMauro Carvalho Chehab O_NONBLOCK); 18280c0d06caSMauro Carvalho Chehab } 18290c0d06caSMauro Carvalho Chehab 18300c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18310c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 18320c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab static int radio_querycap(struct file *file, void *priv, 18350c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 18360c0d06caSMauro Carvalho Chehab { 18370c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18380c0d06caSMauro Carvalho Chehab 18390c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 18400c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 18410c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 18420c0d06caSMauro Carvalho Chehab 18430c0d06caSMauro Carvalho Chehab cap->capabilities = V4L2_CAP_TUNER; 18440c0d06caSMauro Carvalho Chehab return 0; 18450c0d06caSMauro Carvalho Chehab } 18460c0d06caSMauro Carvalho Chehab 18470c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 18480c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18490c0d06caSMauro Carvalho Chehab { 18500c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 18530c0d06caSMauro Carvalho Chehab return -EINVAL; 18540c0d06caSMauro Carvalho Chehab 18550c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 18560c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_RADIO; 18570c0d06caSMauro Carvalho Chehab 18580c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 18590c0d06caSMauro Carvalho Chehab 18600c0d06caSMauro Carvalho Chehab return 0; 18610c0d06caSMauro Carvalho Chehab } 18620c0d06caSMauro Carvalho Chehab 18630c0d06caSMauro Carvalho Chehab static int radio_enum_input(struct file *file, void *priv, 18640c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 18650c0d06caSMauro Carvalho Chehab { 18660c0d06caSMauro Carvalho Chehab if (i->index != 0) 18670c0d06caSMauro Carvalho Chehab return -EINVAL; 18680c0d06caSMauro Carvalho Chehab strcpy(i->name, "Radio"); 18690c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 18700c0d06caSMauro Carvalho Chehab 18710c0d06caSMauro Carvalho Chehab return 0; 18720c0d06caSMauro Carvalho Chehab } 18730c0d06caSMauro Carvalho Chehab 18740c0d06caSMauro Carvalho Chehab static int radio_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 18750c0d06caSMauro Carvalho Chehab { 18760c0d06caSMauro Carvalho Chehab if (unlikely(a->index)) 18770c0d06caSMauro Carvalho Chehab return -EINVAL; 18780c0d06caSMauro Carvalho Chehab 18790c0d06caSMauro Carvalho Chehab strcpy(a->name, "Radio"); 18800c0d06caSMauro Carvalho Chehab return 0; 18810c0d06caSMauro Carvalho Chehab } 18820c0d06caSMauro Carvalho Chehab 18830c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 18840c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18850c0d06caSMauro Carvalho Chehab { 18860c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 18870c0d06caSMauro Carvalho Chehab 18880c0d06caSMauro Carvalho Chehab if (0 != t->index) 18890c0d06caSMauro Carvalho Chehab return -EINVAL; 18900c0d06caSMauro Carvalho Chehab 18910c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 18920c0d06caSMauro Carvalho Chehab 18930c0d06caSMauro Carvalho Chehab return 0; 18940c0d06caSMauro Carvalho Chehab } 18950c0d06caSMauro Carvalho Chehab 18960c0d06caSMauro Carvalho Chehab static int radio_s_audio(struct file *file, void *fh, 18970e8025b9SHans Verkuil const struct v4l2_audio *a) 18980c0d06caSMauro Carvalho Chehab { 18990c0d06caSMauro Carvalho Chehab return 0; 19000c0d06caSMauro Carvalho Chehab } 19010c0d06caSMauro Carvalho Chehab 19020c0d06caSMauro Carvalho Chehab static int radio_s_input(struct file *file, void *fh, unsigned int i) 19030c0d06caSMauro Carvalho Chehab { 19040c0d06caSMauro Carvalho Chehab return 0; 19050c0d06caSMauro Carvalho Chehab } 19060c0d06caSMauro Carvalho Chehab 19070c0d06caSMauro Carvalho Chehab static int radio_queryctrl(struct file *file, void *priv, 19080c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl *qc) 19090c0d06caSMauro Carvalho Chehab { 19100c0d06caSMauro Carvalho Chehab int i; 19110c0d06caSMauro Carvalho Chehab 19120c0d06caSMauro Carvalho Chehab if (qc->id < V4L2_CID_BASE || 19130c0d06caSMauro Carvalho Chehab qc->id >= V4L2_CID_LASTP1) 19140c0d06caSMauro Carvalho Chehab return -EINVAL; 19150c0d06caSMauro Carvalho Chehab 19160c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) { 19170c0d06caSMauro Carvalho Chehab if (qc->id && qc->id == ac97_qctrl[i].id) { 19180c0d06caSMauro Carvalho Chehab memcpy(qc, &(ac97_qctrl[i]), sizeof(*qc)); 19190c0d06caSMauro Carvalho Chehab return 0; 19200c0d06caSMauro Carvalho Chehab } 19210c0d06caSMauro Carvalho Chehab } 19220c0d06caSMauro Carvalho Chehab 19230c0d06caSMauro Carvalho Chehab return -EINVAL; 19240c0d06caSMauro Carvalho Chehab } 19250c0d06caSMauro Carvalho Chehab 19260c0d06caSMauro Carvalho Chehab /* 19270c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 19280c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 19290c0d06caSMauro Carvalho Chehab */ 19300c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 19310c0d06caSMauro Carvalho Chehab { 19320c0d06caSMauro Carvalho Chehab int errCode = 0, radio = 0; 19330c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 19340c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 19350c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 19360c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 19370c0d06caSMauro Carvalho Chehab enum v4l2_field field; 19380c0d06caSMauro Carvalho Chehab 19390c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 19400c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 19410c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 19420c0d06caSMauro Carvalho Chehab break; 19430c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 19440c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 19450c0d06caSMauro Carvalho Chehab break; 19460c0d06caSMauro Carvalho Chehab case VFL_TYPE_RADIO: 19470c0d06caSMauro Carvalho Chehab radio = 1; 19480c0d06caSMauro Carvalho Chehab break; 19490c0d06caSMauro Carvalho Chehab } 19500c0d06caSMauro Carvalho Chehab 19510c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 19520c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 19530c0d06caSMauro Carvalho Chehab dev->users); 19540c0d06caSMauro Carvalho Chehab 19550c0d06caSMauro Carvalho Chehab 19560c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19570c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19580c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 19590c0d06caSMauro Carvalho Chehab if (!fh) { 19600c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 19610c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19620c0d06caSMauro Carvalho Chehab return -ENOMEM; 19630c0d06caSMauro Carvalho Chehab } 19640c0d06caSMauro Carvalho Chehab fh->dev = dev; 19650c0d06caSMauro Carvalho Chehab fh->radio = radio; 19660c0d06caSMauro Carvalho Chehab fh->type = fh_type; 19670c0d06caSMauro Carvalho Chehab filp->private_data = fh; 19680c0d06caSMauro Carvalho Chehab 19690c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 19700c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 19710c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 19720c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 19750c0d06caSMauro Carvalho Chehab some i2c device 19760c0d06caSMauro Carvalho Chehab */ 19770c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 19780c0d06caSMauro Carvalho Chehab 19790c0d06caSMauro Carvalho Chehab } 19800c0d06caSMauro Carvalho Chehab if (fh->radio) { 19810c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 19820c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 19830c0d06caSMauro Carvalho Chehab } 19840c0d06caSMauro Carvalho Chehab 19850c0d06caSMauro Carvalho Chehab dev->users++; 19860c0d06caSMauro Carvalho Chehab 19870c0d06caSMauro Carvalho Chehab if (dev->progressive) 19880c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_NONE; 19890c0d06caSMauro Carvalho Chehab else 19900c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_INTERLACED; 19910c0d06caSMauro Carvalho Chehab 19920c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vidq, &em28xx_video_qops, 19930c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 19940c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VIDEO_CAPTURE, field, 19950c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 19960c0d06caSMauro Carvalho Chehab 19970c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vbiq, &em28xx_vbi_qops, 19980c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 19990c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VBI_CAPTURE, 20000c0d06caSMauro Carvalho Chehab V4L2_FIELD_SEQ_TB, 20010c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 20020c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20030c0d06caSMauro Carvalho Chehab 20040c0d06caSMauro Carvalho Chehab return errCode; 20050c0d06caSMauro Carvalho Chehab } 20060c0d06caSMauro Carvalho Chehab 20070c0d06caSMauro Carvalho Chehab /* 20080c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 20090c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 20100c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 20110c0d06caSMauro Carvalho Chehab */ 20120c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 20130c0d06caSMauro Carvalho Chehab { 20140c0d06caSMauro Carvalho Chehab 20150c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 20160c0d06caSMauro Carvalho Chehab 20170c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 20180c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 20190c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 20200c0d06caSMauro Carvalho Chehab else 20210c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 20220c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 20230c0d06caSMauro Carvalho Chehab } 20240c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 20250c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 20260c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 20270c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 20280c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 20290c0d06caSMauro Carvalho Chehab else 20300c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 20310c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 20320c0d06caSMauro Carvalho Chehab } 20330c0d06caSMauro Carvalho Chehab if (dev->vdev) { 20340c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 20350c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 20360c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 20370c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 20380c0d06caSMauro Carvalho Chehab else 20390c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 20400c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 20410c0d06caSMauro Carvalho Chehab } 20420c0d06caSMauro Carvalho Chehab } 20430c0d06caSMauro Carvalho Chehab 20440c0d06caSMauro Carvalho Chehab /* 20450c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 20460c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 20470c0d06caSMauro Carvalho Chehab * calls and ioctls 20480c0d06caSMauro Carvalho Chehab */ 20490c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 20500c0d06caSMauro Carvalho Chehab { 20510c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 20520c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 20530c0d06caSMauro Carvalho Chehab int errCode; 20540c0d06caSMauro Carvalho Chehab 20550c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 20560c0d06caSMauro Carvalho Chehab 20570c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 20580c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 20590c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vidq); 20600c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 20610c0d06caSMauro Carvalho Chehab } 20620c0d06caSMauro Carvalho Chehab 20630c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 20640c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vbiq); 20650c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 20660c0d06caSMauro Carvalho Chehab } 20670c0d06caSMauro Carvalho Chehab 20680c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 20690c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 20700c0d06caSMauro Carvalho Chehab free the remaining resources */ 20710c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 20720c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 20730cf544a6SFrank Schaefer kfree(dev->alt_max_pkt_size_isoc); 2074e36c92fdSDan Carpenter mutex_unlock(&dev->lock); 20750c0d06caSMauro Carvalho Chehab kfree(dev); 20760c0d06caSMauro Carvalho Chehab kfree(fh); 20770c0d06caSMauro Carvalho Chehab return 0; 20780c0d06caSMauro Carvalho Chehab } 20790c0d06caSMauro Carvalho Chehab 20800c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 20810c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 20820c0d06caSMauro Carvalho Chehab 20830c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 2084afb177e0SFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 20850c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 20860c0d06caSMauro Carvalho Chehab 20870c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 20880c0d06caSMauro Carvalho Chehab dev->alt = 0; 20890c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 20900c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 20910c0d06caSMauro Carvalho Chehab if (errCode < 0) { 20920c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 20930c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 20940c0d06caSMauro Carvalho Chehab } 20950c0d06caSMauro Carvalho Chehab } 20960c0d06caSMauro Carvalho Chehab 20970c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vidq); 20980c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vbiq); 20990c0d06caSMauro Carvalho Chehab kfree(fh); 21000c0d06caSMauro Carvalho Chehab dev->users--; 21010c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21020c0d06caSMauro Carvalho Chehab return 0; 21030c0d06caSMauro Carvalho Chehab } 21040c0d06caSMauro Carvalho Chehab 21050c0d06caSMauro Carvalho Chehab /* 21060c0d06caSMauro Carvalho Chehab * em28xx_v4l2_read() 21070c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 21080c0d06caSMauro Carvalho Chehab */ 21090c0d06caSMauro Carvalho Chehab static ssize_t 21100c0d06caSMauro Carvalho Chehab em28xx_v4l2_read(struct file *filp, char __user *buf, size_t count, 21110c0d06caSMauro Carvalho Chehab loff_t *pos) 21120c0d06caSMauro Carvalho Chehab { 21130c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 21140c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 21150c0d06caSMauro Carvalho Chehab int rc; 21160c0d06caSMauro Carvalho Chehab 21170c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 21180c0d06caSMauro Carvalho Chehab if (rc < 0) 21190c0d06caSMauro Carvalho Chehab return rc; 21200c0d06caSMauro Carvalho Chehab 21210c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21220c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21230c0d06caSMauro Carvalho Chehab /* FIXME: read() is not prepared to allow changing the video 21240c0d06caSMauro Carvalho Chehab resolution while streaming. Seems a bug at em28xx_set_fmt 21250c0d06caSMauro Carvalho Chehab */ 21260c0d06caSMauro Carvalho Chehab 21270c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 21280c0d06caSMauro Carvalho Chehab if (res_locked(dev, EM28XX_RESOURCE_VIDEO)) 21290c0d06caSMauro Carvalho Chehab rc = -EBUSY; 21300c0d06caSMauro Carvalho Chehab else 21310c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vidq, buf, count, pos, 0, 21320c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 21330c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 21340c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VBI)) 21350c0d06caSMauro Carvalho Chehab rc = -EBUSY; 21360c0d06caSMauro Carvalho Chehab else 21370c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vbiq, buf, count, pos, 0, 21380c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 21390c0d06caSMauro Carvalho Chehab } 21400c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21410c0d06caSMauro Carvalho Chehab 21420c0d06caSMauro Carvalho Chehab return rc; 21430c0d06caSMauro Carvalho Chehab } 21440c0d06caSMauro Carvalho Chehab 21450c0d06caSMauro Carvalho Chehab /* 21460c0d06caSMauro Carvalho Chehab * em28xx_poll() 21470c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 21480c0d06caSMauro Carvalho Chehab */ 21490c0d06caSMauro Carvalho Chehab static unsigned int em28xx_poll(struct file *filp, poll_table *wait) 21500c0d06caSMauro Carvalho Chehab { 21510c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 21520c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 21530c0d06caSMauro Carvalho Chehab int rc; 21540c0d06caSMauro Carvalho Chehab 21550c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 21560c0d06caSMauro Carvalho Chehab if (rc < 0) 21570c0d06caSMauro Carvalho Chehab return rc; 21580c0d06caSMauro Carvalho Chehab 21590c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 21600c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VIDEO)) 21610c0d06caSMauro Carvalho Chehab return POLLERR; 21620c0d06caSMauro Carvalho Chehab return videobuf_poll_stream(filp, &fh->vb_vidq, wait); 21630c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 21640c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VBI)) 21650c0d06caSMauro Carvalho Chehab return POLLERR; 21660c0d06caSMauro Carvalho Chehab return videobuf_poll_stream(filp, &fh->vb_vbiq, wait); 21670c0d06caSMauro Carvalho Chehab } else { 21680c0d06caSMauro Carvalho Chehab return POLLERR; 21690c0d06caSMauro Carvalho Chehab } 21700c0d06caSMauro Carvalho Chehab } 21710c0d06caSMauro Carvalho Chehab 21720c0d06caSMauro Carvalho Chehab static unsigned int em28xx_v4l2_poll(struct file *filp, poll_table *wait) 21730c0d06caSMauro Carvalho Chehab { 21740c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 21750c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 21760c0d06caSMauro Carvalho Chehab unsigned int res; 21770c0d06caSMauro Carvalho Chehab 21780c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 21790c0d06caSMauro Carvalho Chehab res = em28xx_poll(filp, wait); 21800c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21810c0d06caSMauro Carvalho Chehab return res; 21820c0d06caSMauro Carvalho Chehab } 21830c0d06caSMauro Carvalho Chehab 21840c0d06caSMauro Carvalho Chehab /* 21850c0d06caSMauro Carvalho Chehab * em28xx_v4l2_mmap() 21860c0d06caSMauro Carvalho Chehab */ 21870c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_mmap(struct file *filp, struct vm_area_struct *vma) 21880c0d06caSMauro Carvalho Chehab { 21890c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 21900c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 21910c0d06caSMauro Carvalho Chehab int rc; 21920c0d06caSMauro Carvalho Chehab 21930c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 21940c0d06caSMauro Carvalho Chehab if (rc < 0) 21950c0d06caSMauro Carvalho Chehab return rc; 21960c0d06caSMauro Carvalho Chehab 21970c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21980c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21990c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 22000c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vidq, vma); 22010c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 22020c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vbiq, vma); 22030c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 22040c0d06caSMauro Carvalho Chehab 22050c0d06caSMauro Carvalho Chehab em28xx_videodbg("vma start=0x%08lx, size=%ld, ret=%d\n", 22060c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_start, 22070c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_end-(unsigned long)vma->vm_start, 22080c0d06caSMauro Carvalho Chehab rc); 22090c0d06caSMauro Carvalho Chehab 22100c0d06caSMauro Carvalho Chehab return rc; 22110c0d06caSMauro Carvalho Chehab } 22120c0d06caSMauro Carvalho Chehab 22130c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22140c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22150c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22160c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 22170c0d06caSMauro Carvalho Chehab .read = em28xx_v4l2_read, 22180c0d06caSMauro Carvalho Chehab .poll = em28xx_v4l2_poll, 22190c0d06caSMauro Carvalho Chehab .mmap = em28xx_v4l2_mmap, 22200c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22210c0d06caSMauro Carvalho Chehab }; 22220c0d06caSMauro Carvalho Chehab 22230c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22240c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22250c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22260c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22270c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 22280c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 22290c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22300c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vbi_cap = vidioc_s_fmt_vbi_cap, 22310c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 22320c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 22330c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 22340c0d06caSMauro Carvalho Chehab .vidioc_cropcap = vidioc_cropcap, 22350c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_sliced_vbi_cap = vidioc_g_fmt_sliced_vbi_cap, 22360c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 22370c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 22380c0d06caSMauro Carvalho Chehab 22390c0d06caSMauro Carvalho Chehab .vidioc_reqbufs = vidioc_reqbufs, 22400c0d06caSMauro Carvalho Chehab .vidioc_querybuf = vidioc_querybuf, 22410c0d06caSMauro Carvalho Chehab .vidioc_qbuf = vidioc_qbuf, 22420c0d06caSMauro Carvalho Chehab .vidioc_dqbuf = vidioc_dqbuf, 22430c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 22440c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 22450c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 22460c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 22470c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 22480c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 22490c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 22500c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 22510c0d06caSMauro Carvalho Chehab .vidioc_queryctrl = vidioc_queryctrl, 22520c0d06caSMauro Carvalho Chehab .vidioc_g_ctrl = vidioc_g_ctrl, 22530c0d06caSMauro Carvalho Chehab .vidioc_s_ctrl = vidioc_s_ctrl, 22540c0d06caSMauro Carvalho Chehab .vidioc_streamon = vidioc_streamon, 22550c0d06caSMauro Carvalho Chehab .vidioc_streamoff = vidioc_streamoff, 22560c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 22570c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 22580c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22590c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 22600c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 22610c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 22620c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 22630c0d06caSMauro Carvalho Chehab .vidioc_g_chip_ident = vidioc_g_chip_ident, 22640c0d06caSMauro Carvalho Chehab #endif 22650c0d06caSMauro Carvalho Chehab }; 22660c0d06caSMauro Carvalho Chehab 22670c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 22680c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 22690c0d06caSMauro Carvalho Chehab .release = video_device_release, 22700c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 22710c0d06caSMauro Carvalho Chehab 22720c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 22730c0d06caSMauro Carvalho Chehab .current_norm = V4L2_STD_PAL, 22740c0d06caSMauro Carvalho Chehab }; 22750c0d06caSMauro Carvalho Chehab 22760c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 22770c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22780c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22790c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 22800c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22810c0d06caSMauro Carvalho Chehab }; 22820c0d06caSMauro Carvalho Chehab 22830c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 22840c0d06caSMauro Carvalho Chehab .vidioc_querycap = radio_querycap, 22850c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 22860c0d06caSMauro Carvalho Chehab .vidioc_enum_input = radio_enum_input, 22870c0d06caSMauro Carvalho Chehab .vidioc_g_audio = radio_g_audio, 22880c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 22890c0d06caSMauro Carvalho Chehab .vidioc_s_audio = radio_s_audio, 22900c0d06caSMauro Carvalho Chehab .vidioc_s_input = radio_s_input, 22910c0d06caSMauro Carvalho Chehab .vidioc_queryctrl = radio_queryctrl, 22920c0d06caSMauro Carvalho Chehab .vidioc_g_ctrl = vidioc_g_ctrl, 22930c0d06caSMauro Carvalho Chehab .vidioc_s_ctrl = vidioc_s_ctrl, 22940c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22950c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 22960c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 22970c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 22980c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 22990c0d06caSMauro Carvalho Chehab #endif 23000c0d06caSMauro Carvalho Chehab }; 23010c0d06caSMauro Carvalho Chehab 23020c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23030c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 23040c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23050c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 23060c0d06caSMauro Carvalho Chehab }; 23070c0d06caSMauro Carvalho Chehab 23080c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23090c0d06caSMauro Carvalho Chehab 23100c0d06caSMauro Carvalho Chehab 23110c0d06caSMauro Carvalho Chehab 23120c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 23130c0d06caSMauro Carvalho Chehab const struct video_device *template, 23140c0d06caSMauro Carvalho Chehab const char *type_name) 23150c0d06caSMauro Carvalho Chehab { 23160c0d06caSMauro Carvalho Chehab struct video_device *vfd; 23170c0d06caSMauro Carvalho Chehab 23180c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 23190c0d06caSMauro Carvalho Chehab if (NULL == vfd) 23200c0d06caSMauro Carvalho Chehab return NULL; 23210c0d06caSMauro Carvalho Chehab 23220c0d06caSMauro Carvalho Chehab *vfd = *template; 23230c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 23240c0d06caSMauro Carvalho Chehab vfd->release = video_device_release; 23250c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 23260c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 23270c0d06caSMauro Carvalho Chehab 23280c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 23290c0d06caSMauro Carvalho Chehab dev->name, type_name); 23300c0d06caSMauro Carvalho Chehab 23310c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 23320c0d06caSMauro Carvalho Chehab return vfd; 23330c0d06caSMauro Carvalho Chehab } 23340c0d06caSMauro Carvalho Chehab 23350c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 23360c0d06caSMauro Carvalho Chehab { 23370c0d06caSMauro Carvalho Chehab u8 val; 23380c0d06caSMauro Carvalho Chehab int ret; 23390c0d06caSMauro Carvalho Chehab unsigned int maxw; 23400c0d06caSMauro Carvalho Chehab 23410c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 23420c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 23430c0d06caSMauro Carvalho Chehab 23440c0d06caSMauro Carvalho Chehab /* set default norm */ 23450c0d06caSMauro Carvalho Chehab dev->norm = em28xx_video_template.current_norm; 23460c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 23470c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 23480c0d06caSMauro Carvalho Chehab 23490c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 23500c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 23510c0d06caSMauro Carvalho Chehab 23520c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 23530c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 23540c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 23550c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 23560c0d06caSMauro Carvalho Chehab maxw /= 2; 23570c0d06caSMauro Carvalho Chehab 23580c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 23590c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 23600c0d06caSMauro Carvalho Chehab 23610c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 23620c0d06caSMauro Carvalho Chehab 23630c0d06caSMauro Carvalho Chehab /* Audio defaults */ 23640c0d06caSMauro Carvalho Chehab dev->mute = 1; 23650c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 23660c0d06caSMauro Carvalho Chehab 23670c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 23680c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 23690c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 23700c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 23710c0d06caSMauro Carvalho Chehab 23720c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 23730c0d06caSMauro Carvalho Chehab em28xx_colorlevels_set_default(dev); 23740c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 23750c0d06caSMauro Carvalho Chehab 23760c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 23770c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 23780c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 23790c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 23800c0d06caSMauro Carvalho Chehab return -ENODEV; 23810c0d06caSMauro Carvalho Chehab } 23820c0d06caSMauro Carvalho Chehab 23830c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 23840c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 23850c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 23860c0d06caSMauro Carvalho Chehab if (ret) { 23870c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 23880c0d06caSMauro Carvalho Chehab ret); 23890c0d06caSMauro Carvalho Chehab return ret; 23900c0d06caSMauro Carvalho Chehab } 23910c0d06caSMauro Carvalho Chehab 23920c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 23930c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 23940c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 23950c0d06caSMauro Carvalho Chehab "vbi"); 23960c0d06caSMauro Carvalho Chehab 23970c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 23980c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 23990c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 24000c0d06caSMauro Carvalho Chehab if (ret < 0) { 24010c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 24020c0d06caSMauro Carvalho Chehab return ret; 24030c0d06caSMauro Carvalho Chehab } 24040c0d06caSMauro Carvalho Chehab } 24050c0d06caSMauro Carvalho Chehab 24060c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 24070c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 24080c0d06caSMauro Carvalho Chehab "radio"); 24090c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 24100c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 24110c0d06caSMauro Carvalho Chehab return -ENODEV; 24120c0d06caSMauro Carvalho Chehab } 24130c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 24140c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 24150c0d06caSMauro Carvalho Chehab if (ret < 0) { 24160c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 24170c0d06caSMauro Carvalho Chehab return ret; 24180c0d06caSMauro Carvalho Chehab } 24190c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 24200c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 24210c0d06caSMauro Carvalho Chehab } 24220c0d06caSMauro Carvalho Chehab 24230c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 24240c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 24250c0d06caSMauro Carvalho Chehab 24260c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 24270c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 24280c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 24290c0d06caSMauro Carvalho Chehab 24300c0d06caSMauro Carvalho Chehab return 0; 24310c0d06caSMauro Carvalho Chehab } 2432