vpif_display.c revision 64dc3c1a906467d90c24913b0b38dd13d9378f4f
1e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 2e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif-display - VPIF display driver 3e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * Display driver for TI DaVinci VPIF 4e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * 5e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * Copyright (C) 2009 Texas Instruments Incorporated - http://www.ti.com/ 6e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * 7e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * This program is free software; you can redistribute it and/or 8e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * modify it under the terms of the GNU General Public License as 9e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * published by the Free Software Foundation version 2. 10e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * 11e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * This program is distributed .as is. WITHOUT ANY WARRANTY of any 12e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * kind, whether express or implied; without even the implied warranty 13e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * GNU General Public License for more details. 15e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 16e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 17e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/kernel.h> 18e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/init.h> 19e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/module.h> 20e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/errno.h> 21e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/fs.h> 22e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/mm.h> 23e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/interrupt.h> 24e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/workqueue.h> 25e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/string.h> 26e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/videodev2.h> 27e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/wait.h> 28e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/time.h> 29e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/i2c.h> 30e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/platform_device.h> 31e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/io.h> 325a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 33e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 34e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <asm/irq.h> 35e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <asm/page.h> 36e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 37e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/adv7343.h> 38e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/v4l2-device.h> 39e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/v4l2-ioctl.h> 407036d6a73c88428764e4a12f30846279346f4382Mats Randgaard#include <media/v4l2-chip-ident.h> 41e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 42e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <mach/dm646x.h> 43e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 44e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include "vpif_display.h" 45e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include "vpif.h" 46e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 47e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_DESCRIPTION("TI DaVinci VPIF Display driver"); 48e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_LICENSE("GPL"); 4964dc3c1a906467d90c24913b0b38dd13d9378f4fMauro Carvalho ChehabMODULE_VERSION(VPIF_DISPLAY_VERSION); 50e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 51e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define DM646X_V4L2_STD (V4L2_STD_525_60 | V4L2_STD_625_50) 52e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 53e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define vpif_err(fmt, arg...) v4l2_err(&vpif_obj.v4l2_dev, fmt, ## arg) 54e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define vpif_dbg(level, debug, fmt, arg...) \ 55e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_dbg(level, debug, &vpif_obj.v4l2_dev, fmt, ## arg) 56e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 57e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int debug = 1; 58e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch2_numbuffers = 3; 59e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch3_numbuffers = 3; 60e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch2_bufsize = 1920 * 1080 * 2; 61e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch3_bufsize = 720 * 576 * 2; 62e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 63e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(debug, int, 0644); 64e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch2_numbuffers, uint, S_IRUGO); 65e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch3_numbuffers, uint, S_IRUGO); 66e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch2_bufsize, uint, S_IRUGO); 67e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch3_bufsize, uint, S_IRUGO); 68e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 69e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(debug, "Debug level 0-1"); 70e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch2_numbuffers, "Channel2 buffer count (default:3)"); 71e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch3_numbuffers, "Channel3 buffer count (default:3)"); 72e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch2_bufsize, "Channel2 buffer size (default:1920 x 1080 x 2)"); 73e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch3_bufsize, "Channel3 buffer size (default:720 x 576 x 2)"); 74e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 75e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct vpif_config_params config_params = { 76e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_numbuffers = 3, 77e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .numbuffers[0] = 3, 78e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .numbuffers[1] = 3, 79e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_bufsize[0] = 720 * 480 * 2, 80e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_bufsize[1] = 720 * 480 * 2, 81e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .channel_bufsize[0] = 1920 * 1080 * 2, 82e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .channel_bufsize[1] = 720 * 576 * 2, 83e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 84e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 85e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct vpif_device vpif_obj = { {NULL} }; 86e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct device *vpif_dev; 87e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 88e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 89e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_uservirt_to_phys: This function is used to convert user 90e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * space virtual address to physical address. 91e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 92e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 vpif_uservirt_to_phys(u32 virtp) 93e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 94e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct mm_struct *mm = current->mm; 95e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long physp = 0; 96e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vm_area_struct *vma; 97e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 98e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vma = find_vma(mm, virtp); 99e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 100e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* For kernel direct-mapped memory, take the easy way */ 101e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (virtp >= PAGE_OFFSET) { 102e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = virt_to_phys((void *)virtp); 103e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (vma && (vma->vm_flags & VM_IO) && (vma->vm_pgoff)) { 104e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* this will catch, kernel-allocated, mmaped-to-usermode addr */ 105e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = (vma->vm_pgoff << PAGE_SHIFT) + (virtp - vma->vm_start); 106e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 107e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* otherwise, use get_user_pages() for general userland pages */ 108e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int res, nr_pages = 1; 109e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct page *pages; 110e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S down_read(¤t->mm->mmap_sem); 111e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 112e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S res = get_user_pages(current, current->mm, 113e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S virtp, nr_pages, 1, 0, &pages, NULL); 114e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S up_read(¤t->mm->mmap_sem); 115e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 116e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (res == nr_pages) { 117e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = __pa(page_address(&pages[0]) + 118e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (virtp & ~PAGE_MASK)); 119e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 120e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("get_user_pages failed\n"); 121e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 122e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 123e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 124e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 125e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return physp; 126e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 127e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 128e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 129e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * buffer_prepare: This is the callback function called from videobuf_qbuf() 130e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * function the buffer is prepared and user space virtual address is converted 131e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * into physical address 132e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 133e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_buffer_prepare(struct videobuf_queue *q, 134e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb, 135e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field) 136e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 137e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 138e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 139e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr; 140e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 141e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &fh->channel->common[VPIF_VIDEO_INDEX]; 142e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VIDEOBUF_NEEDS_INIT == vb->state) { 143e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->width = common->width; 144e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->height = common->height; 145e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->size = vb->width * vb->height; 146e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->field = field; 147e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 148e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_PREPARED; 149e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 150e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* if user pointer memory mechanism is used, get the physical 151e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * address of the buffer */ 152e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) { 153e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vb->baddr) { 154e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer_address is 0\n"); 155e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 156e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 157e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 158e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->boff = vpif_uservirt_to_phys(vb->baddr); 159e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(vb->boff)) 160e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto buf_align_exit; 161e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 162e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 163e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = vb->boff; 164e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (q->streaming && (V4L2_BUF_TYPE_SLICED_VBI_OUTPUT != q->type)) { 165e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(addr + common->ytop_off) || 166e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->ybtm_off) || 167e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->ctop_off) || 168e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->cbtm_off)) 169e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto buf_align_exit; 170e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 171e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 172e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 173e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sbuf_align_exit: 174e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer offset not aligned to 8 bytes\n"); 175e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 176e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 177e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 178e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 179e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_setup: This function allocates memory for the buffers 180e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 181e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_buffer_setup(struct videobuf_queue *q, unsigned int *count, 182e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int *size) 183e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 184e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 185e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 186e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 187e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 188e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_MMAP != common->memory) 189e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 190e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 191e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *size = config_params.channel_bufsize[ch->channel_id]; 192e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (*count < config_params.min_numbuffers) 193e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *count = config_params.min_numbuffers; 194e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 195e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 196e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 197e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 198e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 199e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_queue: This function adds the buffer to DMA queue 200e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 201e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_buffer_queue(struct videobuf_queue *q, 202e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb) 203e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 204e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 205e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 206e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 207e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &fh->channel->common[VPIF_VIDEO_INDEX]; 208e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 209e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* add the buffer to the DMA queue */ 210e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_add_tail(&vb->queue, &common->dma_queue); 211e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_QUEUED; 212e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 213e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 214e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 215e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_release: This function is called from the videobuf layer to 216e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * free memory allocated to the buffers 217e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 218e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_buffer_release(struct videobuf_queue *q, 219e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb) 220e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 221e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 222e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 223e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 224e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int buf_size = 0; 225e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 226e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[VPIF_VIDEO_INDEX]; 227e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 228e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_dma_contig_free(q, vb); 229e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_NEEDS_INIT; 230e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 231e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_MMAP != common->memory) 232e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 233e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 234e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf_size = config_params.channel_bufsize[ch->channel_id]; 235e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 236e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 237e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct videobuf_queue_ops video_qops = { 238e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_setup = vpif_buffer_setup, 239e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_prepare = vpif_buffer_prepare, 240e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_queue = vpif_buffer_queue, 241e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_release = vpif_buffer_release, 242e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 243e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u8 channel_first_int[VPIF_NUMOBJECTS][2] = { {1, 1} }; 244e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 245e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void process_progressive_mode(struct common_obj *common) 246e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 247e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 248e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 249e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the next buffer from buffer queue */ 250e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = list_entry(common->dma_queue.next, 251e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer, queue); 252e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Remove that buffer from the buffer queue */ 253e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_del(&common->next_frm->queue); 254e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark status of the buffer as active */ 255e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm->state = VIDEOBUF_ACTIVE; 256e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 257e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set top and bottom field addrs in VPIF registers */ 258e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = videobuf_to_dma_contig(common->next_frm); 259e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr(addr + common->ytop_off, 260e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->ybtm_off, 261e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->ctop_off, 262e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->cbtm_off); 263e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 264e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 265e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void process_interlaced_mode(int fid, struct common_obj *common) 266e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 267e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* device field id and local field id are in sync */ 268e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If this is even field */ 269e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == fid) { 270e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->cur_frm == common->next_frm) 271e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 272e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 273e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* one frame is displayed If next frame is 274e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * available, release cur_frm and move on */ 275e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Copy frame display time */ 276e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S do_gettimeofday(&common->cur_frm->ts); 277e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Change status of the cur_frm */ 278e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_DONE; 279e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* unlock semaphore on cur_frm */ 280e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S wake_up_interruptible(&common->cur_frm->done); 281e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make cur_frm pointing to next_frm */ 282e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm; 283e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 284e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (1 == fid) { /* odd field */ 285e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue) 286e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (common->cur_frm != common->next_frm)) { 287e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 288e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 289e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* one field is displayed configure the next 290e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frame if it is available else hold on current 291e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frame */ 292e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get next from the buffer queue */ 293e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_progressive_mode(common); 294e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 295e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 296e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 297e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 298e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 299e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_channel_isr: It changes status of the displayed buffer, takes next 300e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * buffer from the queue and sets its address in VPIF registers 301e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 302e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic irqreturn_t vpif_channel_isr(int irq, void *dev_id) 303e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 304e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_device *dev = &vpif_obj; 305e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 306e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 307e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field; 308e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int fid = -1, i; 309e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int channel_id = 0; 310e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 311e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_id = *(int *)(dev_id); 312e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = dev->dev[channel_id]; 313e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = ch->common[VPIF_VIDEO_INDEX].fmt.fmt.pix.field; 314e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_NUMOBJECTS; i++) { 315e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[i]; 316e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If streaming is started in this channel */ 317e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == common->started) 318e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 319e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 320e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (1 == ch->vpifparams.std_info.frm_fmt) { 321e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue)) 322e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 323e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 324e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Progressive mode */ 325e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!channel_first_int[i][channel_id]) { 326e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark status of the cur_frm to 327e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * done and unlock semaphore on it */ 328e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S do_gettimeofday(&common->cur_frm->ts); 329e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_DONE; 330e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S wake_up_interruptible(&common->cur_frm->done); 331e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make cur_frm pointing to next_frm */ 332e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm; 333e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 334e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 335e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[i][channel_id] = 0; 336e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_progressive_mode(common); 337e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 338e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Interlaced mode */ 339e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If it is first interrupt, ignore it */ 340e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 341e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (channel_first_int[i][channel_id]) { 342e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[i][channel_id] = 0; 343e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 344e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 345e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 346e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == i) { 347e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id ^= 1; 348e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get field id from VPIF registers */ 349e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fid = vpif_channel_getfid(ch->channel_id + 2); 350e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If fid does not match with stored field id */ 351e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fid != ch->field_id) { 352e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make them in sync */ 353e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == fid) 354e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id = fid; 355e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 356e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return IRQ_HANDLED; 357e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 358e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 359e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_interlaced_mode(fid, common); 360e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 361e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 362e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 363e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return IRQ_HANDLED; 364e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 365e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 366c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaardstatic int vpif_update_std_info(struct channel_obj *ch) 367e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 368e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 369e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpifparams = &ch->vpifparams; 370e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_channel_config_params *std_info = &vpifparams->std_info; 371e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S const struct vpif_channel_config_params *config; 372e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 373c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard int i; 374e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 375c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard for (i = 0; i < vpif_ch_params_count; i++) { 376c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard config = &ch_params[i]; 37740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (config->hd_sd == 0) { 37840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard vpif_dbg(2, debug, "SD format\n"); 37940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (config->stdid & vid_ch->stdid) { 38040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard memcpy(std_info, config, sizeof(*config)); 38140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard break; 38240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } 38340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } else { 38440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard vpif_dbg(2, debug, "HD format\n"); 38540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (config->dv_preset == vid_ch->dv_preset) { 38640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard memcpy(std_info, config, sizeof(*config)); 38740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard break; 38840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } 389e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 390e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 391e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 392c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (i == vpif_ch_params_count) { 393c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(1, debug, "Format not found\n"); 394aa4444063505983c5971bc8fb832385dfba16b41Mats Randgaard return -EINVAL; 395c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 396c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 397c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return 0; 398c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard} 399c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 400c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaardstatic int vpif_update_resolution(struct channel_obj *ch) 401c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard{ 402c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 403c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct video_obj *vid_ch = &ch->video; 404c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_params *vpifparams = &ch->vpifparams; 405c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_channel_config_params *std_info = &vpifparams->std_info; 406c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 407c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (!vid_ch->stdid && !vid_ch->dv_preset && !vid_ch->bt_timings.height) 408c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 409c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 410c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (vid_ch->stdid || vid_ch->dv_preset) { 411c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (vpif_update_std_info(ch)) 412c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 413c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 414e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 415e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.width = std_info->width; 416e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.height = std_info->height; 417e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Pixel details: Width = %d,Height = %d\n", 418e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.width, common->fmt.fmt.pix.height); 419e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 420e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set height and width paramateres */ 421c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard common->height = std_info->height; 422c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard common->width = std_info->width; 423e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 424e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 425e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 426e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 427e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 428e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_calculate_offsets: This function calculates buffers offset for Y and C 429e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * in the top and bottom field 430e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 431e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_calculate_offsets(struct channel_obj *ch) 432e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 433e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 434e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpifparams = &ch->vpifparams; 435e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field = common->fmt.fmt.pix.field; 436e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 437e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int hpitch, vpitch, sizeimage; 438e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 439e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_FIELD_ANY == common->fmt.fmt.pix.field) { 440e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch->vpifparams.std_info.frm_fmt) 441e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = V4L2_FIELD_NONE; 442e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 443e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = V4L2_FIELD_INTERLACED; 444e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 445e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = common->fmt.fmt.pix.field; 446e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 447e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 448e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) 449e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = common->fmt.fmt.pix.sizeimage; 450e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 451e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = config_params.channel_bufsize[ch->channel_id]; 452e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 453e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S hpitch = common->fmt.fmt.pix.bytesperline; 454e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpitch = sizeimage / (hpitch * 2); 455e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((V4L2_FIELD_NONE == vid_ch->buf_field) || 456e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (V4L2_FIELD_INTERLACED == vid_ch->buf_field)) { 457e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = 0; 458e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = hpitch; 459e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = sizeimage / 2; 460e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = sizeimage / 2 + hpitch; 461e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (V4L2_FIELD_SEQ_TB == vid_ch->buf_field) { 462e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = 0; 463e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = sizeimage / 4; 464e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = sizeimage / 2; 465e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = common->ctop_off + sizeimage / 4; 466e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (V4L2_FIELD_SEQ_BT == vid_ch->buf_field) { 467e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = 0; 468e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = sizeimage / 4; 469e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = sizeimage / 2; 470e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = common->cbtm_off + sizeimage / 4; 471e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 472e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 473e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((V4L2_FIELD_NONE == vid_ch->buf_field) || 474e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (V4L2_FIELD_INTERLACED == vid_ch->buf_field)) { 475e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.storage_mode = 1; 476e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 477e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.storage_mode = 0; 478e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 479e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 480e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch->vpifparams.std_info.frm_fmt == 1) { 481e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 482e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline; 483e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 484e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((field == V4L2_FIELD_ANY) || 485e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (field == V4L2_FIELD_INTERLACED)) 486e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 487e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline * 2; 488e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 489e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 490e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline; 491e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 492e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 493e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.video_params.stdid = ch->vpifparams.std_info.stdid; 494e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 495e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 496e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_config_format(struct channel_obj *ch) 497e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 498e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 499e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 500e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.field = V4L2_FIELD_ANY; 501e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (config_params.numbuffers[ch->channel_id] == 0) 502e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = V4L2_MEMORY_USERPTR; 503e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 504e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = V4L2_MEMORY_MMAP; 505e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 506e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.sizeimage = 507e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[ch->channel_id]; 508e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUV422P; 509e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.type = V4L2_BUF_TYPE_VIDEO_OUTPUT; 510e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 511e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 512e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_check_format(struct channel_obj *ch, 513e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt) 514e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 515e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 516e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field = pixfmt->field; 517e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S u32 sizeimage, hpitch, vpitch; 518e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 519e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (pixfmt->pixelformat != V4L2_PIX_FMT_YUV422P) 520e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_fmt_exit; 521e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 522e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(VPIF_VALID_FIELD(field))) 523e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_fmt_exit; 524e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 525e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (pixfmt->bytesperline <= 0) 526e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_pitch_exit; 527e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 528e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) 529e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = pixfmt->sizeimage; 530e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 531e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = config_params.channel_bufsize[ch->channel_id]; 532e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 533c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (vpif_update_resolution(ch)) 534e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 535e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 536e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S hpitch = pixfmt->bytesperline; 537e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpitch = sizeimage / (hpitch * 2); 538e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 539e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for valid value of pitch */ 540e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((hpitch < ch->vpifparams.std_info.width) || 541e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (vpitch < ch->vpifparams.std_info.height)) 542e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_pitch_exit; 543e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 544e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for 8 byte alignment */ 545e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(hpitch)) { 546e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid pitch alignment\n"); 547e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 548e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 549e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->width = common->fmt.fmt.pix.width; 550e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->height = common->fmt.fmt.pix.height; 551e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 552e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 553e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 554e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sinvalid_fmt_exit: 555e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid field format\n"); 556e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 557e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 558e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sinvalid_pitch_exit: 559e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid pitch\n"); 560e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 561e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 562e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 563e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_config_addr(struct channel_obj *ch, int muxmode) 564e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 565e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 566e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 567e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL3_VIDEO == ch->channel_id) { 568e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch3_set_videobuf_addr; 569e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 570e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (2 == muxmode) 571e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch2_set_videobuf_addr_yc_nmux; 572e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 573e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch2_set_videobuf_addr; 574e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 575e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 576e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 577e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 578e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_mmap: It is used to map kernel space buffers into user spaces 579e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 580e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_mmap(struct file *filep, struct vm_area_struct *vma) 581e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 582e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 5832c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard struct channel_obj *ch = fh->channel; 5842c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard struct common_obj *common = &(ch->common[VPIF_VIDEO_INDEX]); 5852c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard 5862c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard vpif_dbg(2, debug, "vpif_mmap\n"); 587e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 588e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_mmap_mapper(&common->buffer_queue, vma); 589e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 590e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 591e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 592e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_poll: It is used for select/poll system call 593e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 594e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic unsigned int vpif_poll(struct file *filep, poll_table *wait) 595e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 596e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 597e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 598e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 599e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 600e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) 601e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_poll_stream(filep, &common->buffer_queue, wait); 602e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 603e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 604e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 605e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 606e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 607e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_open: It creates object of file handle structure and stores it in 608e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * private_data member of filepointer 609e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 610e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_open(struct file *filep) 611e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 612e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_device *vdev = video_devdata(filep); 613e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = NULL; 614e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = NULL; 615e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 616e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = video_get_drvdata(vdev); 617e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for the file handle object */ 6181f8766b4e3f06c2206e7ff48da72d2886672759aMats Randgaard fh = kzalloc(sizeof(struct vpif_fh), GFP_KERNEL); 619e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh == NULL) { 620e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("unable to allocate memory for file handle object\n"); 621e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -ENOMEM; 622e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 623e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 624e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store pointer to fh in private_data member of filep */ 625e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S filep->private_data = fh; 626e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->channel = ch; 627e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 0; 628e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ch->initialized) { 629e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 1; 630e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 1; 631e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&ch->vpifparams, 0, sizeof(ch->vpifparams)); 632e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 633e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 634e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Increment channel usrs counter */ 635e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_inc(&ch->usrs); 636e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set io_allowed[VPIF_VIDEO_INDEX] member to false */ 637e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->io_allowed[VPIF_VIDEO_INDEX] = 0; 638e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize priority of this instance to default priority */ 639e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->prio = V4L2_PRIORITY_UNSET; 640e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_prio_open(&ch->prio, &fh->prio); 641e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 642e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 643e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 644e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 645e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 646e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_release: This function deletes buffer queue, frees the buffers and 647e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * the vpif file handle 648e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 649e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_release(struct file *filep) 650e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 651e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 652e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 653e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 654e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 655e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* if this instance is doing IO */ 656e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh->io_allowed[VPIF_VIDEO_INDEX]) { 657e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Reset io_usrs member of channel object */ 658e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 0; 659e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Disable channel */ 660e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 661e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(0); 662e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(0); 663e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 664e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) || 665e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (2 == common->started)) { 666e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(0); 667e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(0); 668e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 669e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 670e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Free buffers allocated */ 671e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_queue_cancel(&common->buffer_queue); 672e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_mmap_free(&common->buffer_queue); 673e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = 674e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[ch->channel_id]; 675e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 676e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 677e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Decrement channel usrs counter */ 678e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_dec(&ch->usrs); 679e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If this file handle has initialize encoder device, reset it */ 680e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh->initialized) 681e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 0; 682e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 683e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Close the priority */ 684ffb4877ba013f94322083f77cbb05b35c2a218aaHans Verkuil v4l2_prio_close(&ch->prio, fh->prio); 685e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S filep->private_data = NULL; 686e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 0; 687e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(fh); 688e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 689e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 690e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 691e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 692e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* functions implementing ioctls */ 6932c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard/** 6942c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard * vpif_querycap() - QUERYCAP handler 6952c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard * @file: file ptr 6962c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard * @priv: file handle 6972c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard * @cap: ptr to v4l2_capability structure 6982c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard */ 699e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_querycap(struct file *file, void *priv, 700e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_capability *cap) 701e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 702317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config = vpif_dev->platform_data; 703e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 704e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S cap->capabilities = V4L2_CAP_VIDEO_OUTPUT | V4L2_CAP_STREAMING; 705e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->driver, "vpif display", sizeof(cap->driver)); 706e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->bus_info, "Platform", sizeof(cap->bus_info)); 707e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->card, config->card_name, sizeof(cap->card)); 708e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 709e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 710e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 711e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 712e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_enum_fmt_vid_out(struct file *file, void *priv, 713e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_fmtdesc *fmt) 714e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 715e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fmt->index != 0) { 716e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Invalid format index\n"); 717e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 718e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 719e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 720e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Fill in the information about format */ 721e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fmt->type = V4L2_BUF_TYPE_VIDEO_OUTPUT; 722e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strcpy(fmt->description, "YCbCr4:2:2 YC Planar"); 723e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fmt->pixelformat = V4L2_PIX_FMT_YUV422P; 724e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 725e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 726e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 727e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 728e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_fmt_vid_out(struct file *file, void *priv, 729e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 730e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 731e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 732e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 733e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 734e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 735e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check the validity of the buffer type */ 736e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != fmt->type) 737e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 738e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 739c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (vpif_update_resolution(ch)) 7409bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EINVAL; 7419bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil *fmt = common->fmt; 7429bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return 0; 743e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 744e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 745e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_fmt_vid_out(struct file *file, void *priv, 746e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 747e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 748e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 749e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt; 750e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 751e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 752e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 753e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 754e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL2_VIDEO == ch->channel_id) 755e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (VPIF_CHANNEL3_VIDEO == ch->channel_id)) { 756e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->initialized) { 757e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Channel Busy\n"); 758e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 759e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 760e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 761e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for the priority */ 762ffb4877ba013f94322083f77cbb05b35c2a218aaHans Verkuil ret = v4l2_prio_check(&ch->prio, fh->prio); 763e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 != ret) 764e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 765e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 1; 766e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 767e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 768e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 769e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Streaming in progress\n"); 770e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 771e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 772e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 773e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt = &fmt->fmt.pix; 774e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for valid field format */ 775e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, pixfmt); 776e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret) 777e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 778e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 779e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store the pix format in the channel object */ 780e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix = *pixfmt; 781e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store the format in the channel object */ 782e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt = *fmt; 783e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 784e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 785e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 786e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_try_fmt_vid_out(struct file *file, void *priv, 787e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 788e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 789e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 790e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 791e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 792e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt = &fmt->fmt.pix; 793e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 794e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 795e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, pixfmt); 796e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret) { 797e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *pixfmt = common->fmt.fmt.pix; 798e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->sizeimage = pixfmt->width * pixfmt->height * 2; 799e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 800e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 801e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 802e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 803e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 804e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_reqbufs(struct file *file, void *priv, 805e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_requestbuffers *reqbuf) 806e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 807e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 808e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 809e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 810e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field; 811e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S u8 index = 0; 812e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 813e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* This file handle has not initialized the channel, 814e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S It is not allowed to do settings */ 815e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL2_VIDEO == ch->channel_id) 816e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (VPIF_CHANNEL3_VIDEO == ch->channel_id)) { 817e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->initialized) { 818e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Channel Busy\n"); 819e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 820e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 821e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 822e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 823e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_BUF_TYPE_VIDEO_OUTPUT != reqbuf->type) 824e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 825e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 826e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S index = VPIF_VIDEO_INDEX; 827e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 828e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[index]; 82913df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 8309bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil if (common->fmt.type != reqbuf->type) 8319bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EINVAL; 832e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 8339bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil if (0 != common->io_usrs) 8349bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EBUSY; 835e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 836e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (reqbuf->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 837e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.fmt.pix.field == V4L2_FIELD_ANY) 838e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = V4L2_FIELD_INTERLACED; 839e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 840e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = common->fmt.fmt.pix.field; 841e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 842e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = V4L2_VBI_INTERLACED; 843e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 844e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 845e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize videobuf queue as per the buffer type */ 846e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_queue_dma_contig_init(&common->buffer_queue, 847e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S &video_qops, NULL, 848e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S &common->irqlock, 849e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S reqbuf->type, field, 850e3cfd447d01cf723ccda0ad6bfa2e85b73d3d747Hans Verkuil sizeof(struct videobuf_buffer), fh, 8519bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil &common->lock); 852e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 853e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set io allowed member of file handle to TRUE */ 854e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->io_allowed[index] = 1; 855e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Increment io usrs member of channel object to 1 */ 856e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 1; 857e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Store type of memory requested in channel object */ 858e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = reqbuf->memory; 859e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S INIT_LIST_HEAD(&common->dma_queue); 860e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 861e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate buffers */ 8629bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return videobuf_reqbufs(&common->buffer_queue, reqbuf); 863e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 864e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 865e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_querybuf(struct file *file, void *priv, 866e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_buffer *tbuf) 867e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 868e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 869e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 870e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 871e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 872e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != tbuf->type) 873e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 874e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 875e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_querybuf(&common->buffer_queue, tbuf); 876e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 877e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 878e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf) 879e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 880e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 881e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 882e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 883e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 884e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_buffer tbuf = *buf; 885e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *buf1; 886e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 887e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long flags; 888e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 889e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 890e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != tbuf.type) 891e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 892e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 893e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 894e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 895e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 896e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 897e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 898e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(list_empty(&common->dma_queue)) || 899e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (common->cur_frm != common->next_frm) || 900e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !(common->started) || 901e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (common->started && (0 == ch->field_id))) 902e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_qbuf(&common->buffer_queue, buf); 903e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 904e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* bufferqueue is empty store buffer address in VPIF registers */ 905e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_lock(&common->buffer_queue.vb_lock); 906e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1 = common->buffer_queue.bufs[tbuf.index]; 907e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buf1->memory != tbuf.memory) { 908e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid buffer type\n"); 909e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 910e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 911e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 912e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((buf1->state == VIDEOBUF_QUEUED) || 913e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (buf1->state == VIDEOBUF_ACTIVE)) { 914e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid state\n"); 915e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 916e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 917e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 918e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S switch (buf1->memory) { 919e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S case V4L2_MEMORY_MMAP: 920e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buf1->baddr == 0) 921e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 922e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S break; 923e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 924e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S case V4L2_MEMORY_USERPTR: 925e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (tbuf.length < buf1->bsize) 926e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 927e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 928e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VIDEOBUF_NEEDS_INIT != buf1->state) 929473d80247332b818caf6d25ed3eaaa10d3dfcfb7Julia Lawall && (buf1->baddr != tbuf.m.userptr)) { 930e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_buffer_release(&common->buffer_queue, buf1); 931e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1->baddr = tbuf.m.userptr; 932473d80247332b818caf6d25ed3eaaa10d3dfcfb7Julia Lawall } 933e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S break; 934e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 935e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S default: 936e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 937e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 938e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 939e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_save(flags); 940e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_buffer_prepare(&common->buffer_queue, buf1, 941e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->buffer_queue.field); 942e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 943e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_restore(flags); 944e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 945e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 946e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 947e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1->state = VIDEOBUF_ACTIVE; 948e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = buf1->boff; 949e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = buf1; 950e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (tbuf.type != V4L2_BUF_TYPE_SLICED_VBI_OUTPUT) { 951e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr((addr + common->ytop_off), 952e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ybtm_off), 953e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ctop_off), 954e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->cbtm_off)); 955e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 956e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 957e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_restore(flags); 958e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_add_tail(&buf1->stream, &common->buffer_queue.stream); 959e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->buffer_queue.vb_lock); 960e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 961e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 962e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sqbuf_exit: 963e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->buffer_queue.vb_lock); 964e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 965e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 966e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 967e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_std(struct file *file, void *priv, v4l2_std_id *std_id) 968e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 969e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 970e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 971e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 972e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 973e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 974e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(*std_id & DM646X_V4L2_STD)) 975e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 976e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 977e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 978e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("streaming in progress\n"); 979e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 980e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 981e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 982e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Call encoder subdevice function to set the standard */ 983e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video.stdid = *std_id; 984c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard ch->video.dv_preset = V4L2_DV_INVALID; 985c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard memset(&ch->video.bt_timings, 0, sizeof(ch->video.bt_timings)); 986c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 987e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the information about the standard */ 9889bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil if (vpif_update_resolution(ch)) 9899bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EINVAL; 990e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 991e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->vpifparams.std_info.width * 992e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.height * 2) > 993e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[ch->channel_id]) { 994e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid std for this size\n"); 9959bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EINVAL; 996e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 997e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 998e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline = common->fmt.fmt.pix.width; 999e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Configure the default format information */ 1000e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_format(ch); 1001e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1002e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, video, 1003e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_std_output, *std_id); 1004e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1005e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set output standard\n"); 10069bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return ret; 1007e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1008e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1009e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, core, 1010e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_std, *std_id); 1011e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1012e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set standard for sub devices\n"); 1013e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1014e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1015e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1016e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_std(struct file *file, void *priv, v4l2_std_id *std) 1017e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1018e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1019e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1020e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1021e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *std = ch->video.stdid; 1022e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1023e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1024e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1025e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p) 1026e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1027e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1028e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1029e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1030e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1031e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_dqbuf(&common->buffer_queue, p, 1032e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (file->f_flags & O_NONBLOCK)); 1033e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1034e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1035e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_streamon(struct file *file, void *priv, 1036e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_buf_type buftype) 1037e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1038e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1039e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1040e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1041e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *oth_ch = vpif_obj.dev[!ch->channel_id]; 1042e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpif = &ch->vpifparams; 1043317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *vpif_config_data = 1044e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dev->platform_data; 1045e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 1046e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 1047e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1048e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype != V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1049e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer type not supported\n"); 1050e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1051e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1052e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1053e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 1054e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 1055e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 1056e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1057e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1058e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If Streaming is already started, return error */ 1059e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 1060e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("channel->started\n"); 1061e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 1062e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1063e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1064e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->channel_id == VPIF_CHANNEL2_VIDEO 1065e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && oth_ch->common[VPIF_VIDEO_INDEX].started && 1066e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.ycmux_mode == 0) 1067e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || ((ch->channel_id == VPIF_CHANNEL3_VIDEO) 1068e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (2 == oth_ch->common[VPIF_VIDEO_INDEX].started))) { 1069e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("other channel is using\n"); 1070e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 1071e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1072e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1073e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, &common->fmt.fmt.pix); 1074e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1075e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1076e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 10772c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard /* Call videobuf_streamon to start streaming in videobuf */ 1078e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = videobuf_streamon(&common->buffer_queue); 1079e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1080e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("videobuf_streamon\n"); 1081e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1082e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1083e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1084e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If buffer queue is empty, return error */ 1085e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue)) { 1086e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer queue is empty\n"); 10879bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EIO; 1088e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1089e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1090e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the next frame from the buffer queue */ 1091e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = common->cur_frm = 1092e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_entry(common->dma_queue.next, 1093e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer, queue); 1094e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1095e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_del(&common->cur_frm->queue); 1096e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark state of the current frame to active */ 1097e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_ACTIVE; 1098e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1099e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field_id and started member */ 1100e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id = 0; 1101e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 1; 1102e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1103e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = common->cur_frm->boff; 1104e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Calculate the offset for Y and C data in the buffer */ 1105e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_calculate_offsets(ch); 1106e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1107e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->vpifparams.std_info.frm_fmt && 1108e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ((common->fmt.fmt.pix.field != V4L2_FIELD_NONE) 1109e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (common->fmt.fmt.pix.field != V4L2_FIELD_ANY))) 1110e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (!ch->vpifparams.std_info.frm_fmt 1111e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (common->fmt.fmt.pix.field == V4L2_FIELD_NONE))) { 1112e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("conflict in field format and std format\n"); 11139bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EINVAL; 1114e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1115e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1116e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* clock settings */ 1117e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = 1118e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_data->set_clock(ch->vpifparams.std_info.ycmux_mode, 1119e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.hd_sd); 1120e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1121e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("can't set clock\n"); 11229bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return ret; 1123e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1124e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1125e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* set the parameters and addresses */ 1126e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_set_video_params(vpif, ch->channel_id + 2); 1127e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 11289bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return ret; 1129e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1130e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = ret; 1131e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_addr(ch, ret); 1132e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr((addr + common->ytop_off), 1133e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ybtm_off), 1134e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ctop_off), 1135e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->cbtm_off)); 1136e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1137e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set interrupt for both the fields in VPIF 1138e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S Register enable channel in VPIF register */ 1139e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 1140e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_assert(); 1141e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(1); 1142e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(1); 1143e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1144e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1145e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) 1146e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (common->started == 2)) { 1147e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_assert(); 1148e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(1); 1149e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(1); 1150e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1151e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[VPIF_VIDEO_INDEX][ch->channel_id] = 1; 1152e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1153e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1154e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1155e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1156e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_streamoff(struct file *file, void *priv, 1157e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_buf_type buftype) 1158e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1159e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1160e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1161e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1162e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1163e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype != V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1164e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer type not supported\n"); 1165e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1166e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1167e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1168e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 1169e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 1170e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 1171e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1172e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1173e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!common->started) { 1174e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("channel->started\n"); 1175e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1176e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1177e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1178e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1179e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* disable channel */ 1180e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 1181e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(0); 1182e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(0); 1183e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1184e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) || 1185e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (2 == common->started)) { 1186e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(0); 1187e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(0); 1188e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1189e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1190e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1191e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 1192e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_streamoff(&common->buffer_queue); 1193e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1194e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1195e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_cropcap(struct file *file, void *priv, 1196e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_cropcap *crop) 1197e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1198e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1199e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1200e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1201e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_BUF_TYPE_VIDEO_OUTPUT != crop->type) 1202e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1203e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1204e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->bounds.left = crop->bounds.top = 0; 1205e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.left = crop->defrect.top = 0; 1206e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.height = crop->bounds.height = common->height; 1207e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.width = crop->bounds.width = common->width; 1208e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1209e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1210e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1211e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1212e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_enum_output(struct file *file, void *fh, 1213e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_output *output) 1214e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1215e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1216317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config = vpif_dev->platform_data; 1217e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1218e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (output->index >= config->output_count) { 1219e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Invalid output index\n"); 1220e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1221e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1222e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1223e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strcpy(output->name, config->output[output->index]); 1224e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S output->type = V4L2_OUTPUT_TYPE_ANALOG; 1225e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S output->std = DM646X_V4L2_STD; 1226e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1227e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1228e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1229e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1230e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_output(struct file *file, void *priv, unsigned int i) 1231e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1232e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1233e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1234e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 1235e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1236e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 1237e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1238e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 1239e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Streaming in progress\n"); 12409bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil return -EBUSY; 1241e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1242e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1243e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, video, 1244e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_routing, 0, i, 0); 1245e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1246e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1247e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set output standard\n"); 1248e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1249e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->output_id = i; 1250e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1251e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1252e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1253e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_output(struct file *file, void *priv, unsigned int *i) 1254e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1255e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1256e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1257e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 1258e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1259e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *i = vid_ch->output_id; 1260e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1261e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1262e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1263e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1264e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_priority(struct file *file, void *priv, enum v4l2_priority *p) 1265e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1266e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1267e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1268e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1269e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *p = v4l2_prio_max(&ch->prio); 1270e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1271e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1272e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1273e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1274e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_priority(struct file *file, void *priv, enum v4l2_priority p) 1275e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1276e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1277e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1278e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1279e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return v4l2_prio_change(&ch->prio, &fh->prio, p); 1280e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1281e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 128240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard/** 128340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * vpif_enum_dv_presets() - ENUM_DV_PRESETS handler 128440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @file: file ptr 128540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @priv: file handle 128640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @preset: input preset 128740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard */ 128840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaardstatic int vpif_enum_dv_presets(struct file *file, void *priv, 128940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct v4l2_dv_enum_preset *preset) 129040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard{ 129140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct vpif_fh *fh = priv; 129240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct channel_obj *ch = fh->channel; 129340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct video_obj *vid_ch = &ch->video; 129440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 129540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return v4l2_subdev_call(vpif_obj.sd[vid_ch->output_id], 129640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard video, enum_dv_presets, preset); 129740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard} 129840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 129940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard/** 130040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * vpif_s_dv_presets() - S_DV_PRESETS handler 130140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @file: file ptr 130240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @priv: file handle 130340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @preset: input preset 130440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard */ 130540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaardstatic int vpif_s_dv_preset(struct file *file, void *priv, 130640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct v4l2_dv_preset *preset) 130740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard{ 130840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct vpif_fh *fh = priv; 130940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct channel_obj *ch = fh->channel; 131040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 131140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct video_obj *vid_ch = &ch->video; 131240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard int ret = 0; 131340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 131440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (common->started) { 131540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard vpif_dbg(1, debug, "streaming in progress\n"); 131640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return -EBUSY; 131740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } 131840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 131940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard ret = v4l2_prio_check(&ch->prio, fh->prio); 132040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (ret != 0) 132140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return ret; 132240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 132340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard fh->initialized = 1; 132440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 132540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard /* Call encoder subdevice function to set the standard */ 132640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard if (mutex_lock_interruptible(&common->lock)) 132740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return -ERESTARTSYS; 132840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 132940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard ch->video.dv_preset = preset->preset; 133040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard ch->video.stdid = V4L2_STD_UNKNOWN; 1331c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard memset(&ch->video.bt_timings, 0, sizeof(ch->video.bt_timings)); 133240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 133340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard /* Get the information about the standard */ 1334c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (vpif_update_resolution(ch)) { 133540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard ret = -EINVAL; 133640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } else { 133740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard /* Configure the default format information */ 133840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard vpif_config_format(ch); 133940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 134040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard ret = v4l2_subdev_call(vpif_obj.sd[vid_ch->output_id], 134140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard video, s_dv_preset, preset); 134240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard } 134340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 134440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard mutex_unlock(&common->lock); 134540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 134640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return ret; 134740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard} 134840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard/** 134940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * vpif_g_dv_presets() - G_DV_PRESETS handler 135040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @file: file ptr 135140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @priv: file handle 135240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard * @preset: input preset 135340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard */ 135440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaardstatic int vpif_g_dv_preset(struct file *file, void *priv, 135540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct v4l2_dv_preset *preset) 135640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard{ 135740c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct vpif_fh *fh = priv; 135840c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard struct channel_obj *ch = fh->channel; 135940c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 136040c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard preset->preset = ch->video.dv_preset; 136140c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard 136240c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard return 0; 136340c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard} 1364c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard/** 1365c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * vpif_s_dv_timings() - S_DV_TIMINGS handler 1366c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @file: file ptr 1367c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @priv: file handle 1368c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @timings: digital video timings 1369c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard */ 1370c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaardstatic int vpif_s_dv_timings(struct file *file, void *priv, 1371c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct v4l2_dv_timings *timings) 1372c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard{ 1373c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_fh *fh = priv; 1374c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct channel_obj *ch = fh->channel; 1375c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_params *vpifparams = &ch->vpifparams; 1376c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_channel_config_params *std_info = &vpifparams->std_info; 1377c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct video_obj *vid_ch = &ch->video; 1378c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct v4l2_bt_timings *bt = &vid_ch->bt_timings; 1379c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard int ret; 1380c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1381c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (timings->type != V4L2_DV_BT_656_1120) { 1382c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(2, debug, "Timing type not defined\n"); 1383c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 1384c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1385c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1386c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard /* Configure subdevice timings, if any */ 1387c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard ret = v4l2_subdev_call(vpif_obj.sd[vid_ch->output_id], 1388c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard video, s_dv_timings, timings); 1389c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (ret == -ENOIOCTLCMD) { 1390c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(2, debug, "Custom DV timings not supported by " 1391c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "subdevice\n"); 1392c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 1393c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1394c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (ret < 0) { 1395c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(2, debug, "Error setting custom DV timings\n"); 1396c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return ret; 1397c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1398c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1399c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (!(timings->bt.width && timings->bt.height && 1400c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard (timings->bt.hbackporch || 1401c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard timings->bt.hfrontporch || 1402c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard timings->bt.hsync) && 1403c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard timings->bt.vfrontporch && 1404c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard (timings->bt.vbackporch || 1405c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard timings->bt.vsync))) { 1406c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(2, debug, "Timings for width, height, " 1407c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "horizontal back porch, horizontal sync, " 1408c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "horizontal front porch, vertical back porch, " 1409c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "vertical sync and vertical back porch " 1410c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "must be defined\n"); 1411c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 1412c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1413c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1414c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard *bt = timings->bt; 1415c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1416c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard /* Configure video port timings */ 1417c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1418c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->eav2sav = bt->hbackporch + bt->hfrontporch + 1419c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->hsync - 8; 1420c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->sav2eav = bt->width; 1421c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1422c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l1 = 1; 1423c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l3 = bt->vsync + bt->vbackporch + 1; 1424c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1425c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (bt->interlaced) { 1426c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard if (bt->il_vbackporch || bt->il_vfrontporch || bt->il_vsync) { 1427c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->vsize = bt->height * 2 + 1428c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->vfrontporch + bt->vsync + bt->vbackporch + 1429c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->il_vfrontporch + bt->il_vsync + 1430c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->il_vbackporch; 1431c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l5 = std_info->vsize/2 - 1432c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard (bt->vfrontporch - 1); 1433c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l7 = std_info->vsize/2 + 1; 1434c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l9 = std_info->l7 + bt->il_vsync + 1435c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->il_vbackporch + 1; 1436c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l11 = std_info->vsize - 1437c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard (bt->il_vfrontporch - 1); 1438c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } else { 1439c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vpif_dbg(2, debug, "Required timing values for " 1440c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard "interlaced BT format missing\n"); 1441c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return -EINVAL; 1442c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1443c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } else { 1444c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->vsize = bt->height + bt->vfrontporch + 1445c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard bt->vsync + bt->vbackporch; 1446c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->l5 = std_info->vsize - (bt->vfrontporch - 1); 1447c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard } 1448c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard strncpy(std_info->name, "Custom timings BT656/1120", 1449c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard VPIF_MAX_NAME); 1450c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->width = bt->width; 1451c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->height = bt->height; 1452c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->frm_fmt = bt->interlaced ? 0 : 1; 1453c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->ycmux_mode = 0; 1454c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->capture_format = 0; 1455c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->vbi_supported = 0; 1456c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->hd_sd = 1; 1457c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->stdid = 0; 1458c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard std_info->dv_preset = V4L2_DV_INVALID; 1459c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1460c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vid_ch->stdid = 0; 1461c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard vid_ch->dv_preset = V4L2_DV_INVALID; 1462c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1463c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return 0; 1464c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard} 1465c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1466c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard/** 1467c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * vpif_g_dv_timings() - G_DV_TIMINGS handler 1468c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @file: file ptr 1469c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @priv: file handle 1470c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard * @timings: digital video timings 1471c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard */ 1472c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaardstatic int vpif_g_dv_timings(struct file *file, void *priv, 1473c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct v4l2_dv_timings *timings) 1474c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard{ 1475c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct vpif_fh *fh = priv; 1476c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct channel_obj *ch = fh->channel; 1477c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct video_obj *vid_ch = &ch->video; 1478c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard struct v4l2_bt_timings *bt = &vid_ch->bt_timings; 1479c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1480c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard timings->bt = *bt; 1481c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard 1482c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard return 0; 1483c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard} 14847036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 14857036d6a73c88428764e4a12f30846279346f4382Mats Randgaard/* 14867036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * vpif_g_chip_ident() - Identify the chip 14877036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @file: file ptr 14887036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @priv: file handle 14897036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @chip: chip identity 14907036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * 14917036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Returns zero or -EINVAL if read operations fails. 14927036d6a73c88428764e4a12f30846279346f4382Mats Randgaard */ 14937036d6a73c88428764e4a12f30846279346f4382Mats Randgaardstatic int vpif_g_chip_ident(struct file *file, void *priv, 14947036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct v4l2_dbg_chip_ident *chip) 14957036d6a73c88428764e4a12f30846279346f4382Mats Randgaard{ 14967036d6a73c88428764e4a12f30846279346f4382Mats Randgaard chip->ident = V4L2_IDENT_NONE; 14977036d6a73c88428764e4a12f30846279346f4382Mats Randgaard chip->revision = 0; 14987036d6a73c88428764e4a12f30846279346f4382Mats Randgaard if (chip->match.type != V4L2_CHIP_MATCH_I2C_DRIVER && 14997036d6a73c88428764e4a12f30846279346f4382Mats Randgaard chip->match.type != V4L2_CHIP_MATCH_I2C_ADDR) { 15007036d6a73c88428764e4a12f30846279346f4382Mats Randgaard vpif_dbg(2, debug, "match_type is invalid.\n"); 15017036d6a73c88428764e4a12f30846279346f4382Mats Randgaard return -EINVAL; 15027036d6a73c88428764e4a12f30846279346f4382Mats Randgaard } 15037036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15047036d6a73c88428764e4a12f30846279346f4382Mats Randgaard return v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 0, core, 15057036d6a73c88428764e4a12f30846279346f4382Mats Randgaard g_chip_ident, chip); 15067036d6a73c88428764e4a12f30846279346f4382Mats Randgaard} 15077036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15087036d6a73c88428764e4a12f30846279346f4382Mats Randgaard#ifdef CONFIG_VIDEO_ADV_DEBUG 15097036d6a73c88428764e4a12f30846279346f4382Mats Randgaard/* 15107036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * vpif_dbg_g_register() - Read register 15117036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @file: file ptr 15127036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @priv: file handle 15137036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @reg: register to be read 15147036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * 15157036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Debugging only 15167036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Returns zero or -EINVAL if read operations fails. 15177036d6a73c88428764e4a12f30846279346f4382Mats Randgaard */ 15187036d6a73c88428764e4a12f30846279346f4382Mats Randgaardstatic int vpif_dbg_g_register(struct file *file, void *priv, 15197036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct v4l2_dbg_register *reg){ 15207036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct vpif_fh *fh = priv; 15217036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct channel_obj *ch = fh->channel; 15227036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct video_obj *vid_ch = &ch->video; 15237036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15247036d6a73c88428764e4a12f30846279346f4382Mats Randgaard return v4l2_subdev_call(vpif_obj.sd[vid_ch->output_id], core, 15257036d6a73c88428764e4a12f30846279346f4382Mats Randgaard g_register, reg); 15267036d6a73c88428764e4a12f30846279346f4382Mats Randgaard} 15277036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15287036d6a73c88428764e4a12f30846279346f4382Mats Randgaard/* 15297036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * vpif_dbg_s_register() - Write to register 15307036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @file: file ptr 15317036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @priv: file handle 15327036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @reg: register to be modified 15337036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * 15347036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Debugging only 15357036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Returns zero or -EINVAL if write operations fails. 15367036d6a73c88428764e4a12f30846279346f4382Mats Randgaard */ 15377036d6a73c88428764e4a12f30846279346f4382Mats Randgaardstatic int vpif_dbg_s_register(struct file *file, void *priv, 15387036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct v4l2_dbg_register *reg){ 15397036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct vpif_fh *fh = priv; 15407036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct channel_obj *ch = fh->channel; 15417036d6a73c88428764e4a12f30846279346f4382Mats Randgaard struct video_obj *vid_ch = &ch->video; 15427036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15437036d6a73c88428764e4a12f30846279346f4382Mats Randgaard return v4l2_subdev_call(vpif_obj.sd[vid_ch->output_id], core, 15447036d6a73c88428764e4a12f30846279346f4382Mats Randgaard s_register, reg); 15457036d6a73c88428764e4a12f30846279346f4382Mats Randgaard} 15467036d6a73c88428764e4a12f30846279346f4382Mats Randgaard#endif 15477036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15487036d6a73c88428764e4a12f30846279346f4382Mats Randgaard/* 15497036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * vpif_log_status() - Status information 15507036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @file: file ptr 15517036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * @priv: file handle 15527036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * 15537036d6a73c88428764e4a12f30846279346f4382Mats Randgaard * Returns zero. 15547036d6a73c88428764e4a12f30846279346f4382Mats Randgaard */ 15557036d6a73c88428764e4a12f30846279346f4382Mats Randgaardstatic int vpif_log_status(struct file *filep, void *priv) 15567036d6a73c88428764e4a12f30846279346f4382Mats Randgaard{ 15577036d6a73c88428764e4a12f30846279346f4382Mats Randgaard /* status for sub devices */ 15587036d6a73c88428764e4a12f30846279346f4382Mats Randgaard v4l2_device_call_all(&vpif_obj.v4l2_dev, 0, core, log_status); 15597036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 15607036d6a73c88428764e4a12f30846279346f4382Mats Randgaard return 0; 15617036d6a73c88428764e4a12f30846279346f4382Mats Randgaard} 15627036d6a73c88428764e4a12f30846279346f4382Mats Randgaard 1563e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* vpif display ioctl operations */ 1564e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic const struct v4l2_ioctl_ops vpif_ioctl_ops = { 1565e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_querycap = vpif_querycap, 1566e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_priority = vpif_g_priority, 1567e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_priority = vpif_s_priority, 1568e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_enum_fmt_vid_out = vpif_enum_fmt_vid_out, 1569e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_fmt_vid_out = vpif_g_fmt_vid_out, 1570e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_fmt_vid_out = vpif_s_fmt_vid_out, 1571e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_try_fmt_vid_out = vpif_try_fmt_vid_out, 1572e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_reqbufs = vpif_reqbufs, 1573e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_querybuf = vpif_querybuf, 1574e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_qbuf = vpif_qbuf, 1575e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_dqbuf = vpif_dqbuf, 1576e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_streamon = vpif_streamon, 1577e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_streamoff = vpif_streamoff, 1578e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_std = vpif_s_std, 1579e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_std = vpif_g_std, 1580e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_enum_output = vpif_enum_output, 1581e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_output = vpif_s_output, 1582e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_output = vpif_g_output, 1583e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_cropcap = vpif_cropcap, 158440c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard .vidioc_enum_dv_presets = vpif_enum_dv_presets, 158540c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard .vidioc_s_dv_preset = vpif_s_dv_preset, 158640c8bcea6bc594c50abf3d3867bd49c8c039eb21Mats Randgaard .vidioc_g_dv_preset = vpif_g_dv_preset, 1587c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard .vidioc_s_dv_timings = vpif_s_dv_timings, 1588c027e165d2d901ecab485da5fee72ddce5da0297Mats Randgaard .vidioc_g_dv_timings = vpif_g_dv_timings, 15897036d6a73c88428764e4a12f30846279346f4382Mats Randgaard .vidioc_g_chip_ident = vpif_g_chip_ident, 15907036d6a73c88428764e4a12f30846279346f4382Mats Randgaard#ifdef CONFIG_VIDEO_ADV_DEBUG 15917036d6a73c88428764e4a12f30846279346f4382Mats Randgaard .vidioc_g_register = vpif_dbg_g_register, 15927036d6a73c88428764e4a12f30846279346f4382Mats Randgaard .vidioc_s_register = vpif_dbg_s_register, 15937036d6a73c88428764e4a12f30846279346f4382Mats Randgaard#endif 15947036d6a73c88428764e4a12f30846279346f4382Mats Randgaard .vidioc_log_status = vpif_log_status, 1595e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1596e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1597e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic const struct v4l2_file_operations vpif_fops = { 1598e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .owner = THIS_MODULE, 1599e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .open = vpif_open, 1600e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .release = vpif_release, 16019bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil .unlocked_ioctl = video_ioctl2, 1602e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .mmap = vpif_mmap, 1603e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .poll = vpif_poll 1604e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1605e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1606e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct video_device vpif_video_template = { 1607e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .name = "vpif", 1608e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .fops = &vpif_fops, 1609e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .ioctl_ops = &vpif_ioctl_ops, 1610e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .tvnorms = DM646X_V4L2_STD, 1611e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .current_norm = V4L2_STD_625_50, 1612e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1613e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1614e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1615e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/*Configure the channels, buffer sizei, request irq */ 1616e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int initialize_vpif(void) 1617e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1618e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_channel_objects_index; 1619e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_buffer_channel_index; 1620e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_buffer_index; 1621e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int err = 0, i, j; 1622e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1623e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Default number of buffers should be 3 */ 1624e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch2_numbuffers > 0) && 1625e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (ch2_numbuffers < config_params.min_numbuffers)) 1626e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_numbuffers = config_params.min_numbuffers; 1627e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch3_numbuffers > 0) && 1628e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (ch3_numbuffers < config_params.min_numbuffers)) 1629e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_numbuffers = config_params.min_numbuffers; 1630e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1631e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set buffer size to min buffers size if invalid buffer size is 1632e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * given */ 1633e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch2_bufsize < config_params.min_bufsize[VPIF_CHANNEL2_VIDEO]) 1634e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_bufsize = 1635e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.min_bufsize[VPIF_CHANNEL2_VIDEO]; 1636e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch3_bufsize < config_params.min_bufsize[VPIF_CHANNEL3_VIDEO]) 1637e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_bufsize = 1638e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.min_bufsize[VPIF_CHANNEL3_VIDEO]; 1639e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1640e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[VPIF_CHANNEL2_VIDEO] = ch2_numbuffers; 1641e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1642e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch2_numbuffers) { 1643e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[VPIF_CHANNEL2_VIDEO] = 1644e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_bufsize; 1645e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1646e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[VPIF_CHANNEL3_VIDEO] = ch3_numbuffers; 1647e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1648e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch3_numbuffers) { 1649e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[VPIF_CHANNEL3_VIDEO] = 1650e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_bufsize; 1651e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1652e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1653e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for six channel objects */ 1654e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1655e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_obj.dev[i] = 16561f8766b4e3f06c2206e7ff48da72d2886672759aMats Randgaard kzalloc(sizeof(struct channel_obj), GFP_KERNEL); 1657e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If memory allocation fails, return error */ 1658e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vpif_obj.dev[i]) { 1659e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_channel_objects_index = i; 1660e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1661e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto vpif_init_free_channel_objects; 1662e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1663e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1664e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1665e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_channel_objects_index = VPIF_DISPLAY_MAX_DEVICES; 1666e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_buffer_channel_index = VPIF_DISPLAY_NUM_CHANNELS; 1667e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_buffer_index = config_params.numbuffers[i - 1]; 1668e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1669e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1670e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1671e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Svpif_init_free_channel_objects: 1672e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < free_channel_objects_index; j++) 1673e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.dev[j]); 1674e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1675e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1676e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1677e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1678e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_probe: This function creates device entries by register itself to the 1679e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * V4L2 driver and initializes fields of each channel objects 1680e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1681e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic __init int vpif_probe(struct platform_device *pdev) 1682e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1683317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_subdev_info *subdevdata; 1684317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config; 1685e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i, j = 0, k, q, m, err = 0; 1686e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct i2c_adapter *i2c_adap; 1687e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 1688e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 1689e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_device *vfd; 1690e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct resource *res; 1691e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int subdev_count; 1692e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1693e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dev = &pdev->dev; 1694e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1695317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri err = initialize_vpif(); 1696e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1697317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri if (err) { 1698317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri v4l2_err(vpif_dev->driver, "Error initializing vpif\n"); 1699317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri return err; 1700e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1701e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1702e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = v4l2_device_register(vpif_dev, &vpif_obj.v4l2_dev); 1703e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (err) { 1704e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_err(vpif_dev->driver, "Error registering v4l2 device\n"); 1705e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1706e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1707e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1708e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S k = 0; 1709e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, k))) { 1710e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = res->start; i <= res->end; i++) { 1711e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (request_irq(i, vpif_channel_isr, IRQF_DISABLED, 1712e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S "DM646x_Display", 1713e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (void *)(&vpif_obj.dev[k]->channel_id))) { 1714e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -EBUSY; 1715e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto vpif_int_err; 1716e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1717e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1718e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S k++; 1719e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1720e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1721e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1722e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1723e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the pointer to the channel object */ 1724e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[i]; 1725e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1726e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for video device */ 1727e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd = video_device_alloc(); 1728e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vfd == NULL) { 1729e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < i; j++) { 1730e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[j]; 1731e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_device_release(ch->video_dev); 1732e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1733e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1734317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri goto vpif_int_err; 1735e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1736e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1737e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field of video device */ 1738e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *vfd = vpif_video_template; 1739e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd->v4l2_dev = &vpif_obj.v4l2_dev; 1740e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd->release = video_device_release; 1741e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S snprintf(vfd->name, sizeof(vfd->name), 174264dc3c1a906467d90c24913b0b38dd13d9378f4fMauro Carvalho Chehab "DM646x_VPIFDisplay_DRIVER_V%s", 174364dc3c1a906467d90c24913b0b38dd13d9378f4fMauro Carvalho Chehab VPIF_DISPLAY_VERSION); 1744e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1745e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set video_dev to the video device */ 1746e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = vfd; 1747e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1748e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1749e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < VPIF_DISPLAY_MAX_DEVICES; j++) { 1750e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[j]; 1751e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field of the channel objects */ 1752e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_set(&ch->usrs, 0); 1753e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (k = 0; k < VPIF_NUMOBJECTS; k++) { 1754e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[k].numbuffers = 0; 1755e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[k]; 1756e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 0; 1757e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 1758e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S spin_lock_init(&common->irqlock); 1759e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_init(&common->lock); 1760e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = 0; 1761e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = NULL; 1762e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = common->ybtm_off = 0; 1763e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = common->cbtm_off = 0; 1764e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm = NULL; 1765e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&common->fmt, 0, sizeof(common->fmt)); 1766e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = config_params.numbuffers[k]; 1767e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1768e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1769e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 0; 1770e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->channel_id = j; 1771e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (j < 2) 1772e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].numbuffers = 1773e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[ch->channel_id]; 1774e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 1775e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].numbuffers = 0; 1776e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1777e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&ch->vpifparams, 0, sizeof(ch->vpifparams)); 1778e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1779e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize prio member of channel object */ 1780e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_prio_init(&ch->prio); 1781e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].fmt.type = 1782e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S V4L2_BUF_TYPE_VIDEO_OUTPUT; 17839bfaae24f991ff5255de17cd05838d1cd131727cHans Verkuil ch->video_dev->lock = &common->lock; 1784e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1785e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* register video device */ 1786e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "channel=%x,channel->video_dev=%x\n", 1787e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (int)ch, (int)&ch->video_dev); 1788e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1789e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = video_register_device(ch->video_dev, 1790e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S VFL_TYPE_GRABBER, (j ? 3 : 2)); 1791e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (err < 0) 1792e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_out; 1793e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1794e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_set_drvdata(ch->video_dev, ch); 1795e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1796e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1797e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S i2c_adap = i2c_get_adapter(1); 1798e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config = pdev->dev.platform_data; 1799e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S subdev_count = config->subdev_count; 1800e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S subdevdata = config->subdevinfo; 18011f8766b4e3f06c2206e7ff48da72d2886672759aMats Randgaard vpif_obj.sd = kzalloc(sizeof(struct v4l2_subdev *) * subdev_count, 1802e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S GFP_KERNEL); 1803e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_obj.sd == NULL) { 1804e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("unable to allocate memory for subdevice pointers\n"); 1805e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1806e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_out; 1807e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1808e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1809e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < subdev_count; i++) { 1810317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri vpif_obj.sd[i] = v4l2_i2c_new_subdev_board(&vpif_obj.v4l2_dev, 18119a1f8b34aa539000da17a06235e4bec254d0bfb5Laurent Pinchart i2c_adap, 1812317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri &subdevdata[i].board_info, 1813317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri NULL); 1814e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vpif_obj.sd[i]) { 1815e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Error registering v4l2 subdevice\n"); 1816e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_subdev_out; 1817e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1818e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1819e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_obj.sd[i]) 1820e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_obj.sd[i]->grp_id = 1 << i; 1821e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1822e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 18232c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard v4l2_info(&vpif_obj.v4l2_dev, 18242c0ddd17741383009c53cf557d6526848c8bb917Mats Randgaard "DM646x VPIF display driver initialized\n"); 1825e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1826e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1827e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sprobe_subdev_out: 1828e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.sd); 1829e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sprobe_out: 1830e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (k = 0; k < j; k++) { 1831e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[k]; 1832e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_unregister_device(ch->video_dev); 1833e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_device_release(ch->video_dev); 1834e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = NULL; 1835e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1836e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Svpif_int_err: 1837e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_device_unregister(&vpif_obj.v4l2_dev); 1838e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("VPIF IRQ request failed\n"); 1839e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (q = k; k >= 0; k--) { 1840e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (m = i; m >= res->start; m--) 1841e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_irq(m, (void *)(&vpif_obj.dev[k]->channel_id)); 1842e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S res = platform_get_resource(pdev, IORESOURCE_IRQ, k-1); 1843e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S m = res->end; 1844e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1845e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1846e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1847e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1848e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1849e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1850e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_remove: It un-register channels from V4L2 driver 1851e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1852e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_remove(struct platform_device *device) 1853e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1854e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 1855e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i; 1856e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1857e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_device_unregister(&vpif_obj.v4l2_dev); 1858e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1859e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* un-register device */ 1860e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1861e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the pointer to the channel object */ 1862e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[i]; 1863e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Unregister video device */ 1864e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_unregister_device(ch->video_dev); 1865e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1866e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = NULL; 1867e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1868e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1869e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1870e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1871e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1872ffa1b391c61b9f9a2b5d14859bfdd9259fc6c4daMats Randgaardstatic __refdata struct platform_driver vpif_driver = { 1873e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .driver = { 1874e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .name = "vpif_display", 1875e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .owner = THIS_MODULE, 1876e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S }, 1877e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .probe = vpif_probe, 1878e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .remove = vpif_remove, 1879e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1880e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1881e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic __init int vpif_init(void) 1882e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1883e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return platform_driver_register(&vpif_driver); 1884e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1885e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1886e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1887e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_cleanup: This function un-registers device and driver to the kernel, 1888e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frees requested irq handler and de-allocates memory allocated for channel 1889e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * objects. 1890e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1891e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_cleanup(void) 1892e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1893e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct platform_device *pdev; 1894e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct resource *res; 1895e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int irq_num; 1896e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i = 0; 1897e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1898e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pdev = container_of(vpif_dev, struct platform_device, dev); 1899e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1900e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, i))) { 1901e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (irq_num = res->start; irq_num <= res->end; irq_num++) 1902e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_irq(irq_num, 1903e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (void *)(&vpif_obj.dev[i]->channel_id)); 1904e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S i++; 1905e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1906e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1907e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S platform_driver_unregister(&vpif_driver); 1908e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.sd); 1909e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) 1910e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.dev[i]); 1911e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1912e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1913e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_init(vpif_init); 1914e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_exit(vpif_cleanup); 1915