vpif_display.c revision ffb4877ba013f94322083f77cbb05b35c2a218aa
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> 32e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <linux/version.h> 335a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 34e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 35e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <asm/irq.h> 36e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <asm/page.h> 37e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 38e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/adv7343.h> 39e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/v4l2-device.h> 40e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#include <media/v4l2-ioctl.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"); 49e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 50e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define DM646X_V4L2_STD (V4L2_STD_525_60 | V4L2_STD_625_50) 51e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 52e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define vpif_err(fmt, arg...) v4l2_err(&vpif_obj.v4l2_dev, fmt, ## arg) 53e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S#define vpif_dbg(level, debug, fmt, arg...) \ 54e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_dbg(level, debug, &vpif_obj.v4l2_dev, fmt, ## arg) 55e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 56e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int debug = 1; 57e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch2_numbuffers = 3; 58e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch3_numbuffers = 3; 59e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch2_bufsize = 1920 * 1080 * 2; 60e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 ch3_bufsize = 720 * 576 * 2; 61e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 62e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(debug, int, 0644); 63e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch2_numbuffers, uint, S_IRUGO); 64e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch3_numbuffers, uint, S_IRUGO); 65e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch2_bufsize, uint, S_IRUGO); 66e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_param(ch3_bufsize, uint, S_IRUGO); 67e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 68e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(debug, "Debug level 0-1"); 69e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch2_numbuffers, "Channel2 buffer count (default:3)"); 70e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch3_numbuffers, "Channel3 buffer count (default:3)"); 71e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch2_bufsize, "Channel2 buffer size (default:1920 x 1080 x 2)"); 72e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U SMODULE_PARM_DESC(ch3_bufsize, "Channel3 buffer size (default:720 x 576 x 2)"); 73e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 74e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct vpif_config_params config_params = { 75e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_numbuffers = 3, 76e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .numbuffers[0] = 3, 77e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .numbuffers[1] = 3, 78e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_bufsize[0] = 720 * 480 * 2, 79e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .min_bufsize[1] = 720 * 480 * 2, 80e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .channel_bufsize[0] = 1920 * 1080 * 2, 81e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .channel_bufsize[1] = 720 * 576 * 2, 82e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 83e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 84e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct vpif_device vpif_obj = { {NULL} }; 85e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct device *vpif_dev; 86e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 87e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic const struct vpif_channel_config_params ch_params[] = { 88e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S { 89e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S "NTSC", 720, 480, 30, 0, 1, 268, 1440, 1, 23, 263, 266, 90e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 286, 525, 525, 0, 1, 0, V4L2_STD_525_60, 91e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S }, 92e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S { 93e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S "PAL", 720, 576, 25, 0, 1, 280, 1440, 1, 23, 311, 313, 94e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 336, 624, 625, 0, 1, 0, V4L2_STD_625_50, 95e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S }, 96e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 97e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 98e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 99e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_uservirt_to_phys: This function is used to convert user 100e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * space virtual address to physical address. 101e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 102e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u32 vpif_uservirt_to_phys(u32 virtp) 103e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 104e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct mm_struct *mm = current->mm; 105e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long physp = 0; 106e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vm_area_struct *vma; 107e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 108e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vma = find_vma(mm, virtp); 109e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 110e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* For kernel direct-mapped memory, take the easy way */ 111e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (virtp >= PAGE_OFFSET) { 112e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = virt_to_phys((void *)virtp); 113e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (vma && (vma->vm_flags & VM_IO) && (vma->vm_pgoff)) { 114e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* this will catch, kernel-allocated, mmaped-to-usermode addr */ 115e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = (vma->vm_pgoff << PAGE_SHIFT) + (virtp - vma->vm_start); 116e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 117e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* otherwise, use get_user_pages() for general userland pages */ 118e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int res, nr_pages = 1; 119e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct page *pages; 120e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S down_read(¤t->mm->mmap_sem); 121e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 122e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S res = get_user_pages(current, current->mm, 123e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S virtp, nr_pages, 1, 0, &pages, NULL); 124e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S up_read(¤t->mm->mmap_sem); 125e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 126e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (res == nr_pages) { 127e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S physp = __pa(page_address(&pages[0]) + 128e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (virtp & ~PAGE_MASK)); 129e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 130e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("get_user_pages failed\n"); 131e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 132e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 133e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 134e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 135e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return physp; 136e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 137e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 138e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 139e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * buffer_prepare: This is the callback function called from videobuf_qbuf() 140e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * function the buffer is prepared and user space virtual address is converted 141e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * into physical address 142e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 143e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_buffer_prepare(struct videobuf_queue *q, 144e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb, 145e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field) 146e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 147e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 148e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 149e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr; 150e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 151e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &fh->channel->common[VPIF_VIDEO_INDEX]; 152e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VIDEOBUF_NEEDS_INIT == vb->state) { 153e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->width = common->width; 154e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->height = common->height; 155e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->size = vb->width * vb->height; 156e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->field = field; 157e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 158e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_PREPARED; 159e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 160e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* if user pointer memory mechanism is used, get the physical 161e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * address of the buffer */ 162e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) { 163e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vb->baddr) { 164e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer_address is 0\n"); 165e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 166e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 167e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 168e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->boff = vpif_uservirt_to_phys(vb->baddr); 169e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(vb->boff)) 170e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto buf_align_exit; 171e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 172e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 173e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = vb->boff; 174e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (q->streaming && (V4L2_BUF_TYPE_SLICED_VBI_OUTPUT != q->type)) { 175e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(addr + common->ytop_off) || 176e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->ybtm_off) || 177e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->ctop_off) || 178e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !ISALIGNED(addr + common->cbtm_off)) 179e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto buf_align_exit; 180e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 181e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 182e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 183e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sbuf_align_exit: 184e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer offset not aligned to 8 bytes\n"); 185e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 186e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 187e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 188e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 189e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_setup: This function allocates memory for the buffers 190e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 191e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_buffer_setup(struct videobuf_queue *q, unsigned int *count, 192e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int *size) 193e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 194e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 195e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 196e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 197e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 198e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_MMAP != common->memory) 199e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 200e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 201e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *size = config_params.channel_bufsize[ch->channel_id]; 202e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (*count < config_params.min_numbuffers) 203e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *count = config_params.min_numbuffers; 204e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 205e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 206e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 207e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 208e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 209e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_queue: This function adds the buffer to DMA queue 210e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 211e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_buffer_queue(struct videobuf_queue *q, 212e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb) 213e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 214e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 215e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 216e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 217e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &fh->channel->common[VPIF_VIDEO_INDEX]; 218e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 219e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* add the buffer to the DMA queue */ 220e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_add_tail(&vb->queue, &common->dma_queue); 221e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_QUEUED; 222e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 223e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 224e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 225e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_buffer_release: This function is called from the videobuf layer to 226e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * free memory allocated to the buffers 227e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 228e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_buffer_release(struct videobuf_queue *q, 229e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *vb) 230e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 231e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = q->priv_data; 232e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 233e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 234e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int buf_size = 0; 235e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 236e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[VPIF_VIDEO_INDEX]; 237e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 238e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_dma_contig_free(q, vb); 239e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vb->state = VIDEOBUF_NEEDS_INIT; 240e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 241e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_MMAP != common->memory) 242e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 243e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 244e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf_size = config_params.channel_bufsize[ch->channel_id]; 245e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 246e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 247e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct videobuf_queue_ops video_qops = { 248e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_setup = vpif_buffer_setup, 249e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_prepare = vpif_buffer_prepare, 250e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_queue = vpif_buffer_queue, 251e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .buf_release = vpif_buffer_release, 252e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 253e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic u8 channel_first_int[VPIF_NUMOBJECTS][2] = { {1, 1} }; 254e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 255e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void process_progressive_mode(struct common_obj *common) 256e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 257e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 258e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 259e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the next buffer from buffer queue */ 260e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = list_entry(common->dma_queue.next, 261e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer, queue); 262e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Remove that buffer from the buffer queue */ 263e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_del(&common->next_frm->queue); 264e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark status of the buffer as active */ 265e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm->state = VIDEOBUF_ACTIVE; 266e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 267e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set top and bottom field addrs in VPIF registers */ 268e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = videobuf_to_dma_contig(common->next_frm); 269e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr(addr + common->ytop_off, 270e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->ybtm_off, 271e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->ctop_off, 272e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr + common->cbtm_off); 273e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 274e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 275e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void process_interlaced_mode(int fid, struct common_obj *common) 276e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 277e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* device field id and local field id are in sync */ 278e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If this is even field */ 279e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == fid) { 280e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->cur_frm == common->next_frm) 281e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 282e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 283e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* one frame is displayed If next frame is 284e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * available, release cur_frm and move on */ 285e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Copy frame display time */ 286e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S do_gettimeofday(&common->cur_frm->ts); 287e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Change status of the cur_frm */ 288e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_DONE; 289e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* unlock semaphore on cur_frm */ 290e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S wake_up_interruptible(&common->cur_frm->done); 291e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make cur_frm pointing to next_frm */ 292e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm; 293e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 294e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (1 == fid) { /* odd field */ 295e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue) 296e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (common->cur_frm != common->next_frm)) { 297e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return; 298e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 299e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* one field is displayed configure the next 300e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frame if it is available else hold on current 301e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frame */ 302e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get next from the buffer queue */ 303e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_progressive_mode(common); 304e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 305e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 306e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 307e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 308e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 309e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_channel_isr: It changes status of the displayed buffer, takes next 310e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * buffer from the queue and sets its address in VPIF registers 311e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 312e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic irqreturn_t vpif_channel_isr(int irq, void *dev_id) 313e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 314e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_device *dev = &vpif_obj; 315e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 316e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 317e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field; 318e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int fid = -1, i; 319e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int channel_id = 0; 320e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 321e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_id = *(int *)(dev_id); 322e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = dev->dev[channel_id]; 323e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = ch->common[VPIF_VIDEO_INDEX].fmt.fmt.pix.field; 324e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_NUMOBJECTS; i++) { 325e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[i]; 326e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If streaming is started in this channel */ 327e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == common->started) 328e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 329e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 330e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (1 == ch->vpifparams.std_info.frm_fmt) { 331e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue)) 332e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 333e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 334e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Progressive mode */ 335e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!channel_first_int[i][channel_id]) { 336e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark status of the cur_frm to 337e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * done and unlock semaphore on it */ 338e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S do_gettimeofday(&common->cur_frm->ts); 339e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_DONE; 340e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S wake_up_interruptible(&common->cur_frm->done); 341e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make cur_frm pointing to next_frm */ 342e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm; 343e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 344e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 345e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[i][channel_id] = 0; 346e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_progressive_mode(common); 347e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 348e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Interlaced mode */ 349e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If it is first interrupt, ignore it */ 350e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 351e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (channel_first_int[i][channel_id]) { 352e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[i][channel_id] = 0; 353e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S continue; 354e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 355e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 356e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == i) { 357e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id ^= 1; 358e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get field id from VPIF registers */ 359e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fid = vpif_channel_getfid(ch->channel_id + 2); 360e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If fid does not match with stored field id */ 361e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fid != ch->field_id) { 362e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Make them in sync */ 363e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 == fid) 364e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id = fid; 365e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 366e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return IRQ_HANDLED; 367e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 368e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 369e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S process_interlaced_mode(fid, common); 370e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 371e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 372e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 373e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return IRQ_HANDLED; 374e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 375e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 376e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_get_std_info(struct channel_obj *ch) 377e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 378e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 379e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 380e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpifparams = &ch->vpifparams; 381e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_channel_config_params *std_info = &vpifparams->std_info; 382e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S const struct vpif_channel_config_params *config; 383e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 384e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int index; 385e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 386e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S std_info->stdid = vid_ch->stdid; 387728385c4d31469b9124953f36fb42015435466c9Julia Lawall if (!std_info->stdid) 388e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -1; 389e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 390e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (index = 0; index < ARRAY_SIZE(ch_params); index++) { 391e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config = &ch_params[index]; 392e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (config->stdid & std_info->stdid) { 393e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memcpy(std_info, config, sizeof(*config)); 394e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S break; 395e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 396e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 397e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 398e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (index == ARRAY_SIZE(ch_params)) 399e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -1; 400e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 401e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.width = std_info->width; 402e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.height = std_info->height; 403e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Pixel details: Width = %d,Height = %d\n", 404e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.width, common->fmt.fmt.pix.height); 405e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 406e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set height and width paramateres */ 407e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].height = std_info->height; 408e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].width = std_info->width; 409e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 410e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 411e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 412e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 413e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 414e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_calculate_offsets: This function calculates buffers offset for Y and C 415e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * in the top and bottom field 416e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 417e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_calculate_offsets(struct channel_obj *ch) 418e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 419e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 420e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpifparams = &ch->vpifparams; 421e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field = common->fmt.fmt.pix.field; 422e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 423e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned int hpitch, vpitch, sizeimage; 424e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 425e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_FIELD_ANY == common->fmt.fmt.pix.field) { 426e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch->vpifparams.std_info.frm_fmt) 427e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = V4L2_FIELD_NONE; 428e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 429e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = V4L2_FIELD_INTERLACED; 430e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 431e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->buf_field = common->fmt.fmt.pix.field; 432e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 433e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 434e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) 435e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = common->fmt.fmt.pix.sizeimage; 436e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 437e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = config_params.channel_bufsize[ch->channel_id]; 438e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 439e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S hpitch = common->fmt.fmt.pix.bytesperline; 440e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpitch = sizeimage / (hpitch * 2); 441e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((V4L2_FIELD_NONE == vid_ch->buf_field) || 442e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (V4L2_FIELD_INTERLACED == vid_ch->buf_field)) { 443e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = 0; 444e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = hpitch; 445e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = sizeimage / 2; 446e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = sizeimage / 2 + hpitch; 447e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (V4L2_FIELD_SEQ_TB == vid_ch->buf_field) { 448e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = 0; 449e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = sizeimage / 4; 450e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = sizeimage / 2; 451e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = common->ctop_off + sizeimage / 4; 452e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else if (V4L2_FIELD_SEQ_BT == vid_ch->buf_field) { 453e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ybtm_off = 0; 454e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = sizeimage / 4; 455e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cbtm_off = sizeimage / 2; 456e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = common->cbtm_off + sizeimage / 4; 457e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 458e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 459e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((V4L2_FIELD_NONE == vid_ch->buf_field) || 460e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (V4L2_FIELD_INTERLACED == vid_ch->buf_field)) { 461e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.storage_mode = 1; 462e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 463e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.storage_mode = 0; 464e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 465e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 466e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch->vpifparams.std_info.frm_fmt == 1) { 467e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 468e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline; 469e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 470e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((field == V4L2_FIELD_ANY) || 471e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (field == V4L2_FIELD_INTERLACED)) 472e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 473e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline * 2; 474e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 475e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpifparams->video_params.hpitch = 476e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline; 477e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 478e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 479e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.video_params.stdid = ch->vpifparams.std_info.stdid; 480e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 481e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 482e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_config_format(struct channel_obj *ch) 483e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 484e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 485e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 486e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.field = V4L2_FIELD_ANY; 487e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (config_params.numbuffers[ch->channel_id] == 0) 488e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = V4L2_MEMORY_USERPTR; 489e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 490e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = V4L2_MEMORY_MMAP; 491e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 492e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.sizeimage = 493e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[ch->channel_id]; 494e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUV422P; 495e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.type = V4L2_BUF_TYPE_VIDEO_OUTPUT; 496e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 497e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 498e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_check_format(struct channel_obj *ch, 499e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt) 500e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 501e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 502e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field = pixfmt->field; 503e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S u32 sizeimage, hpitch, vpitch; 504e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 505e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (pixfmt->pixelformat != V4L2_PIX_FMT_YUV422P) 506e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_fmt_exit; 507e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 508e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(VPIF_VALID_FIELD(field))) 509e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_fmt_exit; 510e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 511e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (pixfmt->bytesperline <= 0) 512e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_pitch_exit; 513e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 514e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_MEMORY_USERPTR == common->memory) 515e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = pixfmt->sizeimage; 516e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 517e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeimage = config_params.channel_bufsize[ch->channel_id]; 518e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 519e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_get_std_info(ch)) { 520e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Error getting the standard info\n"); 521e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 522e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 523e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 524e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S hpitch = pixfmt->bytesperline; 525e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpitch = sizeimage / (hpitch * 2); 526e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 527e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for valid value of pitch */ 528e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((hpitch < ch->vpifparams.std_info.width) || 529e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (vpitch < ch->vpifparams.std_info.height)) 530e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto invalid_pitch_exit; 531e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 532e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for 8 byte alignment */ 533e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ISALIGNED(hpitch)) { 534e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid pitch alignment\n"); 535e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 536e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 537e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->width = common->fmt.fmt.pix.width; 538e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->height = common->fmt.fmt.pix.height; 539e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 540e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 541e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 542e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sinvalid_fmt_exit: 543e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid field format\n"); 544e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 545e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 546e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sinvalid_pitch_exit: 547e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid pitch\n"); 548e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 549e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 550e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 551e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_config_addr(struct channel_obj *ch, int muxmode) 552e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 553e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 554e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 555e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL3_VIDEO == ch->channel_id) { 556e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch3_set_videobuf_addr; 557e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 558e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (2 == muxmode) 559e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch2_set_videobuf_addr_yc_nmux; 560e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 561e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = ch2_set_videobuf_addr; 562e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 563e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 564e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 565e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 566e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_mmap: It is used to map kernel space buffers into user spaces 567e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 568e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_mmap(struct file *filep, struct vm_area_struct *vma) 569e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 570e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 571e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &fh->channel->common[VPIF_VIDEO_INDEX]; 572e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 573e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_mmap_mapper(&common->buffer_queue, vma); 574e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 575e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 576e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 577e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_poll: It is used for select/poll system call 578e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 579e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic unsigned int vpif_poll(struct file *filep, poll_table *wait) 580e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 581e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 582e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 583e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 584e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 585e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) 586e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_poll_stream(filep, &common->buffer_queue, wait); 587e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 588e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 589e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 590e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 591e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 592e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_open: It creates object of file handle structure and stores it in 593e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * private_data member of filepointer 594e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 595e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_open(struct file *filep) 596e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 597e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_device *vdev = video_devdata(filep); 598e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = NULL; 599e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = NULL; 600e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 601e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = video_get_drvdata(vdev); 602e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for the file handle object */ 603e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh = kmalloc(sizeof(struct vpif_fh), GFP_KERNEL); 604e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh == NULL) { 605e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("unable to allocate memory for file handle object\n"); 606e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -ENOMEM; 607e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 608e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 609e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store pointer to fh in private_data member of filep */ 610e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S filep->private_data = fh; 611e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->channel = ch; 612e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 0; 613e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!ch->initialized) { 614e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 1; 615e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 1; 616e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&ch->vpifparams, 0, sizeof(ch->vpifparams)); 617e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 618e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 619e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Increment channel usrs counter */ 620e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_inc(&ch->usrs); 621e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set io_allowed[VPIF_VIDEO_INDEX] member to false */ 622e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->io_allowed[VPIF_VIDEO_INDEX] = 0; 623e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize priority of this instance to default priority */ 624e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->prio = V4L2_PRIORITY_UNSET; 625e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_prio_open(&ch->prio, &fh->prio); 626e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 627e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 628e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 629e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 630e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 631e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_release: This function deletes buffer queue, frees the buffers and 632e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * the vpif file handle 633e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 634e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_release(struct file *filep) 635e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 636e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = filep->private_data; 637e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 638e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 639e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 64013df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 64113df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 64213df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 643e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* if this instance is doing IO */ 644e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh->io_allowed[VPIF_VIDEO_INDEX]) { 645e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Reset io_usrs member of channel object */ 646e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 0; 647e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Disable channel */ 648e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 649e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(0); 650e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(0); 651e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 652e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) || 653e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (2 == common->started)) { 654e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(0); 655e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(0); 656e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 657e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 658e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Free buffers allocated */ 659e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_queue_cancel(&common->buffer_queue); 660e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_mmap_free(&common->buffer_queue); 661e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = 662e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[ch->channel_id]; 663e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 664e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 665e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 666e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 667e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Decrement channel usrs counter */ 668e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_dec(&ch->usrs); 669e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If this file handle has initialize encoder device, reset it */ 670e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fh->initialized) 671e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 0; 672e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 673e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Close the priority */ 674ffb4877ba013f94322083f77cbb05b35c2a218aaHans Verkuil v4l2_prio_close(&ch->prio, fh->prio); 675e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S filep->private_data = NULL; 676e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 0; 677e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(fh); 678e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 679e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 680e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 681e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 682e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* functions implementing ioctls */ 683e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 684e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_querycap(struct file *file, void *priv, 685e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_capability *cap) 686e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 687317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config = vpif_dev->platform_data; 688e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 689e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S cap->version = VPIF_DISPLAY_VERSION_CODE; 690e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S cap->capabilities = V4L2_CAP_VIDEO_OUTPUT | V4L2_CAP_STREAMING; 691e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->driver, "vpif display", sizeof(cap->driver)); 692e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->bus_info, "Platform", sizeof(cap->bus_info)); 693e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strlcpy(cap->card, config->card_name, sizeof(cap->card)); 694e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 695e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 696e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 697e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 698e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_enum_fmt_vid_out(struct file *file, void *priv, 699e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_fmtdesc *fmt) 700e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 701e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (fmt->index != 0) { 702e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Invalid format index\n"); 703e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 704e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 705e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 706e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Fill in the information about format */ 707e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fmt->type = V4L2_BUF_TYPE_VIDEO_OUTPUT; 708e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strcpy(fmt->description, "YCbCr4:2:2 YC Planar"); 709e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fmt->pixelformat = V4L2_PIX_FMT_YUV422P; 710e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 711e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 712e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 713e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 714e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_fmt_vid_out(struct file *file, void *priv, 715e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 716e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 717e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 718e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 719e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 720e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 721e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check the validity of the buffer type */ 722e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != fmt->type) 723e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 724e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 725e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Fill in the information about format */ 72613df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 72713df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 72813df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 729e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_get_std_info(ch)) { 730e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Error getting the standard info\n"); 731e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 732e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 733e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 734e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *fmt = common->fmt; 735e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 736e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 737e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 738e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 739e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_fmt_vid_out(struct file *file, void *priv, 740e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 741e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 742e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 743e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt; 744e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 745e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 746e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 747e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 748e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL2_VIDEO == ch->channel_id) 749e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (VPIF_CHANNEL3_VIDEO == ch->channel_id)) { 750e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->initialized) { 751e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Channel Busy\n"); 752e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 753e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 754e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 755e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for the priority */ 756ffb4877ba013f94322083f77cbb05b35c2a218aaHans Verkuil ret = v4l2_prio_check(&ch->prio, fh->prio); 757e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 != ret) 758e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 759e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->initialized = 1; 760e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 761e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 762e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 763e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Streaming in progress\n"); 764e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 765e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 766e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 767e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt = &fmt->fmt.pix; 768e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Check for valid field format */ 769e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, pixfmt); 770e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret) 771e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 772e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 773e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store the pix format in the channel object */ 774e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix = *pixfmt; 775e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* store the format in the channel object */ 77613df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 77713df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 77813df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 779e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt = *fmt; 780e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 781e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 782e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 783e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 784e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 785e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_try_fmt_vid_out(struct file *file, void *priv, 786e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_format *fmt) 787e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 788e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 789e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 790e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 791e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_pix_format *pixfmt = &fmt->fmt.pix; 792e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 793e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 794e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, pixfmt); 795e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret) { 796e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *pixfmt = common->fmt.fmt.pix; 797e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pixfmt->sizeimage = pixfmt->width * pixfmt->height * 2; 798e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 799e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 800e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 801e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 802e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 803e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_reqbufs(struct file *file, void *priv, 804e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_requestbuffers *reqbuf) 805e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 806e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 807e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 808e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 809e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_field field; 810e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S u8 index = 0; 811e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 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 if (mutex_lock_interruptible(&common->lock)) 83013df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 83113df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 832e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != reqbuf->type) { 833e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EINVAL; 834e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto reqbuf_exit; 835e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 836e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 837e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (0 != common->io_usrs) { 838e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EBUSY; 839e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto reqbuf_exit; 840e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 841e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 842e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (reqbuf->type == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 843e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.fmt.pix.field == V4L2_FIELD_ANY) 844e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = V4L2_FIELD_INTERLACED; 845e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 846e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = common->fmt.fmt.pix.field; 847e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } else { 848e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S field = V4L2_VBI_INTERLACED; 849e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 850e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 851e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize videobuf queue as per the buffer type */ 852e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S videobuf_queue_dma_contig_init(&common->buffer_queue, 853e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S &video_qops, NULL, 854e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S &common->irqlock, 855e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S reqbuf->type, field, 856e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S sizeof(struct videobuf_buffer), fh); 857e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 858e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set io allowed member of file handle to TRUE */ 859e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S fh->io_allowed[index] = 1; 860e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Increment io usrs member of channel object to 1 */ 861e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 1; 862e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Store type of memory requested in channel object */ 863e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->memory = reqbuf->memory; 864e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S INIT_LIST_HEAD(&common->dma_queue); 865e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 866e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate buffers */ 867e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = videobuf_reqbufs(&common->buffer_queue, reqbuf); 868e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 869e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sreqbuf_exit: 870e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 871e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 872e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 873e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 874e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_querybuf(struct file *file, void *priv, 875e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_buffer *tbuf) 876e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 877e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 878e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 879e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 880e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 881e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != tbuf->type) 882e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 883e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 884e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_querybuf(&common->buffer_queue, tbuf); 885e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 886e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 887e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf) 888e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 889e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 890e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 891e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 892e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 893e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_buffer tbuf = *buf; 894e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer *buf1; 895e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 896e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long flags; 897e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 898e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 899e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->fmt.type != tbuf.type) 900e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 901e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 902e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 903e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 904e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 905e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 906e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 907e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(list_empty(&common->dma_queue)) || 908e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (common->cur_frm != common->next_frm) || 909e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S !(common->started) || 910e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (common->started && (0 == ch->field_id))) 911e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_qbuf(&common->buffer_queue, buf); 912e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 913e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* bufferqueue is empty store buffer address in VPIF registers */ 914e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_lock(&common->buffer_queue.vb_lock); 915e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1 = common->buffer_queue.bufs[tbuf.index]; 916e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buf1->memory != tbuf.memory) { 917e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid buffer type\n"); 918e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 919e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 920e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 921e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((buf1->state == VIDEOBUF_QUEUED) || 922e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (buf1->state == VIDEOBUF_ACTIVE)) { 923e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid state\n"); 924e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 925e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 926e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 927e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S switch (buf1->memory) { 928e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S case V4L2_MEMORY_MMAP: 929e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buf1->baddr == 0) 930e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 931e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S break; 932e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 933e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S case V4L2_MEMORY_USERPTR: 934e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (tbuf.length < buf1->bsize) 935e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 936e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 937e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VIDEOBUF_NEEDS_INIT != buf1->state) 938e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (buf1->baddr != tbuf.m.userptr)) 939e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_buffer_release(&common->buffer_queue, buf1); 940e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1->baddr = tbuf.m.userptr; 941e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S break; 942e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 943e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S default: 944e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 945e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 946e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 947e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_save(flags); 948e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_buffer_prepare(&common->buffer_queue, buf1, 949e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->buffer_queue.field); 950e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 951e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_restore(flags); 952e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto qbuf_exit; 953e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 954e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 955e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S buf1->state = VIDEOBUF_ACTIVE; 956e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = buf1->boff; 957e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = buf1; 958e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (tbuf.type != V4L2_BUF_TYPE_SLICED_VBI_OUTPUT) { 959e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr((addr + common->ytop_off), 960e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ybtm_off), 961e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ctop_off), 962e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->cbtm_off)); 963e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 964e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 965e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S local_irq_restore(flags); 966e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_add_tail(&buf1->stream, &common->buffer_queue.stream); 967e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->buffer_queue.vb_lock); 968e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 969e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 970e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sqbuf_exit: 971e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->buffer_queue.vb_lock); 972e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 973e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 974e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 975e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_std(struct file *file, void *priv, v4l2_std_id *std_id) 976e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 977e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 978e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 979e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 980e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 981e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 982e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!(*std_id & DM646X_V4L2_STD)) 983e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 984e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 985e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 986e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("streaming in progress\n"); 987e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 988e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 989e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 990e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Call encoder subdevice function to set the standard */ 99113df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 99213df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 993e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 994e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video.stdid = *std_id; 995e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the information about the standard */ 996e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_get_std_info(ch)) { 997e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Error getting the standard info\n"); 998e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 999e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1000e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1001e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->vpifparams.std_info.width * 1002e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.height * 2) > 1003e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[ch->channel_id]) { 1004e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("invalid std for this size\n"); 1005e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EINVAL; 1006e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto s_std_exit; 1007e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1008e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1009e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->fmt.fmt.pix.bytesperline = common->fmt.fmt.pix.width; 1010e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Configure the default format information */ 1011e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_format(ch); 1012e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1013e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, video, 1014e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_std_output, *std_id); 1015e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1016e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set output standard\n"); 1017e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto s_std_exit; 1018e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1019e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1020e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, core, 1021e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_std, *std_id); 1022e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1023e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set standard for sub devices\n"); 1024e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1025e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Ss_std_exit: 1026e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 1027e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1028e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1029e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1030e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_std(struct file *file, void *priv, v4l2_std_id *std) 1031e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1032e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1033e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1034e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1035e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *std = ch->video.stdid; 1036e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1037e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1038e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1039e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p) 1040e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1041e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1042e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1043e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1044e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1045e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_dqbuf(&common->buffer_queue, p, 1046e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (file->f_flags & O_NONBLOCK)); 1047e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1048e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1049e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_streamon(struct file *file, void *priv, 1050e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_buf_type buftype) 1051e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1052e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1053e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1054e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1055e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *oth_ch = vpif_obj.dev[!ch->channel_id]; 1056e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_params *vpif = &ch->vpifparams; 1057317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *vpif_config_data = 1058e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dev->platform_data; 1059e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S unsigned long addr = 0; 1060e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 1061e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1062e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype != V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1063e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer type not supported\n"); 1064e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1065e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1066e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1067e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 1068e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 1069e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 1070e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1071e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1072e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If Streaming is already started, return error */ 1073e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 1074e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("channel->started\n"); 1075e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 1076e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1077e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1078e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->channel_id == VPIF_CHANNEL2_VIDEO 1079e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && oth_ch->common[VPIF_VIDEO_INDEX].started && 1080e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.ycmux_mode == 0) 1081e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || ((ch->channel_id == VPIF_CHANNEL3_VIDEO) 1082e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (2 == oth_ch->common[VPIF_VIDEO_INDEX].started))) { 1083e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("other channel is using\n"); 1084e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EBUSY; 1085e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1086e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1087e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_check_format(ch, &common->fmt.fmt.pix); 1088e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1089e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1090e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1091e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Call videobuf_streamon to start streaming in videobuf */ 1092e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = videobuf_streamon(&common->buffer_queue); 1093e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1094e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("videobuf_streamon\n"); 1095e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1096e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1097e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 109813df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 109913df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 110013df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 1101e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If buffer queue is empty, return error */ 1102e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (list_empty(&common->dma_queue)) { 1103e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer queue is empty\n"); 1104e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EIO; 1105e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto streamon_exit; 1106e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1107e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1108e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the next frame from the buffer queue */ 1109e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->next_frm = common->cur_frm = 1110e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_entry(common->dma_queue.next, 1111e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct videobuf_buffer, queue); 1112e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1113e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S list_del(&common->cur_frm->queue); 1114e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Mark state of the current frame to active */ 1115e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm->state = VIDEOBUF_ACTIVE; 1116e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1117e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field_id and started member */ 1118e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->field_id = 0; 1119e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 1; 1120e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1121e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S addr = common->cur_frm->boff; 1122e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Calculate the offset for Y and C data in the buffer */ 1123e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_calculate_offsets(ch); 1124e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1125e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch->vpifparams.std_info.frm_fmt && 1126e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ((common->fmt.fmt.pix.field != V4L2_FIELD_NONE) 1127e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (common->fmt.fmt.pix.field != V4L2_FIELD_ANY))) 1128e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (!ch->vpifparams.std_info.frm_fmt 1129e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S && (common->fmt.fmt.pix.field == V4L2_FIELD_NONE))) { 1130e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("conflict in field format and std format\n"); 1131e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EINVAL; 1132e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto streamon_exit; 1133e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1134e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1135e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* clock settings */ 1136e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = 1137e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_data->set_clock(ch->vpifparams.std_info.ycmux_mode, 1138e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->vpifparams.std_info.hd_sd); 1139e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) { 1140e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("can't set clock\n"); 1141e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto streamon_exit; 1142e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1143e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1144e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* set the parameters and addresses */ 1145e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = vpif_set_video_params(vpif, ch->channel_id + 2); 1146e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1147e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto streamon_exit; 1148e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1149e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = ret; 1150e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_config_addr(ch, ret); 1151e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr((addr + common->ytop_off), 1152e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ybtm_off), 1153e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->ctop_off), 1154e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (addr + common->cbtm_off)); 1155e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1156e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set interrupt for both the fields in VPIF 1157e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S Register enable channel in VPIF register */ 1158e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 1159e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_assert(); 1160e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(1); 1161e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(1); 1162e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1163e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1164e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) 1165e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S || (common->started == 2)) { 1166e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_assert(); 1167e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(1); 1168e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(1); 1169e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1170e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel_first_int[VPIF_VIDEO_INDEX][ch->channel_id] = 1; 1171e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1172e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1173e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstreamon_exit: 1174e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 1175e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1176e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1177e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1178e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_streamoff(struct file *file, void *priv, 1179e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enum v4l2_buf_type buftype) 1180e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1181e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1182e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1183e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1184e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1185e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype != V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1186e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("buffer type not supported\n"); 1187e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1188e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1189e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1190e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!fh->io_allowed[VPIF_VIDEO_INDEX]) { 1191e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("fh->io_allowed\n"); 1192e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EACCES; 1193e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1194e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1195e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!common->started) { 1196e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("channel->started\n"); 1197e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1198e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1199e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 120013df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 120113df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 120213df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 1203e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (buftype == V4L2_BUF_TYPE_VIDEO_OUTPUT) { 1204e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* disable channel */ 1205e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (VPIF_CHANNEL2_VIDEO == ch->channel_id) { 1206e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel2(0); 1207e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel2_intr_enable(0); 1208e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1209e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((VPIF_CHANNEL3_VIDEO == ch->channel_id) || 1210e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (2 == common->started)) { 1211e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S enable_channel3(0); 1212e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S channel3_intr_enable(0); 1213e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1214e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1215e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1216e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 1217e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 1218e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1219e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return videobuf_streamoff(&common->buffer_queue); 1220e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1221e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1222e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_cropcap(struct file *file, void *priv, 1223e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_cropcap *crop) 1224e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1225e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1226e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1227e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1228e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (V4L2_BUF_TYPE_VIDEO_OUTPUT != crop->type) 1229e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1230e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1231e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->bounds.left = crop->bounds.top = 0; 1232e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.left = crop->defrect.top = 0; 1233e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.height = crop->bounds.height = common->height; 1234e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S crop->defrect.width = crop->bounds.width = common->width; 1235e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1236e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1237e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1238e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1239e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_enum_output(struct file *file, void *fh, 1240e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct v4l2_output *output) 1241e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1242e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1243317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config = vpif_dev->platform_data; 1244e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1245e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (output->index >= config->output_count) { 1246e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "Invalid output index\n"); 1247e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return -EINVAL; 1248e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1249e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1250e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S strcpy(output->name, config->output[output->index]); 1251e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S output->type = V4L2_OUTPUT_TYPE_ANALOG; 1252e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S output->std = DM646X_V4L2_STD; 1253e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1254e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1255e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1256e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1257e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_output(struct file *file, void *priv, unsigned int i) 1258e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1259e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1260e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1261e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 1262e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX]; 1263e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int ret = 0; 1264e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 126513df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S if (mutex_lock_interruptible(&common->lock)) 126613df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S return -ERESTARTSYS; 126713df4f6a36e41e0c8f25273ef2077b239f633265Chaithrika U S 1268e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (common->started) { 1269e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Streaming in progress\n"); 1270e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = -EBUSY; 1271e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto s_output_exit; 1272e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1273e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1274e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ret = v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 1, video, 1275e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S s_routing, 0, i, 0); 1276e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1277e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ret < 0) 1278e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Failed to set output standard\n"); 1279e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1280e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vid_ch->output_id = i; 1281e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1282e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Ss_output_exit: 1283e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_unlock(&common->lock); 1284e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return ret; 1285e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1286e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1287e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_output(struct file *file, void *priv, unsigned int *i) 1288e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1289e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1290e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1291e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_obj *vid_ch = &ch->video; 1292e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1293e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *i = vid_ch->output_id; 1294e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1295e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1296e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1297e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1298e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_g_priority(struct file *file, void *priv, enum v4l2_priority *p) 1299e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1300e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1301e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1302e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1303e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *p = v4l2_prio_max(&ch->prio); 1304e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1305e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1306e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1307e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1308e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_s_priority(struct file *file, void *priv, enum v4l2_priority p) 1309e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1310e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct vpif_fh *fh = priv; 1311e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch = fh->channel; 1312e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1313e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return v4l2_prio_change(&ch->prio, &fh->prio, p); 1314e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1315e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1316e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* vpif display ioctl operations */ 1317e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic const struct v4l2_ioctl_ops vpif_ioctl_ops = { 1318e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_querycap = vpif_querycap, 1319e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_priority = vpif_g_priority, 1320e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_priority = vpif_s_priority, 1321e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_enum_fmt_vid_out = vpif_enum_fmt_vid_out, 1322e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_fmt_vid_out = vpif_g_fmt_vid_out, 1323e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_fmt_vid_out = vpif_s_fmt_vid_out, 1324e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_try_fmt_vid_out = vpif_try_fmt_vid_out, 1325e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_reqbufs = vpif_reqbufs, 1326e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_querybuf = vpif_querybuf, 1327e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_qbuf = vpif_qbuf, 1328e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_dqbuf = vpif_dqbuf, 1329e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_streamon = vpif_streamon, 1330e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_streamoff = vpif_streamoff, 1331e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_std = vpif_s_std, 1332e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_std = vpif_g_std, 1333e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_enum_output = vpif_enum_output, 1334e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_s_output = vpif_s_output, 1335e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_g_output = vpif_g_output, 1336e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .vidioc_cropcap = vpif_cropcap, 1337e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1338e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1339e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic const struct v4l2_file_operations vpif_fops = { 1340e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .owner = THIS_MODULE, 1341e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .open = vpif_open, 1342e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .release = vpif_release, 1343e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .ioctl = video_ioctl2, 1344e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .mmap = vpif_mmap, 1345e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .poll = vpif_poll 1346e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1347e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1348e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct video_device vpif_video_template = { 1349e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .name = "vpif", 1350e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .fops = &vpif_fops, 1351e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .ioctl_ops = &vpif_ioctl_ops, 1352e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .tvnorms = DM646X_V4L2_STD, 1353e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .current_norm = V4L2_STD_625_50, 1354e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1355e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1356e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1357e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/*Configure the channels, buffer sizei, request irq */ 1358e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int initialize_vpif(void) 1359e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1360e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_channel_objects_index; 1361e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_buffer_channel_index; 1362e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int free_buffer_index; 1363e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int err = 0, i, j; 1364e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1365e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Default number of buffers should be 3 */ 1366e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch2_numbuffers > 0) && 1367e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (ch2_numbuffers < config_params.min_numbuffers)) 1368e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_numbuffers = config_params.min_numbuffers; 1369e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if ((ch3_numbuffers > 0) && 1370e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (ch3_numbuffers < config_params.min_numbuffers)) 1371e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_numbuffers = config_params.min_numbuffers; 1372e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1373e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set buffer size to min buffers size if invalid buffer size is 1374e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * given */ 1375e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch2_bufsize < config_params.min_bufsize[VPIF_CHANNEL2_VIDEO]) 1376e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_bufsize = 1377e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.min_bufsize[VPIF_CHANNEL2_VIDEO]; 1378e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch3_bufsize < config_params.min_bufsize[VPIF_CHANNEL3_VIDEO]) 1379e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_bufsize = 1380e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.min_bufsize[VPIF_CHANNEL3_VIDEO]; 1381e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1382e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[VPIF_CHANNEL2_VIDEO] = ch2_numbuffers; 1383e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1384e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch2_numbuffers) { 1385e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[VPIF_CHANNEL2_VIDEO] = 1386e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch2_bufsize; 1387e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1388e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[VPIF_CHANNEL3_VIDEO] = ch3_numbuffers; 1389e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1390e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (ch3_numbuffers) { 1391e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.channel_bufsize[VPIF_CHANNEL3_VIDEO] = 1392e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch3_bufsize; 1393e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1394e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1395e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for six channel objects */ 1396e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1397e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_obj.dev[i] = 1398e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kmalloc(sizeof(struct channel_obj), GFP_KERNEL); 1399e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* If memory allocation fails, return error */ 1400e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vpif_obj.dev[i]) { 1401e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_channel_objects_index = i; 1402e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1403e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto vpif_init_free_channel_objects; 1404e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1405e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1406e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1407e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_channel_objects_index = VPIF_DISPLAY_MAX_DEVICES; 1408e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_buffer_channel_index = VPIF_DISPLAY_NUM_CHANNELS; 1409e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_buffer_index = config_params.numbuffers[i - 1]; 1410e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1411e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1412e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1413e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Svpif_init_free_channel_objects: 1414e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < free_channel_objects_index; j++) 1415e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.dev[j]); 1416e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1417e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1418e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1419e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1420e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_probe: This function creates device entries by register itself to the 1421e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * V4L2 driver and initializes fields of each channel objects 1422e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1423e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic __init int vpif_probe(struct platform_device *pdev) 1424e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1425317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_subdev_info *subdevdata; 1426317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri struct vpif_display_config *config; 1427e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i, j = 0, k, q, m, err = 0; 1428e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct i2c_adapter *i2c_adap; 1429e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct common_obj *common; 1430e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 1431e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct video_device *vfd; 1432e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct resource *res; 1433e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int subdev_count; 1434e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1435e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dev = &pdev->dev; 1436e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1437317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri err = initialize_vpif(); 1438e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1439317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri if (err) { 1440317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri v4l2_err(vpif_dev->driver, "Error initializing vpif\n"); 1441317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri return err; 1442e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1443e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1444e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = v4l2_device_register(vpif_dev, &vpif_obj.v4l2_dev); 1445e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (err) { 1446e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_err(vpif_dev->driver, "Error registering v4l2 device\n"); 1447e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1448e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1449e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1450e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S k = 0; 1451e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, k))) { 1452e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = res->start; i <= res->end; i++) { 1453e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (request_irq(i, vpif_channel_isr, IRQF_DISABLED, 1454e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S "DM646x_Display", 1455e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (void *)(&vpif_obj.dev[k]->channel_id))) { 1456e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -EBUSY; 1457e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto vpif_int_err; 1458e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1459e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1460e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S k++; 1461e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1462e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1463e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1464e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1465e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the pointer to the channel object */ 1466e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[i]; 1467e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1468e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Allocate memory for video device */ 1469e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd = video_device_alloc(); 1470e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vfd == NULL) { 1471e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < i; j++) { 1472e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[j]; 1473e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_device_release(ch->video_dev); 1474e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1475e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1476317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri goto vpif_int_err; 1477e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1478e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1479e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field of video device */ 1480e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S *vfd = vpif_video_template; 1481e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd->v4l2_dev = &vpif_obj.v4l2_dev; 1482e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vfd->release = video_device_release; 1483e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S snprintf(vfd->name, sizeof(vfd->name), 1484e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S "DM646x_VPIFDisplay_DRIVER_V%d.%d.%d", 1485e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (VPIF_DISPLAY_VERSION_CODE >> 16) & 0xff, 1486e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (VPIF_DISPLAY_VERSION_CODE >> 8) & 0xff, 1487e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (VPIF_DISPLAY_VERSION_CODE) & 0xff); 1488e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1489e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Set video_dev to the video device */ 1490e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = vfd; 1491e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1492e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1493e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (j = 0; j < VPIF_DISPLAY_MAX_DEVICES; j++) { 1494e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[j]; 1495e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize field of the channel objects */ 1496e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S atomic_set(&ch->usrs, 0); 1497e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (k = 0; k < VPIF_NUMOBJECTS; k++) { 1498e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[k].numbuffers = 0; 1499e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common = &ch->common[k]; 1500e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->io_usrs = 0; 1501e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->started = 0; 1502e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S spin_lock_init(&common->irqlock); 1503e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S mutex_init(&common->lock); 1504e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = 0; 1505e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->set_addr = NULL; 1506e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ytop_off = common->ybtm_off = 0; 1507e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->ctop_off = common->cbtm_off = 0; 1508e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->cur_frm = common->next_frm = NULL; 1509e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&common->fmt, 0, sizeof(common->fmt)); 1510e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S common->numbuffers = config_params.numbuffers[k]; 1511e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1512e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1513e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->initialized = 0; 1514e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->channel_id = j; 1515e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (j < 2) 1516e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].numbuffers = 1517e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config_params.numbuffers[ch->channel_id]; 1518e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S else 1519e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].numbuffers = 0; 1520e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1521e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S memset(&ch->vpifparams, 0, sizeof(ch->vpifparams)); 1522e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1523e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Initialize prio member of channel object */ 1524e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_prio_init(&ch->prio); 1525e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->common[VPIF_VIDEO_INDEX].fmt.type = 1526e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S V4L2_BUF_TYPE_VIDEO_OUTPUT; 1527e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1528e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* register video device */ 1529e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_dbg(1, debug, "channel=%x,channel->video_dev=%x\n", 1530e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (int)ch, (int)&ch->video_dev); 1531e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1532e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = video_register_device(ch->video_dev, 1533e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S VFL_TYPE_GRABBER, (j ? 3 : 2)); 1534e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (err < 0) 1535e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_out; 1536e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1537e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_set_drvdata(ch->video_dev, ch); 1538e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1539e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1540e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S i2c_adap = i2c_get_adapter(1); 1541e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S config = pdev->dev.platform_data; 1542e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S subdev_count = config->subdev_count; 1543e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S subdevdata = config->subdevinfo; 1544e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_obj.sd = kmalloc(sizeof(struct v4l2_subdev *) * subdev_count, 1545e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S GFP_KERNEL); 1546e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_obj.sd == NULL) { 1547e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("unable to allocate memory for subdevice pointers\n"); 1548e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S err = -ENOMEM; 1549e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_out; 1550e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1551e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1552e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < subdev_count; i++) { 1553317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri vpif_obj.sd[i] = v4l2_i2c_new_subdev_board(&vpif_obj.v4l2_dev, 1554e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S i2c_adap, subdevdata[i].name, 1555317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri &subdevdata[i].board_info, 1556317b2e2f4b5d2b69d9bd49e4fed386d176344e76Muralidharan Karicheri NULL); 1557e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (!vpif_obj.sd[i]) { 1558e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("Error registering v4l2 subdevice\n"); 1559e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S goto probe_subdev_out; 1560e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1561e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1562e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S if (vpif_obj.sd[i]) 1563e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_obj.sd[i]->grp_id = 1 << i; 1564e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1565e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1566e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1567e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1568e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sprobe_subdev_out: 1569e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.sd); 1570e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sprobe_out: 1571e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (k = 0; k < j; k++) { 1572e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[k]; 1573e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_unregister_device(ch->video_dev); 1574e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_device_release(ch->video_dev); 1575e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = NULL; 1576e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1577e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Svpif_int_err: 1578e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_device_unregister(&vpif_obj.v4l2_dev); 1579e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S vpif_err("VPIF IRQ request failed\n"); 1580e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (q = k; k >= 0; k--) { 1581e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (m = i; m >= res->start; m--) 1582e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_irq(m, (void *)(&vpif_obj.dev[k]->channel_id)); 1583e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S res = platform_get_resource(pdev, IORESOURCE_IRQ, k-1); 1584e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S m = res->end; 1585e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1586e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1587e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return err; 1588e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1589e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1590e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1591e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_remove: It un-register channels from V4L2 driver 1592e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1593e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic int vpif_remove(struct platform_device *device) 1594e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1595e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct channel_obj *ch; 1596e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i; 1597e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1598e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S v4l2_device_unregister(&vpif_obj.v4l2_dev); 1599e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1600e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* un-register device */ 1601e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) { 1602e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Get the pointer to the channel object */ 1603e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch = vpif_obj.dev[i]; 1604e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S /* Unregister video device */ 1605e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S video_unregister_device(ch->video_dev); 1606e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1607e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S ch->video_dev = NULL; 1608e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1609e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1610e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return 0; 1611e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1612e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1613e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic struct platform_driver vpif_driver = { 1614e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .driver = { 1615e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .name = "vpif_display", 1616e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .owner = THIS_MODULE, 1617e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S }, 1618e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .probe = vpif_probe, 1619e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S .remove = vpif_remove, 1620e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S}; 1621e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1622e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic __init int vpif_init(void) 1623e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1624e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S return platform_driver_register(&vpif_driver); 1625e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1626e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1627e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S/* 1628e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * vpif_cleanup: This function un-registers device and driver to the kernel, 1629e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * frees requested irq handler and de-allocates memory allocated for channel 1630e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S * objects. 1631e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S */ 1632e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Sstatic void vpif_cleanup(void) 1633e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S{ 1634e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct platform_device *pdev; 1635e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S struct resource *res; 1636e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int irq_num; 1637e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S int i = 0; 1638e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1639e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S pdev = container_of(vpif_dev, struct platform_device, dev); 1640e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1641e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, i))) { 1642e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (irq_num = res->start; irq_num <= res->end; irq_num++) 1643e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S free_irq(irq_num, 1644e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S (void *)(&vpif_obj.dev[i]->channel_id)); 1645e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S i++; 1646e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S } 1647e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1648e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S platform_driver_unregister(&vpif_driver); 1649e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.sd); 1650e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S for (i = 0; i < VPIF_DISPLAY_MAX_DEVICES; i++) 1651e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S kfree(vpif_obj.dev[i]); 1652e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S} 1653e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U S 1654e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_init(vpif_init); 1655e7332e3a552f6e18b39f5b77ce964818d10c9743Chaithrika U Smodule_exit(vpif_cleanup); 1656