| Message ID | 1246554351-6191-1-git-send-email-m-karicheri2@ti.com (mailing list archive) |
|---|---|
| State | Not Applicable |
| Headers | show |
Mauro & Hans, I have taken care of the below changes as part of this patch. So please don't apply below from the original pull request. http://www.linuxtv.org/hg/~hverkuil/v4l-dvb-vpfe-cap/rev/ae2ca5c20d85 This will replace the patch 1/11 from the original pull request. Murali Karicheri Software Design Engineer Texas Instruments Inc. Germantown, MD 20874 Phone : 301-515-3736 email: m-karicheri2@ti.com >-----Original Message----- >From: Karicheri, Muralidharan >Sent: Thursday, July 02, 2009 1:06 PM >To: hverkuil@xs4all.nl; mchehab@infradead.org >Cc: linux-media@vger.kernel/org; davinci-linux-open- >source@linux.davincidsp.com; Karicheri, Muralidharan >Subject: [PATCH 1/11 - v3] vpfe capture bridge driver for DM355 and DM6446 > >From: Muralidharan Karicheri <m-karicheri2@ti.com> > >Re-sending to add description for VPFE_CMD_S_CCDC_RAW_PARAMS and >updating debug prints with \n and fixing an error coder ENOMEM > >VPFE Capture bridge driver > >This is version, v3 of vpfe capture bridge driver for doing video >capture on DM355 and DM6446 evms. The ccdc hw modules register with the >driver and are used for configuring the CCD Controller for a specific >decoder interface. The driver also registers the sub devices required >for a specific evm. More than one sub devices can be registered. >This allows driver to switch dynamically to capture video from >any sub device that is registered. Currently only one sub device >(tvp5146) is supported. But in future this driver is expected >to do capture from sensor devices such as Micron's MT9T001,MT9T031 >and MT9P031 etc. The driver currently supports MMAP based IO. > >Following are the updates based on review comments:- > 1) clean up of setting bus parameters in ccdc > 2) removed v4l2_routing structure type > 3) module authors, description changes > 4) pixel aspect constants removed > >Reviewed by: Hans Verkuil <hverkuil@xs4all.nl> >Reviewed by: Laurent Pinchart <laurent.pinchart@skynet.be> >Reviewed by: Alexey Klimov <klimov.linux@gmail.com> > >Signed-off-by: Muralidharan Karicheri <m-karicheri2@ti.com> >--- >Applies to v4l-dvb repository > > drivers/media/video/davinci/vpfe_capture.c | 2136 >++++++++++++++++++++++++++++ > include/media/davinci/vpfe_capture.h | 194 +++ > include/media/davinci/vpfe_types.h | 51 + > 3 files changed, 2381 insertions(+), 0 deletions(-) > create mode 100644 drivers/media/video/davinci/vpfe_capture.c > create mode 100644 include/media/davinci/vpfe_capture.h > create mode 100644 include/media/davinci/vpfe_types.h > >diff --git a/drivers/media/video/davinci/vpfe_capture.c >b/drivers/media/video/davinci/vpfe_capture.c >new file mode 100644 >index 0000000..8c05d68 >--- /dev/null >+++ b/drivers/media/video/davinci/vpfe_capture.c >@@ -0,0 +1,2136 @@ >+/* >+ * Copyright (C) 2008-2009 Texas Instruments Inc >+ * >+ * This program is free software; you can redistribute it and/or modify >+ * it under the terms of the GNU General Public License as published by >+ * the Free Software Foundation; either version 2 of the License, or >+ * (at your option) any later version. >+ * >+ * This program is distributed in the hope that it will be useful, >+ * but WITHOUT ANY WARRANTY; without even the implied warranty of >+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >+ * GNU General Public License for more details. >+ * >+ * You should have received a copy of the GNU General Public License >+ * along with this program; if not, write to the Free Software >+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 >USA >+ * >+ * Driver name : VPFE Capture driver >+ * VPFE Capture driver allows applications to capture and stream video >+ * frames on DaVinci SoCs (DM6446, DM355 etc) from a YUV source such as >+ * TVP5146 or Raw Bayer RGB image data from an image sensor >+ * such as Microns' MT9T001, MT9T031 etc. >+ * >+ * These SoCs have, in common, a Video Processing Subsystem (VPSS) that >+ * consists of a Video Processing Front End (VPFE) for capturing >+ * video/raw image data and Video Processing Back End (VPBE) for >displaying >+ * YUV data through an in-built analog encoder or Digital LCD port. >This >+ * driver is for capture through VPFE. A typical EVM using these SoCs >have >+ * following high level configuration. >+ * >+ * >+ * decoder(TVP5146/ YUV/ >+ * MT9T001) --> Raw Bayer RGB ---> MUX -> VPFE (CCDC/ISIF) >+ * data input | | >+ * V | >+ * SDRAM | >+ * V >+ * Image Processor >+ * | >+ * V >+ * SDRAM >+ * The data flow happens from a decoder connected to the VPFE over a >+ * YUV embedded (BT.656/BT.1120) or separate sync or raw bayer rgb >interface >+ * and to the input of VPFE through an optional MUX (if more inputs are >+ * to be interfaced on the EVM). The input data is first passed through >+ * CCDC (CCD Controller, a.k.a Image Sensor Interface, ISIF). The CCDC >+ * does very little or no processing on YUV data and does pre-process >Raw >+ * Bayer RGB data through modules such as Defect Pixel Correction (DFC) >+ * Color Space Conversion (CSC), data gain/offset etc. After this, data >+ * can be written to SDRAM or can be connected to the image processing >+ * block such as IPIPE (on DM355 only). >+ * >+ * Features supported >+ * - MMAP IO >+ * - Capture using TVP5146 over BT.656 >+ * - support for interfacing decoders using sub device model >+ * - Work with DM355 or DM6446 CCDC to do Raw Bayer RGB/YUV >+ * data capture to SDRAM. >+ * TODO list >+ * - Support multiple REQBUF after open >+ * - Support for de-allocating buffers through REQBUF >+ * - Support for Raw Bayer RGB capture >+ * - Support for chaining Image Processor >+ * - Support for static allocation of buffers >+ * - Support for USERPTR IO >+ * - Support for STREAMON before QBUF >+ * - Support for control ioctls >+ */ >+#include <linux/module.h> >+#include <linux/init.h> >+#include <linux/platform_device.h> >+#include <linux/interrupt.h> >+#include <linux/version.h> >+#include <media/v4l2-common.h> >+#include <linux/io.h> >+#include <media/davinci/vpfe_capture.h> >+#include <media/tvp514x.h> >+#include <linux/i2c.h> >+#include "ccdc_hw_device.h" >+ >+static int debug; >+static u32 numbuffers = 3; >+static u32 bufsize = (720 * 576 * 2); >+ >+module_param(numbuffers, uint, S_IRUGO); >+module_param(bufsize, uint, S_IRUGO); >+module_param(debug, int, 0644); >+ >+MODULE_PARM_DESC(numbuffers, "buffer count (default:3)"); >+MODULE_PARM_DESC(bufsize, "buffer size in bytes (default:720 x 576 x 2)"); >+MODULE_PARM_DESC(debug, "Debug level 0-1"); >+ >+MODULE_DESCRIPTION("VPFE Video for Linux Capture Driver"); >+MODULE_LICENSE("GPL"); >+MODULE_AUTHOR("Texas Instruments"); >+ >+/* standard information */ >+struct vpfe_standard { >+ v4l2_std_id std_id; >+ unsigned int width; >+ unsigned int height; >+ struct v4l2_fract pixelaspect; >+ /* 0 - progressive, 1 - interlaced */ >+ int frame_format; >+}; >+ >+/* ccdc configuration */ >+struct ccdc_config { >+ /* This make sure vpfe is probed and ready to go */ >+ int vpfe_probed; >+ /* name of ccdc device */ >+ char name[32]; >+ /* for storing mem maps for CCDC */ >+ int ccdc_addr_size; >+ void *__iomem ccdc_addr; >+}; >+ >+/* data structures */ >+static struct vpfe_config_params config_params = { >+ .min_numbuffers = 3, >+ .numbuffers = 3, >+ .min_bufsize = 720 * 480 * 2, >+ .device_bufsize = 720 * 576 * 2, >+}; >+ >+/* ccdc device registered */ >+static struct ccdc_hw_device *ccdc_dev; >+/* lock for accessing ccdc information */ >+static DEFINE_MUTEX(ccdc_lock); >+/* ccdc configuration */ >+static struct ccdc_config *ccdc_cfg; >+ >+const struct vpfe_standard vpfe_standards[] = { >+ {V4L2_STD_525_60, 720, 480, {11, 10}, 1}, >+ {V4L2_STD_625_50, 720, 576, {54, 59}, 1}, >+}; >+ >+/* Used when raw Bayer image from ccdc is directly captured to SDRAM */ >+static const struct vpfe_pixel_format vpfe_pix_fmts[] = { >+ { >+ .fmtdesc = { >+ .index = 0, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "Bayer GrRBGb 8bit A-Law compr.", >+ .pixelformat = V4L2_PIX_FMT_SBGGR8, >+ }, >+ .bpp = 1, >+ }, >+ { >+ .fmtdesc = { >+ .index = 1, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "Bayer GrRBGb - 16bit", >+ .pixelformat = V4L2_PIX_FMT_SBGGR16, >+ }, >+ .bpp = 2, >+ }, >+ { >+ .fmtdesc = { >+ .index = 2, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "Bayer GrRBGb 8bit DPCM compr.", >+ .pixelformat = V4L2_PIX_FMT_SGRBG10DPCM8, >+ }, >+ .bpp = 1, >+ }, >+ { >+ .fmtdesc = { >+ .index = 3, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "YCbCr 4:2:2 Interleaved UYVY", >+ .pixelformat = V4L2_PIX_FMT_UYVY, >+ }, >+ .bpp = 2, >+ }, >+ { >+ .fmtdesc = { >+ .index = 4, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "YCbCr 4:2:2 Interleaved YUYV", >+ .pixelformat = V4L2_PIX_FMT_YUYV, >+ }, >+ .bpp = 2, >+ }, >+ { >+ .fmtdesc = { >+ .index = 5, >+ .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, >+ .description = "Y/CbCr 4:2:0 - Semi planar", >+ .pixelformat = V4L2_PIX_FMT_NV12, >+ }, >+ .bpp = 1, >+ }, >+}; >+ >+/* >+ * vpfe_lookup_pix_format() >+ * lookup an entry in the vpfe pix format table based on pix_format >+ */ >+static const struct vpfe_pixel_format *vpfe_lookup_pix_format(u32 >pix_format) >+{ >+ int i; >+ >+ for (i = 0; i < ARRAY_SIZE(vpfe_pix_fmts); i++) { >+ if (pix_format == vpfe_pix_fmts[i].fmtdesc.pixelformat) >+ return &vpfe_pix_fmts[i]; >+ } >+ return NULL; >+} >+ >+/* >+ * vpfe_register_ccdc_device. CCDC module calls this to >+ * register with vpfe capture >+ */ >+int vpfe_register_ccdc_device(struct ccdc_hw_device *dev) >+{ >+ int ret = 0; >+ printk(KERN_NOTICE "vpfe_register_ccdc_device: %s\n", dev->name); >+ >+ BUG_ON(!dev->hw_ops.open); >+ BUG_ON(!dev->hw_ops.enable); >+ BUG_ON(!dev->hw_ops.set_hw_if_params); >+ BUG_ON(!dev->hw_ops.configure); >+ BUG_ON(!dev->hw_ops.set_buftype); >+ BUG_ON(!dev->hw_ops.get_buftype); >+ BUG_ON(!dev->hw_ops.enum_pix); >+ BUG_ON(!dev->hw_ops.set_frame_format); >+ BUG_ON(!dev->hw_ops.get_frame_format); >+ BUG_ON(!dev->hw_ops.get_pixel_format); >+ BUG_ON(!dev->hw_ops.set_pixel_format); >+ BUG_ON(!dev->hw_ops.set_params); >+ BUG_ON(!dev->hw_ops.set_image_window); >+ BUG_ON(!dev->hw_ops.get_image_window); >+ BUG_ON(!dev->hw_ops.get_line_length); >+ BUG_ON(!dev->hw_ops.setfbaddr); >+ BUG_ON(!dev->hw_ops.getfid); >+ >+ mutex_lock(&ccdc_lock); >+ if (NULL == ccdc_cfg) { >+ /* >+ * TODO. Will this ever happen? if so, we need to fix it. >+ * Proabably we need to add the request to a linked list and >+ * walk through it during vpfe probe >+ */ >+ printk(KERN_ERR "vpfe capture not initialized\n"); >+ ret = -1; >+ goto unlock; >+ } >+ >+ if (strcmp(dev->name, ccdc_cfg->name)) { >+ /* ignore this ccdc */ >+ ret = -1; >+ goto unlock; >+ } >+ >+ if (ccdc_dev) { >+ printk(KERN_ERR "ccdc already registered\n"); >+ ret = -1; >+ goto unlock; >+ } >+ >+ ccdc_dev = dev; >+ dev->hw_ops.set_ccdc_base(ccdc_cfg->ccdc_addr, >+ ccdc_cfg->ccdc_addr_size); >+unlock: >+ mutex_unlock(&ccdc_lock); >+ return ret; >+} >+EXPORT_SYMBOL(vpfe_register_ccdc_device); >+ >+/* >+ * vpfe_unregister_ccdc_device. CCDC module calls this to >+ * unregister with vpfe capture >+ */ >+void vpfe_unregister_ccdc_device(struct ccdc_hw_device *dev) >+{ >+ if (NULL == dev) { >+ printk(KERN_ERR "invalid ccdc device ptr\n"); >+ return; >+ } >+ >+ printk(KERN_NOTICE "vpfe_unregister_ccdc_device, dev->name = %s\n", >+ dev->name); >+ >+ if (strcmp(dev->name, ccdc_cfg->name)) { >+ /* ignore this ccdc */ >+ return; >+ } >+ >+ mutex_lock(&ccdc_lock); >+ ccdc_dev = NULL; >+ mutex_unlock(&ccdc_lock); >+ return; >+} >+EXPORT_SYMBOL(vpfe_unregister_ccdc_device); >+ >+/* >+ * vpfe_get_ccdc_image_format - Get image parameters based on CCDC >settings >+ */ >+static int vpfe_get_ccdc_image_format(struct vpfe_device *vpfe_dev, >+ struct v4l2_format *f) >+{ >+ struct v4l2_rect image_win; >+ enum ccdc_buftype buf_type; >+ enum ccdc_frmfmt frm_fmt; >+ >+ memset(f, 0, sizeof(*f)); >+ f->type = V4L2_BUF_TYPE_VIDEO_OUTPUT; >+ ccdc_dev->hw_ops.get_image_window(&image_win); >+ f->fmt.pix.width = image_win.width; >+ f->fmt.pix.height = image_win.height; >+ f->fmt.pix.bytesperline = ccdc_dev->hw_ops.get_line_length(); >+ f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * >+ f->fmt.pix.height; >+ buf_type = ccdc_dev->hw_ops.get_buftype(); >+ f->fmt.pix.pixelformat = ccdc_dev->hw_ops.get_pixel_format(); >+ frm_fmt = ccdc_dev->hw_ops.get_frame_format(); >+ if (frm_fmt == CCDC_FRMFMT_PROGRESSIVE) >+ f->fmt.pix.field = V4L2_FIELD_NONE; >+ else if (frm_fmt == CCDC_FRMFMT_INTERLACED) { >+ if (buf_type == CCDC_BUFTYPE_FLD_INTERLEAVED) >+ f->fmt.pix.field = V4L2_FIELD_INTERLACED; >+ else if (buf_type == CCDC_BUFTYPE_FLD_SEPARATED) >+ f->fmt.pix.field = V4L2_FIELD_SEQ_TB; >+ else { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf_type\n"); >+ return -EINVAL; >+ } >+ } else { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid frm_fmt\n"); >+ return -EINVAL; >+ } >+ return 0; >+} >+ >+/* >+ * vpfe_config_ccdc_image_format() >+ * For a pix format, configure ccdc to setup the capture >+ */ >+static int vpfe_config_ccdc_image_format(struct vpfe_device *vpfe_dev) >+{ >+ enum ccdc_frmfmt frm_fmt = CCDC_FRMFMT_INTERLACED; >+ int ret = 0; >+ >+ if (ccdc_dev->hw_ops.set_pixel_format( >+ vpfe_dev->fmt.fmt.pix.pixelformat) < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "couldn't set pix format in ccdc\n"); >+ return -EINVAL; >+ } >+ /* configure the image window */ >+ ccdc_dev->hw_ops.set_image_window(&vpfe_dev->crop); >+ >+ switch (vpfe_dev->fmt.fmt.pix.field) { >+ case V4L2_FIELD_INTERLACED: >+ /* do nothing, since it is default */ >+ ret = ccdc_dev->hw_ops.set_buftype( >+ CCDC_BUFTYPE_FLD_INTERLEAVED); >+ break; >+ case V4L2_FIELD_NONE: >+ frm_fmt = CCDC_FRMFMT_PROGRESSIVE; >+ /* buffer type only applicable for interlaced scan */ >+ break; >+ case V4L2_FIELD_SEQ_TB: >+ ret = ccdc_dev->hw_ops.set_buftype( >+ CCDC_BUFTYPE_FLD_SEPARATED); >+ break; >+ default: >+ return -EINVAL; >+ } >+ >+ /* set the frame format */ >+ if (!ret) >+ ret = ccdc_dev->hw_ops.set_frame_format(frm_fmt); >+ return ret; >+} >+/* >+ * vpfe_config_image_format() >+ * For a given standard, this functions sets up the default >+ * pix format & crop values in the vpfe device and ccdc. It first >+ * starts with defaults based values from the standard table. >+ * It then checks if sub device support g_fmt and then override the >+ * values based on that.Sets crop values to match with scan resolution >+ * starting at 0,0. It calls vpfe_config_ccdc_image_format() set the >+ * values in ccdc >+ */ >+static int vpfe_config_image_format(struct vpfe_device *vpfe_dev, >+ const v4l2_std_id *std_id) >+{ >+ struct vpfe_subdev_info *sdinfo = vpfe_dev->current_subdev; >+ int i, ret = 0; >+ >+ for (i = 0; i < ARRAY_SIZE(vpfe_standards); i++) { >+ if (vpfe_standards[i].std_id & *std_id) { >+ vpfe_dev->std_info.active_pixels = >+ vpfe_standards[i].width; >+ vpfe_dev->std_info.active_lines = >+ vpfe_standards[i].height; >+ vpfe_dev->std_info.frame_format = >+ vpfe_standards[i].frame_format; >+ vpfe_dev->std_index = i; >+ break; >+ } >+ } >+ >+ if (i == ARRAY_SIZE(vpfe_standards)) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "standard not supported\n"); >+ return -EINVAL; >+ } >+ >+ vpfe_dev->crop.top = 0; >+ vpfe_dev->crop.left = 0; >+ vpfe_dev->crop.width = vpfe_dev->std_info.active_pixels; >+ vpfe_dev->crop.height = vpfe_dev->std_info.active_lines; >+ vpfe_dev->fmt.fmt.pix.width = vpfe_dev->crop.width; >+ vpfe_dev->fmt.fmt.pix.height = vpfe_dev->crop.height; >+ >+ /* first field and frame format based on standard frame format */ >+ if (vpfe_dev->std_info.frame_format) { >+ vpfe_dev->fmt.fmt.pix.field = V4L2_FIELD_INTERLACED; >+ /* assume V4L2_PIX_FMT_UYVY as default */ >+ vpfe_dev->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_UYVY; >+ } else { >+ vpfe_dev->fmt.fmt.pix.field = V4L2_FIELD_NONE; >+ /* assume V4L2_PIX_FMT_SBGGR8 */ >+ vpfe_dev->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_SBGGR8; >+ } >+ >+ /* if sub device supports g_fmt, override the defaults */ >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, >+ sdinfo->grp_id, video, g_fmt, &vpfe_dev->fmt); >+ >+ if (ret && ret != -ENOIOCTLCMD) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "error in getting g_fmt from sub device\n"); >+ return ret; >+ } >+ >+ /* Sets the values in CCDC */ >+ ret = vpfe_config_ccdc_image_format(vpfe_dev); >+ if (ret) >+ return ret; >+ >+ /* Update the values of sizeimage and bytesperline */ >+ if (!ret) { >+ vpfe_dev->fmt.fmt.pix.bytesperline = >+ ccdc_dev->hw_ops.get_line_length(); >+ vpfe_dev->fmt.fmt.pix.sizeimage = >+ vpfe_dev->fmt.fmt.pix.bytesperline * >+ vpfe_dev->fmt.fmt.pix.height; >+ } >+ return ret; >+} >+ >+static int vpfe_initialize_device(struct vpfe_device *vpfe_dev) >+{ >+ int ret = 0; >+ >+ /* set first input of current subdevice as the current input */ >+ vpfe_dev->current_input = 0; >+ >+ /* set default standard */ >+ vpfe_dev->std_index = 0; >+ >+ /* Configure the default format information */ >+ ret = vpfe_config_image_format(vpfe_dev, >+ &vpfe_standards[vpfe_dev->std_index].std_id); >+ if (ret) >+ return ret; >+ >+ /* now open the ccdc device to initialize it */ >+ mutex_lock(&ccdc_lock); >+ if (NULL == ccdc_dev) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "ccdc device not registered\n"); >+ ret = -ENODEV; >+ goto unlock; >+ } >+ >+ if (!try_module_get(ccdc_dev->owner)) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Couldn't lock ccdc module\n"); >+ ret = -ENODEV; >+ goto unlock; >+ } >+ ret = ccdc_dev->hw_ops.open(vpfe_dev->pdev); >+ if (!ret) >+ vpfe_dev->initialized = 1; >+unlock: >+ mutex_unlock(&ccdc_lock); >+ return ret; >+} >+ >+/* >+ * vpfe_open : It creates object of file handle structure and >+ * stores it in private_data member of filepointer >+ */ >+static int vpfe_open(struct file *file) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_open\n"); >+ >+ if (!vpfe_dev->cfg->num_subdevs) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "No decoder registered\n"); >+ return -ENODEV; >+ } >+ >+ /* Allocate memory for the file handle object */ >+ fh = kmalloc(sizeof(struct vpfe_fh), GFP_KERNEL); >+ if (NULL == fh) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "unable to allocate memory for file handle object\n"); >+ return -ENOMEM; >+ } >+ /* store pointer to fh in private_data member of file */ >+ file->private_data = fh; >+ fh->vpfe_dev = vpfe_dev; >+ mutex_lock(&vpfe_dev->lock); >+ /* If decoder is not initialized. initialize it */ >+ if (!vpfe_dev->initialized) { >+ if (vpfe_initialize_device(vpfe_dev)) { >+ mutex_unlock(&vpfe_dev->lock); >+ return -ENODEV; >+ } >+ } >+ /* Increment device usrs counter */ >+ vpfe_dev->usrs++; >+ /* Set io_allowed member to false */ >+ fh->io_allowed = 0; >+ /* Initialize priority of this instance to default priority */ >+ fh->prio = V4L2_PRIORITY_UNSET; >+ v4l2_prio_open(&vpfe_dev->prio, &fh->prio); >+ mutex_unlock(&vpfe_dev->lock); >+ return 0; >+} >+ >+static void vpfe_schedule_next_buffer(struct vpfe_device *vpfe_dev) >+{ >+ unsigned long addr; >+ >+ vpfe_dev->next_frm = list_entry(vpfe_dev->dma_queue.next, >+ struct videobuf_buffer, queue); >+ list_del(&vpfe_dev->next_frm->queue); >+ vpfe_dev->next_frm->state = VIDEOBUF_ACTIVE; >+ addr = videobuf_to_dma_contig(vpfe_dev->next_frm); >+ ccdc_dev->hw_ops.setfbaddr(addr); >+} >+ >+static void vpfe_process_buffer_complete(struct vpfe_device *vpfe_dev) >+{ >+ struct timeval timevalue; >+ >+ do_gettimeofday(&timevalue); >+ vpfe_dev->cur_frm->ts = timevalue; >+ vpfe_dev->cur_frm->state = VIDEOBUF_DONE; >+ vpfe_dev->cur_frm->size = vpfe_dev->fmt.fmt.pix.sizeimage; >+ wake_up_interruptible(&vpfe_dev->cur_frm->done); >+ vpfe_dev->cur_frm = vpfe_dev->next_frm; >+} >+ >+/* ISR for VINT0*/ >+static irqreturn_t vpfe_isr(int irq, void *dev_id) >+{ >+ struct vpfe_device *vpfe_dev = dev_id; >+ enum v4l2_field field; >+ unsigned long addr; >+ int fid; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "\nStarting vpfe_isr...\n"); >+ field = vpfe_dev->fmt.fmt.pix.field; >+ >+ /* if streaming not started, don't do anything */ >+ if (!vpfe_dev->started) >+ return IRQ_HANDLED; >+ >+ /* only for 6446 this will be applicable */ >+ if (NULL != ccdc_dev->hw_ops.reset) >+ ccdc_dev->hw_ops.reset(); >+ >+ if (field == V4L2_FIELD_NONE) { >+ /* handle progressive frame capture */ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, >+ "frame format is progressive...\n"); >+ if (vpfe_dev->cur_frm != vpfe_dev->next_frm) >+ vpfe_process_buffer_complete(vpfe_dev); >+ return IRQ_HANDLED; >+ } >+ >+ /* interlaced or TB capture check which field we are in hardware */ >+ fid = ccdc_dev->hw_ops.getfid(); >+ >+ /* switch the software maintained field id */ >+ vpfe_dev->field_id ^= 1; >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "field id = %x:%x.\n", >+ fid, vpfe_dev->field_id); >+ if (fid == vpfe_dev->field_id) { >+ /* we are in-sync here,continue */ >+ if (fid == 0) { >+ /* >+ * One frame is just being captured. If the next frame >+ * is available, release the current frame and move on >+ */ >+ if (vpfe_dev->cur_frm != vpfe_dev->next_frm) >+ vpfe_process_buffer_complete(vpfe_dev); >+ /* >+ * based on whether the two fields are stored >+ * interleavely or separately in memory, reconfigure >+ * the CCDC memory address >+ */ >+ if (field == V4L2_FIELD_SEQ_TB) { >+ addr = >+ videobuf_to_dma_contig(vpfe_dev->cur_frm); >+ addr += vpfe_dev->field_off; >+ ccdc_dev->hw_ops.setfbaddr(addr); >+ } >+ return IRQ_HANDLED; >+ } >+ /* >+ * if one field is just being captured configure >+ * the next frame get the next frame from the empty >+ * queue if no frame is available hold on to the >+ * current buffer >+ */ >+ spin_lock(&vpfe_dev->dma_queue_lock); >+ if (!list_empty(&vpfe_dev->dma_queue) && >+ vpfe_dev->cur_frm == vpfe_dev->next_frm) >+ vpfe_schedule_next_buffer(vpfe_dev); >+ spin_unlock(&vpfe_dev->dma_queue_lock); >+ } else if (fid == 0) { >+ /* >+ * out of sync. Recover from any hardware out-of-sync. >+ * May loose one frame >+ */ >+ vpfe_dev->field_id = fid; >+ } >+ return IRQ_HANDLED; >+} >+ >+/* vdint1_isr - isr handler for VINT1 interrupt */ >+static irqreturn_t vdint1_isr(int irq, void *dev_id) >+{ >+ struct vpfe_device *vpfe_dev = dev_id; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "\nInside vdint1_isr...\n"); >+ >+ /* if streaming not started, don't do anything */ >+ if (!vpfe_dev->started) >+ return IRQ_HANDLED; >+ >+ spin_lock(&vpfe_dev->dma_queue_lock); >+ if ((vpfe_dev->fmt.fmt.pix.field == V4L2_FIELD_NONE) && >+ !list_empty(&vpfe_dev->dma_queue) && >+ vpfe_dev->cur_frm == vpfe_dev->next_frm) >+ vpfe_schedule_next_buffer(vpfe_dev); >+ spin_unlock(&vpfe_dev->dma_queue_lock); >+ return IRQ_HANDLED; >+} >+ >+static void vpfe_detach_irq(struct vpfe_device *vpfe_dev) >+{ >+ enum ccdc_frmfmt frame_format; >+ >+ frame_format = ccdc_dev->hw_ops.get_frame_format(); >+ if (frame_format == CCDC_FRMFMT_PROGRESSIVE) >+ free_irq(IRQ_VDINT1, vpfe_dev); >+} >+ >+static int vpfe_attach_irq(struct vpfe_device *vpfe_dev) >+{ >+ enum ccdc_frmfmt frame_format; >+ >+ frame_format = ccdc_dev->hw_ops.get_frame_format(); >+ if (frame_format == CCDC_FRMFMT_PROGRESSIVE) { >+ return request_irq(vpfe_dev->ccdc_irq1, vdint1_isr, >+ IRQF_DISABLED, "vpfe_capture1", >+ vpfe_dev); >+ } >+ return 0; >+} >+ >+/* vpfe_stop_ccdc_capture: stop streaming in ccdc/isif */ >+static void vpfe_stop_ccdc_capture(struct vpfe_device *vpfe_dev) >+{ >+ vpfe_dev->started = 0; >+ ccdc_dev->hw_ops.enable(0); >+ if (ccdc_dev->hw_ops.enable_out_to_sdram) >+ ccdc_dev->hw_ops.enable_out_to_sdram(0); >+} >+ >+/* >+ * vpfe_release : This function deletes buffer queue, frees the >+ * buffers and the vpfe file handle >+ */ >+static int vpfe_release(struct file *file) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh = file->private_data; >+ struct vpfe_subdev_info *sdinfo; >+ int ret; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_release\n"); >+ >+ /* Get the device lock */ >+ mutex_lock(&vpfe_dev->lock); >+ /* if this instance is doing IO */ >+ if (fh->io_allowed) { >+ if (vpfe_dev->started) { >+ sdinfo = vpfe_dev->current_subdev; >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, >+ sdinfo->grp_id, >+ video, s_stream, 0); >+ if (ret && (ret != -ENOIOCTLCMD)) >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "stream off failed in subdev\n"); >+ vpfe_stop_ccdc_capture(vpfe_dev); >+ vpfe_detach_irq(vpfe_dev); >+ videobuf_streamoff(&vpfe_dev->buffer_queue); >+ } >+ vpfe_dev->io_usrs = 0; >+ vpfe_dev->numbuffers = config_params.numbuffers; >+ } >+ >+ /* Decrement device usrs counter */ >+ vpfe_dev->usrs--; >+ /* Close the priority */ >+ v4l2_prio_close(&vpfe_dev->prio, &fh->prio); >+ /* If this is the last file handle */ >+ if (!vpfe_dev->usrs) { >+ vpfe_dev->initialized = 0; >+ if (ccdc_dev->hw_ops.close) >+ ccdc_dev->hw_ops.close(vpfe_dev->pdev); >+ module_put(ccdc_dev->owner); >+ } >+ mutex_unlock(&vpfe_dev->lock); >+ file->private_data = NULL; >+ /* Free memory allocated to file handle object */ >+ kfree(fh); >+ return 0; >+} >+ >+/* >+ * vpfe_mmap : It is used to map kernel space buffers >+ * into user spaces >+ */ >+static int vpfe_mmap(struct file *file, struct vm_area_struct *vma) >+{ >+ /* Get the device object and file handle object */ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_mmap\n"); >+ >+ return videobuf_mmap_mapper(&vpfe_dev->buffer_queue, vma); >+} >+ >+/* >+ * vpfe_poll: It is used for select/poll system call >+ */ >+static unsigned int vpfe_poll(struct file *file, poll_table *wait) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_poll\n"); >+ >+ if (vpfe_dev->started) >+ return videobuf_poll_stream(file, >+ &vpfe_dev->buffer_queue, wait); >+ return 0; >+} >+ >+/* vpfe capture driver file operations */ >+static const struct v4l2_file_operations vpfe_fops = { >+ .owner = THIS_MODULE, >+ .open = vpfe_open, >+ .release = vpfe_release, >+ .unlocked_ioctl = video_ioctl2, >+ .mmap = vpfe_mmap, >+ .poll = vpfe_poll >+}; >+ >+/* >+ * vpfe_check_format() >+ * This function adjust the input pixel format as per hardware >+ * capabilities and update the same in pixfmt. >+ * Following algorithm used :- >+ * >+ * If given pixformat is not in the vpfe list of pix formats or not >+ * supported by the hardware, current value of pixformat in the device >+ * is used >+ * If given field is not supported, then current field is used. If field >+ * is different from current, then it is matched with that from sub >device. >+ * Minimum height is 2 lines for interlaced or tb field and 1 line for >+ * progressive. Maximum height is clamped to active active lines of scan >+ * Minimum width is 32 bytes in memory and width is clamped to active >+ * pixels of scan. >+ * bytesperline is a multiple of 32. >+ */ >+static const struct vpfe_pixel_format * >+ vpfe_check_format(struct vpfe_device *vpfe_dev, >+ struct v4l2_pix_format *pixfmt) >+{ >+ u32 min_height = 1, min_width = 32, max_width, max_height; >+ const struct vpfe_pixel_format *vpfe_pix_fmt; >+ u32 pix; >+ int temp, found; >+ >+ vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); >+ if (NULL == vpfe_pix_fmt) { >+ /* >+ * use current pixel format in the vpfe device. We >+ * will find this pix format in the table >+ */ >+ pixfmt->pixelformat = vpfe_dev->fmt.fmt.pix.pixelformat; >+ vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); >+ } >+ >+ /* check if hw supports it */ >+ temp = 0; >+ found = 0; >+ while (ccdc_dev->hw_ops.enum_pix(&pix, temp) >= 0) { >+ if (vpfe_pix_fmt->fmtdesc.pixelformat == pix) { >+ found = 1; >+ break; >+ } >+ temp++; >+ } >+ >+ if (!found) { >+ /* use current pixel format */ >+ pixfmt->pixelformat = vpfe_dev->fmt.fmt.pix.pixelformat; >+ /* >+ * Since this is currently used in the vpfe device, we >+ * will find this pix format in the table >+ */ >+ vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); >+ } >+ >+ /* check what field format is supported */ >+ if (pixfmt->field == V4L2_FIELD_ANY) { >+ /* if field is any, use current value as default */ >+ pixfmt->field = vpfe_dev->fmt.fmt.pix.field; >+ } >+ >+ /* >+ * if field is not same as current field in the vpfe device >+ * try matching the field with the sub device field >+ */ >+ if (vpfe_dev->fmt.fmt.pix.field != pixfmt->field) { >+ /* >+ * If field value is not in the supported fields, use current >+ * field used in the device as default >+ */ >+ switch (pixfmt->field) { >+ case V4L2_FIELD_INTERLACED: >+ case V4L2_FIELD_SEQ_TB: >+ /* if sub device is supporting progressive, use that */ >+ if (!vpfe_dev->std_info.frame_format) >+ pixfmt->field = V4L2_FIELD_NONE; >+ break; >+ case V4L2_FIELD_NONE: >+ if (vpfe_dev->std_info.frame_format) >+ pixfmt->field = V4L2_FIELD_INTERLACED; >+ break; >+ >+ default: >+ /* use current field as default */ >+ pixfmt->field = vpfe_dev->fmt.fmt.pix.field; >+ break; >+ } >+ } >+ >+ /* Now adjust image resolutions supported */ >+ if (pixfmt->field == V4L2_FIELD_INTERLACED || >+ pixfmt->field == V4L2_FIELD_SEQ_TB) >+ min_height = 2; >+ >+ max_width = vpfe_dev->std_info.active_pixels; >+ max_height = vpfe_dev->std_info.active_lines; >+ min_width /= vpfe_pix_fmt->bpp; >+ >+ v4l2_info(&vpfe_dev->v4l2_dev, "width = %d, height = %d, bpp = %d\n", >+ pixfmt->width, pixfmt->height, vpfe_pix_fmt->bpp); >+ >+ pixfmt->width = clamp((pixfmt->width), min_width, max_width); >+ pixfmt->height = clamp((pixfmt->height), min_height, max_height); >+ >+ /* If interlaced, adjust height to be a multiple of 2 */ >+ if (pixfmt->field == V4L2_FIELD_INTERLACED) >+ pixfmt->height &= (~1); >+ /* >+ * recalculate bytesperline and sizeimage since width >+ * and height might have changed >+ */ >+ pixfmt->bytesperline = (((pixfmt->width * vpfe_pix_fmt->bpp) + 31) >+ & ~31); >+ if (pixfmt->pixelformat == V4L2_PIX_FMT_NV12) >+ pixfmt->sizeimage = >+ pixfmt->bytesperline * pixfmt->height + >+ ((pixfmt->bytesperline * pixfmt->height) >> 1); >+ else >+ pixfmt->sizeimage = pixfmt->bytesperline * pixfmt->height; >+ >+ v4l2_info(&vpfe_dev->v4l2_dev, "adjusted width = %d, height =" >+ " %d, bpp = %d, bytesperline = %d, sizeimage = %d\n", >+ pixfmt->width, pixfmt->height, vpfe_pix_fmt->bpp, >+ pixfmt->bytesperline, pixfmt->sizeimage); >+ return vpfe_pix_fmt; >+} >+ >+static int vpfe_querycap(struct file *file, void *priv, >+ struct v4l2_capability *cap) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querycap\n"); >+ >+ cap->version = VPFE_CAPTURE_VERSION_CODE; >+ cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; >+ strlcpy(cap->driver, CAPTURE_DRV_NAME, sizeof(cap->driver)); >+ strlcpy(cap->bus_info, "VPFE", sizeof(cap->bus_info)); >+ strlcpy(cap->card, vpfe_dev->cfg->card_name, sizeof(cap->card)); >+ return 0; >+} >+ >+static int vpfe_g_fmt_vid_cap(struct file *file, void *priv, >+ struct v4l2_format *fmt) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_fmt_vid_cap\n"); >+ /* Fill in the information about format */ >+ *fmt = vpfe_dev->fmt; >+ return ret; >+} >+ >+static int vpfe_enum_fmt_vid_cap(struct file *file, void *priv, >+ struct v4l2_fmtdesc *fmt) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ const struct vpfe_pixel_format *pix_fmt; >+ int temp_index; >+ u32 pix; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_enum_fmt_vid_cap\n"); >+ >+ if (ccdc_dev->hw_ops.enum_pix(&pix, fmt->index) < 0) >+ return -EINVAL; >+ >+ /* Fill in the information about format */ >+ pix_fmt = vpfe_lookup_pix_format(pix); >+ if (NULL != pix_fmt) { >+ temp_index = fmt->index; >+ *fmt = pix_fmt->fmtdesc; >+ fmt->index = temp_index; >+ return 0; >+ } >+ return -EINVAL; >+} >+ >+static int vpfe_s_fmt_vid_cap(struct file *file, void *priv, >+ struct v4l2_format *fmt) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ const struct vpfe_pixel_format *pix_fmts; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_fmt_vid_cap\n"); >+ >+ /* If streaming is started, return error */ >+ if (vpfe_dev->started) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Streaming is started\n"); >+ return -EBUSY; >+ } >+ >+ /* Check for valid frame format */ >+ pix_fmts = vpfe_check_format(vpfe_dev, &fmt->fmt.pix); >+ >+ if (NULL == pix_fmts) >+ return -EINVAL; >+ >+ /* store the pixel format in the device object */ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ /* First detach any IRQ if currently attached */ >+ vpfe_detach_irq(vpfe_dev); >+ vpfe_dev->fmt = *fmt; >+ /* set image capture parameters in the ccdc */ >+ ret = vpfe_config_ccdc_image_format(vpfe_dev); >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_try_fmt_vid_cap(struct file *file, void *priv, >+ struct v4l2_format *f) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ const struct vpfe_pixel_format *pix_fmts; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_try_fmt_vid_cap\n"); >+ >+ pix_fmts = vpfe_check_format(vpfe_dev, &f->fmt.pix); >+ if (NULL == pix_fmts) >+ return -EINVAL; >+ return 0; >+} >+ >+/* >+ * vpfe_get_subdev_input_index - Get subdev index and subdev input index >for a >+ * given app input index >+ */ >+static int vpfe_get_subdev_input_index(struct vpfe_device *vpfe_dev, >+ int *subdev_index, >+ int *subdev_input_index, >+ int app_input_index) >+{ >+ struct vpfe_config *cfg = vpfe_dev->cfg; >+ struct vpfe_subdev_info *sdinfo; >+ int i, j = 0; >+ >+ for (i = 0; i < cfg->num_subdevs; i++) { >+ sdinfo = &cfg->sub_devs[i]; >+ if (app_input_index < (j + sdinfo->num_inputs)) { >+ *subdev_index = i; >+ *subdev_input_index = app_input_index - j; >+ return 0; >+ } >+ j += sdinfo->num_inputs; >+ } >+ return -EINVAL; >+} >+ >+/* >+ * vpfe_get_app_input - Get app input index for a given subdev input index >+ * driver stores the input index of the current sub device and translate >it >+ * when application request the current input >+ */ >+static int vpfe_get_app_input_index(struct vpfe_device *vpfe_dev, >+ int *app_input_index) >+{ >+ struct vpfe_config *cfg = vpfe_dev->cfg; >+ struct vpfe_subdev_info *sdinfo; >+ int i, j = 0; >+ >+ for (i = 0; i < cfg->num_subdevs; i++) { >+ sdinfo = &cfg->sub_devs[i]; >+ if (!strcmp(sdinfo->name, vpfe_dev->current_subdev->name)) { >+ if (vpfe_dev->current_input >= sdinfo->num_inputs) >+ return -1; >+ *app_input_index = j + vpfe_dev->current_input; >+ return 0; >+ } >+ j += sdinfo->num_inputs; >+ } >+ return -EINVAL; >+} >+ >+static int vpfe_enum_input(struct file *file, void *priv, >+ struct v4l2_input *inp) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_subdev_info *sdinfo; >+ int subdev, index ; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_enum_input\n"); >+ >+ if (vpfe_get_subdev_input_index(vpfe_dev, >+ &subdev, >+ &index, >+ inp->index) < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "input information not found" >+ " for the subdev\n"); >+ return -EINVAL; >+ } >+ sdinfo = &vpfe_dev->cfg->sub_devs[subdev]; >+ memcpy(inp, &sdinfo->inputs[index], sizeof(struct v4l2_input)); >+ return 0; >+} >+ >+static int vpfe_g_input(struct file *file, void *priv, unsigned int >*index) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_input\n"); >+ >+ return vpfe_get_app_input_index(vpfe_dev, index); >+} >+ >+ >+static int vpfe_s_input(struct file *file, void *priv, unsigned int index) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_subdev_info *sdinfo; >+ int subdev_index, inp_index; >+ struct vpfe_route *route; >+ u32 input = 0, output = 0; >+ int ret = -EINVAL; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_input\n"); >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ /* >+ * If streaming is started return device busy >+ * error >+ */ >+ if (vpfe_dev->started) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Streaming is on\n"); >+ ret = -EBUSY; >+ goto unlock_out; >+ } >+ >+ if (vpfe_get_subdev_input_index(vpfe_dev, >+ &subdev_index, >+ &inp_index, >+ index) < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "invalid input index\n"); >+ goto unlock_out; >+ } >+ >+ sdinfo = &vpfe_dev->cfg->sub_devs[subdev_index]; >+ route = &sdinfo->routes[inp_index]; >+ if (route && sdinfo->can_route) { >+ input = route->input; >+ output = route->output; >+ } >+ >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, >+ video, s_routing, input, output, 0); >+ >+ if (ret) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "vpfe_doioctl:error in setting input in decoder\n"); >+ ret = -EINVAL; >+ goto unlock_out; >+ } >+ vpfe_dev->current_subdev = sdinfo; >+ vpfe_dev->current_input = index; >+ vpfe_dev->std_index = 0; >+ >+ /* set the bus/interface parameter for the sub device in ccdc */ >+ ret = ccdc_dev->hw_ops.set_hw_if_params(&sdinfo->ccdc_if_params); >+ if (ret) >+ goto unlock_out; >+ >+ /* set the default image parameters in the device */ >+ ret = vpfe_config_image_format(vpfe_dev, >+ &vpfe_standards[vpfe_dev->std_index].std_id); >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_querystd(struct file *file, void *priv, v4l2_std_id >*std_id) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_subdev_info *sdinfo; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querystd\n"); >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ sdinfo = vpfe_dev->current_subdev; >+ if (ret) >+ return ret; >+ /* Call querystd function of decoder device */ >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, >+ video, querystd, std_id); >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_s_std(struct file *file, void *priv, v4l2_std_id *std_id) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_subdev_info *sdinfo; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_std\n"); >+ >+ /* Call decoder driver function to set the standard */ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ sdinfo = vpfe_dev->current_subdev; >+ /* If streaming is started, return device busy error */ >+ if (vpfe_dev->started) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "streaming is started\n"); >+ ret = -EBUSY; >+ goto unlock_out; >+ } >+ >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, >+ core, s_std, *std_id); >+ if (ret < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Failed to set standard\n"); >+ goto unlock_out; >+ } >+ ret = vpfe_config_image_format(vpfe_dev, std_id); >+ >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_g_std(struct file *file, void *priv, v4l2_std_id *std_id) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_std\n"); >+ >+ *std_id = vpfe_standards[vpfe_dev->std_index].std_id; >+ return 0; >+} >+/* >+ * Videobuf operations >+ */ >+static int vpfe_videobuf_setup(struct videobuf_queue *vq, >+ unsigned int *count, >+ unsigned int *size) >+{ >+ struct vpfe_fh *fh = vq->priv_data; >+ struct vpfe_device *vpfe_dev = fh->vpfe_dev; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_setup\n"); >+ *size = config_params.device_bufsize; >+ >+ if (*count < config_params.min_numbuffers) >+ *count = config_params.min_numbuffers; >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, >+ "count=%d, size=%d\n", *count, *size); >+ return 0; >+} >+ >+static int vpfe_videobuf_prepare(struct videobuf_queue *vq, >+ struct videobuf_buffer *vb, >+ enum v4l2_field field) >+{ >+ struct vpfe_fh *fh = vq->priv_data; >+ struct vpfe_device *vpfe_dev = fh->vpfe_dev; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_prepare\n"); >+ >+ /* If buffer is not initialized, initialize it */ >+ if (VIDEOBUF_NEEDS_INIT == vb->state) { >+ vb->width = vpfe_dev->fmt.fmt.pix.width; >+ vb->height = vpfe_dev->fmt.fmt.pix.height; >+ vb->size = vpfe_dev->fmt.fmt.pix.sizeimage; >+ vb->field = field; >+ } >+ vb->state = VIDEOBUF_PREPARED; >+ return 0; >+} >+ >+static void vpfe_videobuf_queue(struct videobuf_queue *vq, >+ struct videobuf_buffer *vb) >+{ >+ /* Get the file handle object and device object */ >+ struct vpfe_fh *fh = vq->priv_data; >+ struct vpfe_device *vpfe_dev = fh->vpfe_dev; >+ unsigned long flags; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_queue\n"); >+ >+ /* add the buffer to the DMA queue */ >+ spin_lock_irqsave(&vpfe_dev->dma_queue_lock, flags); >+ list_add_tail(&vb->queue, &vpfe_dev->dma_queue); >+ spin_unlock_irqrestore(&vpfe_dev->dma_queue_lock, flags); >+ >+ /* Change state of the buffer */ >+ vb->state = VIDEOBUF_QUEUED; >+} >+ >+static void vpfe_videobuf_release(struct videobuf_queue *vq, >+ struct videobuf_buffer *vb) >+{ >+ struct vpfe_fh *fh = vq->priv_data; >+ struct vpfe_device *vpfe_dev = fh->vpfe_dev; >+ unsigned long flags; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_videobuf_release\n"); >+ >+ /* >+ * We need to flush the buffer from the dma queue since >+ * they are de-allocated >+ */ >+ spin_lock_irqsave(&vpfe_dev->dma_queue_lock, flags); >+ INIT_LIST_HEAD(&vpfe_dev->dma_queue); >+ spin_unlock_irqrestore(&vpfe_dev->dma_queue_lock, flags); >+ videobuf_dma_contig_free(vq, vb); >+ vb->state = VIDEOBUF_NEEDS_INIT; >+} >+ >+static struct videobuf_queue_ops vpfe_videobuf_qops = { >+ .buf_setup = vpfe_videobuf_setup, >+ .buf_prepare = vpfe_videobuf_prepare, >+ .buf_queue = vpfe_videobuf_queue, >+ .buf_release = vpfe_videobuf_release, >+}; >+ >+/* >+ * vpfe_reqbufs. currently support REQBUF only once opening >+ * the device. >+ */ >+static int vpfe_reqbufs(struct file *file, void *priv, >+ struct v4l2_requestbuffers *req_buf) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh = file->private_data; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_reqbufs\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != req_buf->type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buffer type\n"); >+ return -EINVAL; >+ } >+ >+ if (V4L2_MEMORY_USERPTR == req_buf->memory) { >+ /* we don't support user ptr IO */ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_reqbufs:" >+ " USERPTR IO not supported\n"); >+ return -EINVAL; >+ } >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ if (vpfe_dev->io_usrs != 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Only one IO user allowed\n"); >+ ret = -EBUSY; >+ goto unlock_out; >+ } >+ >+ vpfe_dev->memory = req_buf->memory; >+ videobuf_queue_dma_contig_init(&vpfe_dev->buffer_queue, >+ &vpfe_videobuf_qops, >+ NULL, >+ &vpfe_dev->irqlock, >+ req_buf->type, >+ vpfe_dev->fmt.fmt.pix.field, >+ sizeof(struct videobuf_buffer), >+ fh); >+ >+ fh->io_allowed = 1; >+ vpfe_dev->io_usrs = 1; >+ INIT_LIST_HEAD(&vpfe_dev->dma_queue); >+ ret = videobuf_reqbufs(&vpfe_dev->buffer_queue, req_buf); >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_querybuf(struct file *file, void *priv, >+ struct v4l2_buffer *buf) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querybuf\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf->type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); >+ return -EINVAL; >+ } >+ >+ if (vpfe_dev->memory != V4L2_MEMORY_MMAP) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid memory\n"); >+ return -EINVAL; >+ } >+ /* Call videobuf_querybuf to get information */ >+ return videobuf_querybuf(&vpfe_dev->buffer_queue, buf); >+} >+ >+static int vpfe_qbuf(struct file *file, void *priv, >+ struct v4l2_buffer *p) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh = file->private_data; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_qbuf\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != p->type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); >+ return -EINVAL; >+ } >+ >+ /* >+ * If this file handle is not allowed to do IO, >+ * return error >+ */ >+ if (!fh->io_allowed) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); >+ return -EACCES; >+ } >+ return videobuf_qbuf(&vpfe_dev->buffer_queue, p); >+} >+ >+static int vpfe_dqbuf(struct file *file, void *priv, >+ struct v4l2_buffer *buf) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_dqbuf\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf->type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); >+ return -EINVAL; >+ } >+ return videobuf_dqbuf(&vpfe_dev->buffer_queue, >+ buf, file->f_flags & O_NONBLOCK); >+} >+ >+/* >+ * vpfe_calculate_offsets : This function calculates buffers offset >+ * for top and bottom field >+ */ >+static void vpfe_calculate_offsets(struct vpfe_device *vpfe_dev) >+{ >+ struct v4l2_rect image_win; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_calculate_offsets\n"); >+ >+ ccdc_dev->hw_ops.get_image_window(&image_win); >+ vpfe_dev->field_off = image_win.height * image_win.width; >+} >+ >+/* vpfe_start_ccdc_capture: start streaming in ccdc/isif */ >+static void vpfe_start_ccdc_capture(struct vpfe_device *vpfe_dev) >+{ >+ ccdc_dev->hw_ops.enable(1); >+ if (ccdc_dev->hw_ops.enable_out_to_sdram) >+ ccdc_dev->hw_ops.enable_out_to_sdram(1); >+ vpfe_dev->started = 1; >+} >+ >+/* >+ * vpfe_streamon. Assume the DMA queue is not empty. >+ * application is expected to call QBUF before calling >+ * this ioctl. If not, driver returns error >+ */ >+static int vpfe_streamon(struct file *file, void *priv, >+ enum v4l2_buf_type buf_type) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh = file->private_data; >+ struct vpfe_subdev_info *sdinfo; >+ unsigned long addr; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_streamon\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf_type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); >+ return -EINVAL; >+ } >+ >+ /* If file handle is not allowed IO, return error */ >+ if (!fh->io_allowed) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); >+ return -EACCES; >+ } >+ >+ sdinfo = vpfe_dev->current_subdev; >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, >+ video, s_stream, 1); >+ >+ if (ret && (ret != -ENOIOCTLCMD)) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "stream on failed in subdev\n"); >+ return -EINVAL; >+ } >+ >+ /* If buffer queue is empty, return error */ >+ if (list_empty(&vpfe_dev->buffer_queue.stream)) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "buffer queue is empty\n"); >+ return -EIO; >+ } >+ >+ /* Call videobuf_streamon to start streaming * in videobuf */ >+ ret = videobuf_streamon(&vpfe_dev->buffer_queue); >+ if (ret) >+ return ret; >+ >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ goto streamoff; >+ /* Get the next frame from the buffer queue */ >+ vpfe_dev->next_frm = list_entry(vpfe_dev->dma_queue.next, >+ struct videobuf_buffer, queue); >+ vpfe_dev->cur_frm = vpfe_dev->next_frm; >+ /* Remove buffer from the buffer queue */ >+ list_del(&vpfe_dev->cur_frm->queue); >+ /* Mark state of the current frame to active */ >+ vpfe_dev->cur_frm->state = VIDEOBUF_ACTIVE; >+ /* Initialize field_id and started member */ >+ vpfe_dev->field_id = 0; >+ addr = videobuf_to_dma_contig(vpfe_dev->cur_frm); >+ >+ /* Calculate field offset */ >+ vpfe_calculate_offsets(vpfe_dev); >+ >+ if (vpfe_attach_irq(vpfe_dev) < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Error in attaching interrupt handle\n"); >+ ret = -EFAULT; >+ goto unlock_out; >+ } >+ if (ccdc_dev->hw_ops.configure() < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Error in configuring ccdc\n"); >+ ret = -EINVAL; >+ goto unlock_out; >+ } >+ ccdc_dev->hw_ops.setfbaddr((unsigned long)(addr)); >+ vpfe_start_ccdc_capture(vpfe_dev); >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+streamoff: >+ ret = videobuf_streamoff(&vpfe_dev->buffer_queue); >+ return ret; >+} >+ >+static int vpfe_streamoff(struct file *file, void *priv, >+ enum v4l2_buf_type buf_type) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ struct vpfe_fh *fh = file->private_data; >+ struct vpfe_subdev_info *sdinfo; >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_streamoff\n"); >+ >+ if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf_type) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); >+ return -EINVAL; >+ } >+ >+ /* If io is allowed for this file handle, return error */ >+ if (!fh->io_allowed) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); >+ return -EACCES; >+ } >+ >+ /* If streaming is not started, return error */ >+ if (!vpfe_dev->started) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "device started\n"); >+ return -EINVAL; >+ } >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ vpfe_stop_ccdc_capture(vpfe_dev); >+ vpfe_detach_irq(vpfe_dev); >+ >+ sdinfo = vpfe_dev->current_subdev; >+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, >+ video, s_stream, 0); >+ >+ if (ret && (ret != -ENOIOCTLCMD)) >+ v4l2_err(&vpfe_dev->v4l2_dev, "stream off failed in subdev\n"); >+ ret = videobuf_streamoff(&vpfe_dev->buffer_queue); >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+static int vpfe_cropcap(struct file *file, void *priv, >+ struct v4l2_cropcap *crop) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_cropcap\n"); >+ >+ if (vpfe_dev->std_index > ARRAY_SIZE(vpfe_standards)) >+ return -EINVAL; >+ >+ memset(crop, 0, sizeof(struct v4l2_cropcap)); >+ crop->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; >+ crop->bounds.width = crop->defrect.width = >+ vpfe_standards[vpfe_dev->std_index].width; >+ crop->bounds.height = crop->defrect.height = >+ vpfe_standards[vpfe_dev->std_index].height; >+ crop->pixelaspect = vpfe_standards[vpfe_dev->std_index].pixelaspect; >+ return 0; >+} >+ >+static int vpfe_g_crop(struct file *file, void *priv, >+ struct v4l2_crop *crop) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_crop\n"); >+ >+ crop->c = vpfe_dev->crop; >+ return 0; >+} >+ >+static int vpfe_s_crop(struct file *file, void *priv, >+ struct v4l2_crop *crop) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_crop\n"); >+ >+ if (vpfe_dev->started) { >+ /* make sure streaming is not started */ >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Cannot change crop when streaming is ON\n"); >+ return -EBUSY; >+ } >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ if (crop->c.top < 0 || crop->c.left < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "doesn't support negative values for top & left\n"); >+ ret = -EINVAL; >+ goto unlock_out; >+ } >+ >+ /* adjust the width to 16 pixel boundry */ >+ crop->c.width = ((crop->c.width + 15) & ~0xf); >+ >+ /* make sure parameters are valid */ >+ if ((crop->c.left + crop->c.width > >+ vpfe_dev->std_info.active_pixels) || >+ (crop->c.top + crop->c.height > >+ vpfe_dev->std_info.active_lines)) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "Error in S_CROP params\n"); >+ ret = -EINVAL; >+ goto unlock_out; >+ } >+ ccdc_dev->hw_ops.set_image_window(&crop->c); >+ vpfe_dev->fmt.fmt.pix.width = crop->c.width; >+ vpfe_dev->fmt.fmt.pix.height = crop->c.height; >+ vpfe_dev->fmt.fmt.pix.bytesperline = >+ ccdc_dev->hw_ops.get_line_length(); >+ vpfe_dev->fmt.fmt.pix.sizeimage = >+ vpfe_dev->fmt.fmt.pix.bytesperline * >+ vpfe_dev->fmt.fmt.pix.height; >+ vpfe_dev->crop = crop->c; >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+ >+static long vpfe_param_handler(struct file *file, void *priv, >+ int cmd, void *param) >+{ >+ struct vpfe_device *vpfe_dev = video_drvdata(file); >+ int ret = 0; >+ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_param_handler\n"); >+ >+ if (vpfe_dev->started) { >+ /* only allowed if streaming is not started */ >+ v4l2_err(&vpfe_dev->v4l2_dev, "device already started\n"); >+ return -EBUSY; >+ } >+ >+ ret = mutex_lock_interruptible(&vpfe_dev->lock); >+ if (ret) >+ return ret; >+ >+ switch (cmd) { >+ case VPFE_CMD_S_CCDC_RAW_PARAMS: >+ ret = ccdc_dev->hw_ops.set_params(param); >+ if (ret) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Error in setting parameters in CCDC\n"); >+ goto unlock_out; >+ } >+ if (vpfe_get_ccdc_image_format(vpfe_dev, &vpfe_dev->fmt) < 0) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Invalid image format at CCDC\n"); >+ goto unlock_out; >+ } >+ break; >+ default: >+ ret = -EINVAL; >+ } >+unlock_out: >+ mutex_unlock(&vpfe_dev->lock); >+ return ret; >+} >+ >+ >+/* vpfe capture ioctl operations */ >+static const struct v4l2_ioctl_ops vpfe_ioctl_ops = { >+ .vidioc_querycap = vpfe_querycap, >+ .vidioc_g_fmt_vid_cap = vpfe_g_fmt_vid_cap, >+ .vidioc_enum_fmt_vid_cap = vpfe_enum_fmt_vid_cap, >+ .vidioc_s_fmt_vid_cap = vpfe_s_fmt_vid_cap, >+ .vidioc_try_fmt_vid_cap = vpfe_try_fmt_vid_cap, >+ .vidioc_enum_input = vpfe_enum_input, >+ .vidioc_g_input = vpfe_g_input, >+ .vidioc_s_input = vpfe_s_input, >+ .vidioc_querystd = vpfe_querystd, >+ .vidioc_s_std = vpfe_s_std, >+ .vidioc_g_std = vpfe_g_std, >+ .vidioc_reqbufs = vpfe_reqbufs, >+ .vidioc_querybuf = vpfe_querybuf, >+ .vidioc_qbuf = vpfe_qbuf, >+ .vidioc_dqbuf = vpfe_dqbuf, >+ .vidioc_streamon = vpfe_streamon, >+ .vidioc_streamoff = vpfe_streamoff, >+ .vidioc_cropcap = vpfe_cropcap, >+ .vidioc_g_crop = vpfe_g_crop, >+ .vidioc_s_crop = vpfe_s_crop, >+ .vidioc_default = vpfe_param_handler, >+}; >+ >+static struct vpfe_device *vpfe_initialize(void) >+{ >+ struct vpfe_device *vpfe_dev; >+ >+ /* Default number of buffers should be 3 */ >+ if ((numbuffers > 0) && >+ (numbuffers < config_params.min_numbuffers)) >+ numbuffers = config_params.min_numbuffers; >+ >+ /* >+ * Set buffer size to min buffers size if invalid buffer size is >+ * given >+ */ >+ if (bufsize < config_params.min_bufsize) >+ bufsize = config_params.min_bufsize; >+ >+ config_params.numbuffers = numbuffers; >+ >+ if (numbuffers) >+ config_params.device_bufsize = bufsize; >+ >+ /* Allocate memory for device objects */ >+ vpfe_dev = kzalloc(sizeof(*vpfe_dev), GFP_KERNEL); >+ >+ return vpfe_dev; >+} >+ >+static void vpfe_disable_clock(struct vpfe_device *vpfe_dev) >+{ >+ struct vpfe_config *vpfe_cfg = vpfe_dev->cfg; >+ >+ clk_disable(vpfe_cfg->vpssclk); >+ clk_put(vpfe_cfg->vpssclk); >+ clk_disable(vpfe_cfg->slaveclk); >+ clk_put(vpfe_cfg->slaveclk); >+ v4l2_info(vpfe_dev->pdev->driver, >+ "vpfe vpss master & slave clocks disabled\n"); >+} >+ >+static int vpfe_enable_clock(struct vpfe_device *vpfe_dev) >+{ >+ struct vpfe_config *vpfe_cfg = vpfe_dev->cfg; >+ int ret = -ENOENT; >+ >+ vpfe_cfg->vpssclk = clk_get(vpfe_dev->pdev, "vpss_master"); >+ if (NULL == vpfe_cfg->vpssclk) { >+ v4l2_err(vpfe_dev->pdev->driver, "No clock defined for" >+ "vpss_master\n"); >+ return ret; >+ } >+ >+ if (clk_enable(vpfe_cfg->vpssclk)) { >+ v4l2_err(vpfe_dev->pdev->driver, >+ "vpfe vpss master clock not enabled\n"); >+ goto out; >+ } >+ v4l2_info(vpfe_dev->pdev->driver, >+ "vpfe vpss master clock enabled\n"); >+ >+ vpfe_cfg->slaveclk = clk_get(vpfe_dev->pdev, "vpss_slave"); >+ if (NULL == vpfe_cfg->slaveclk) { >+ v4l2_err(vpfe_dev->pdev->driver, >+ "No clock defined for vpss slave\n"); >+ goto out; >+ } >+ >+ if (clk_enable(vpfe_cfg->slaveclk)) { >+ v4l2_err(vpfe_dev->pdev->driver, >+ "vpfe vpss slave clock not enabled\n"); >+ goto out; >+ } >+ v4l2_info(vpfe_dev->pdev->driver, "vpfe vpss slave clock enabled\n"); >+ return 0; >+out: >+ if (vpfe_cfg->vpssclk) >+ clk_put(vpfe_cfg->vpssclk); >+ if (vpfe_cfg->slaveclk) >+ clk_put(vpfe_cfg->slaveclk); >+ >+ return -1; >+} >+ >+/* >+ * vpfe_probe : This function creates device entries by register >+ * itself to the V4L2 driver and initializes fields of each >+ * device objects >+ */ >+static __init int vpfe_probe(struct platform_device *pdev) >+{ >+ struct vpfe_config *vpfe_cfg; >+ struct resource *res1; >+ struct vpfe_device *vpfe_dev; >+ struct i2c_adapter *i2c_adap; >+ struct i2c_client *client; >+ struct video_device *vfd; >+ int ret = -ENOMEM, i, j; >+ int num_subdevs = 0; >+ >+ /* Get the pointer to the device object */ >+ vpfe_dev = vpfe_initialize(); >+ >+ if (!vpfe_dev) { >+ v4l2_err(pdev->dev.driver, >+ "Failed to allocate memory for vpfe_dev\n"); >+ return ret; >+ } >+ >+ vpfe_dev->pdev = &pdev->dev; >+ >+ if (NULL == pdev->dev.platform_data) { >+ v4l2_err(pdev->dev.driver, "Unable to get vpfe config\n"); >+ ret = -ENOENT; >+ goto probe_free_dev_mem; >+ } >+ >+ vpfe_cfg = pdev->dev.platform_data; >+ vpfe_dev->cfg = vpfe_cfg; >+ if (NULL == vpfe_cfg->ccdc || >+ NULL == vpfe_cfg->card_name || >+ NULL == vpfe_cfg->sub_devs) { >+ v4l2_err(pdev->dev.driver, "null ptr in vpfe_cfg\n"); >+ ret = -ENOENT; >+ goto probe_free_dev_mem; >+ } >+ >+ /* enable vpss clocks */ >+ ret = vpfe_enable_clock(vpfe_dev); >+ if (ret) >+ goto probe_free_dev_mem; >+ >+ mutex_lock(&ccdc_lock); >+ /* Allocate memory for ccdc configuration */ >+ ccdc_cfg = kmalloc(sizeof(struct ccdc_config), GFP_KERNEL); >+ if (NULL == ccdc_cfg) { >+ v4l2_err(pdev->dev.driver, >+ "Memory allocation failed for ccdc_cfg\n"); >+ goto probe_disable_clock; >+ } >+ >+ strncpy(ccdc_cfg->name, vpfe_cfg->ccdc, 32); >+ /* Get VINT0 irq resource */ >+ res1 = platform_get_resource(pdev, IORESOURCE_IRQ, 0); >+ if (!res1) { >+ v4l2_err(pdev->dev.driver, >+ "Unable to get interrupt for VINT0\n"); >+ ret = -ENOENT; >+ goto probe_disable_clock; >+ } >+ vpfe_dev->ccdc_irq0 = res1->start; >+ >+ /* Get VINT1 irq resource */ >+ res1 = platform_get_resource(pdev, >+ IORESOURCE_IRQ, 1); >+ if (!res1) { >+ v4l2_err(pdev->dev.driver, >+ "Unable to get interrupt for VINT1\n"); >+ ret = -ENOENT; >+ goto probe_disable_clock; >+ } >+ vpfe_dev->ccdc_irq1 = res1->start; >+ >+ /* Get address base of CCDC */ >+ res1 = platform_get_resource(pdev, IORESOURCE_MEM, 0); >+ if (!res1) { >+ v4l2_err(pdev->dev.driver, >+ "Unable to get register address map\n"); >+ ret = -ENOENT; >+ goto probe_disable_clock; >+ } >+ >+ ccdc_cfg->ccdc_addr_size = res1->end - res1->start + 1; >+ if (!request_mem_region(res1->start, ccdc_cfg->ccdc_addr_size, >+ pdev->dev.driver->name)) { >+ v4l2_err(pdev->dev.driver, >+ "Failed request_mem_region for ccdc base\n"); >+ ret = -ENXIO; >+ goto probe_disable_clock; >+ } >+ ccdc_cfg->ccdc_addr = ioremap_nocache(res1->start, >+ ccdc_cfg->ccdc_addr_size); >+ if (!ccdc_cfg->ccdc_addr) { >+ v4l2_err(pdev->dev.driver, "Unable to ioremap ccdc addr\n"); >+ ret = -ENXIO; >+ goto probe_out_release_mem1; >+ } >+ >+ ret = request_irq(vpfe_dev->ccdc_irq0, vpfe_isr, IRQF_DISABLED, >+ "vpfe_capture0", vpfe_dev); >+ >+ if (0 != ret) { >+ v4l2_err(pdev->dev.driver, "Unable to request interrupt\n"); >+ goto probe_out_unmap1; >+ } >+ >+ /* Allocate memory for video device */ >+ vfd = video_device_alloc(); >+ if (NULL == vfd) { >+ ret = -ENOMEM; >+ v4l2_err(pdev->dev.driver, >+ "Unable to alloc video device\n"); >+ goto probe_out_release_irq; >+ } >+ >+ /* Initialize field of video device */ >+ vfd->release = video_device_release; >+ vfd->current_norm = V4L2_STD_UNKNOWN; >+ vfd->fops = &vpfe_fops; >+ vfd->ioctl_ops = &vpfe_ioctl_ops; >+ vfd->minor = -1; >+ vfd->tvnorms = 0; >+ vfd->current_norm = V4L2_STD_PAL; >+ vfd->v4l2_dev = &vpfe_dev->v4l2_dev; >+ snprintf(vfd->name, sizeof(vfd->name), >+ "%s_V%d.%d.%d", >+ CAPTURE_DRV_NAME, >+ (VPFE_CAPTURE_VERSION_CODE >> 16) & 0xff, >+ (VPFE_CAPTURE_VERSION_CODE >> 8) & 0xff, >+ (VPFE_CAPTURE_VERSION_CODE) & 0xff); >+ /* Set video_dev to the video device */ >+ vpfe_dev->video_dev = vfd; >+ >+ ret = v4l2_device_register(&pdev->dev, &vpfe_dev->v4l2_dev); >+ if (ret) { >+ v4l2_err(pdev->dev.driver, >+ "Unable to register v4l2 device.\n"); >+ goto probe_out_video_release; >+ } >+ v4l2_info(&vpfe_dev->v4l2_dev, "v4l2 device registered\n"); >+ spin_lock_init(&vpfe_dev->irqlock); >+ spin_lock_init(&vpfe_dev->dma_queue_lock); >+ mutex_init(&vpfe_dev->lock); >+ >+ /* Initialize field of the device objects */ >+ vpfe_dev->numbuffers = config_params.numbuffers; >+ >+ /* Initialize prio member of device object */ >+ v4l2_prio_init(&vpfe_dev->prio); >+ /* register video device */ >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, >+ "trying to register vpfe device.\n"); >+ v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, >+ "video_dev=%x\n", (int)&vpfe_dev->video_dev); >+ vpfe_dev->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; >+ ret = video_register_device(vpfe_dev->video_dev, >+ VFL_TYPE_GRABBER, -1); >+ >+ if (ret) { >+ v4l2_err(pdev->dev.driver, >+ "Unable to register video device.\n"); >+ goto probe_out_v4l2_unregister; >+ } >+ >+ v4l2_info(&vpfe_dev->v4l2_dev, "video device registered\n"); >+ /* set the driver data in platform device */ >+ platform_set_drvdata(pdev, vpfe_dev); >+ /* set driver private data */ >+ video_set_drvdata(vpfe_dev->video_dev, vpfe_dev); >+ i2c_adap = i2c_get_adapter(1); >+ vpfe_cfg = pdev->dev.platform_data; >+ num_subdevs = vpfe_cfg->num_subdevs; >+ vpfe_dev->sd = kmalloc(sizeof(struct v4l2_subdev *) * num_subdevs, >+ GFP_KERNEL); >+ if (NULL == vpfe_dev->sd) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "unable to allocate memory for subdevice pointers\n"); >+ ret = -ENOMEM; >+ goto probe_out_video_unregister; >+ } >+ >+ for (i = 0; i < num_subdevs; i++) { >+ struct vpfe_subdev_info *sdinfo = &vpfe_cfg->sub_devs[i]; >+ struct v4l2_input *inps; >+ >+ list_for_each_entry(client, &i2c_adap->clients, list) { >+ if (!strcmp(client->name, sdinfo->name)) >+ break; >+ } >+ >+ if (NULL == client) { >+ v4l2_err(&vpfe_dev->v4l2_dev, "No Subdevice found\n"); >+ ret = -ENODEV; >+ goto probe_sd_out; >+ } >+ >+ /* Get subdevice data from the client */ >+ vpfe_dev->sd[i] = i2c_get_clientdata(client); >+ if (NULL == vpfe_dev->sd[i]) { >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "No Subdevice data\n"); >+ ret = -ENODEV; >+ goto probe_sd_out; >+ } >+ >+ vpfe_dev->sd[i]->grp_id = sdinfo->grp_id; >+ ret = v4l2_device_register_subdev(&vpfe_dev->v4l2_dev, >+ vpfe_dev->sd[i]); >+ if (ret) { >+ ret = -ENODEV; >+ v4l2_err(&vpfe_dev->v4l2_dev, >+ "Error registering v4l2 sub-device\n"); >+ goto probe_sd_out; >+ } >+ v4l2_info(&vpfe_dev->v4l2_dev, "v4l2 sub device %s" >+ " registered\n", client->name); >+ >+ /* update tvnorms from the sub devices */ >+ for (j = 0; j < sdinfo->num_inputs; j++) { >+ inps = &sdinfo->inputs[j]; >+ vfd->tvnorms |= inps->std; >+ } >+ } >+ /* We have at least one sub device to work with */ >+ vpfe_dev->current_subdev = &vpfe_cfg->sub_devs[0]; >+ mutex_unlock(&ccdc_lock); >+ return 0; >+ >+probe_sd_out: >+ for (j = i; j >= 0; j--) >+ v4l2_device_unregister_subdev(vpfe_dev->sd[j]); >+ kfree(vpfe_dev->sd); >+probe_out_video_unregister: >+ video_unregister_device(vpfe_dev->video_dev); >+probe_out_v4l2_unregister: >+ v4l2_device_unregister(&vpfe_dev->v4l2_dev); >+probe_out_video_release: >+ video_device_release(vpfe_dev->video_dev); >+probe_out_release_irq: >+ free_irq(vpfe_dev->ccdc_irq0, vpfe_dev); >+probe_out_unmap1: >+ iounmap(ccdc_cfg->ccdc_addr); >+probe_out_release_mem1: >+ release_mem_region(res1->start, res1->end - res1->start + 1); >+probe_disable_clock: >+ vpfe_disable_clock(vpfe_dev); >+ mutex_unlock(&ccdc_lock); >+ kfree(ccdc_cfg); >+probe_free_dev_mem: >+ kfree(vpfe_dev); >+ return ret; >+} >+ >+/* >+ * vpfe_remove : It un-register device from V4L2 driver >+ */ >+static int vpfe_remove(struct platform_device *pdev) >+{ >+ struct vpfe_device *vpfe_dev = platform_get_drvdata(pdev); >+ struct resource *res; >+ int j; >+ >+ v4l2_info(pdev->dev.driver, "vpfe_remove\n"); >+ >+ free_irq(vpfe_dev->ccdc_irq0, vpfe_dev); >+ /* Unregister video device */ >+ for (j = 0; j < vpfe_dev->cfg->num_subdevs; j++) >+ v4l2_device_unregister_subdev(vpfe_dev->sd[j]); >+ kfree(vpfe_dev->sd); >+ v4l2_device_unregister(&vpfe_dev->v4l2_dev); >+ video_unregister_device(vpfe_dev->video_dev); >+ mutex_lock(&ccdc_lock); >+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); >+ release_mem_region(res->start, res->end - res->start + 1); >+ iounmap(ccdc_cfg->ccdc_addr); >+ mutex_unlock(&ccdc_lock); >+ vpfe_disable_clock(vpfe_dev); >+ kfree(vpfe_dev); >+ kfree(ccdc_cfg); >+ return 0; >+} >+ >+static int >+vpfe_suspend(struct platform_device *dev, pm_message_t state) >+{ >+ /* add suspend code here later */ >+ return -1; >+} >+ >+static int >+vpfe_resume(struct platform_device *dev) >+{ >+ /* add resume code here later */ >+ return -1; >+} >+ >+static struct platform_driver vpfe_driver = { >+ .driver = { >+ .name = CAPTURE_DRV_NAME, >+ .owner = THIS_MODULE, >+ }, >+ .probe = vpfe_probe, >+ .remove = __devexit_p(vpfe_remove), >+ .suspend = vpfe_suspend, >+ .resume = vpfe_resume, >+}; >+ >+static __init int vpfe_init(void) >+{ >+ printk(KERN_NOTICE "vpfe_init\n"); >+ /* Register driver to the kernel */ >+ return platform_driver_register(&vpfe_driver); >+} >+ >+/* >+ * vpfe_cleanup : This function un-registers device driver >+ */ >+static void vpfe_cleanup(void) >+{ >+ platform_driver_unregister(&vpfe_driver); >+} >+ >+module_init(vpfe_init); >+module_exit(vpfe_cleanup); >diff --git a/include/media/davinci/vpfe_capture.h >b/include/media/davinci/vpfe_capture.h >new file mode 100644 >index 0000000..cda5c9e >--- /dev/null >+++ b/include/media/davinci/vpfe_capture.h >@@ -0,0 +1,194 @@ >+/* >+ * Copyright (C) 2008-2009 Texas Instruments Inc >+ * >+ * This program is free software; you can redistribute it and/or modify >+ * it under the terms of the GNU General Public License as published by >+ * the Free Software Foundation; either version 2 of the License, or >+ * (at your option) any later version. >+ * >+ * This program is distributed in the hope that it will be useful, >+ * but WITHOUT ANY WARRANTY; without even the implied warranty of >+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >+ * GNU General Public License for more details. >+ * >+ * You should have received a copy of the GNU General Public License >+ * along with this program; if not, write to the Free Software >+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 >USA >+ */ >+ >+#ifndef _VPFE_CAPTURE_H >+#define _VPFE_CAPTURE_H >+ >+#ifdef __KERNEL__ >+ >+/* Header files */ >+#include <media/v4l2-dev.h> >+#include <linux/videodev2.h> >+#include <linux/clk.h> >+#include <media/v4l2-ioctl.h> >+#include <media/v4l2-device.h> >+#include <media/videobuf-dma-contig.h> >+#include <media/davinci/vpfe_types.h> >+ >+#define VPFE_CAPTURE_NUM_DECODERS 5 >+ >+/* Macros */ >+#define VPFE_MAJOR_RELEASE 0 >+#define VPFE_MINOR_RELEASE 0 >+#define VPFE_BUILD 1 >+#define VPFE_CAPTURE_VERSION_CODE ((VPFE_MAJOR_RELEASE << 16) | \ >+ (VPFE_MINOR_RELEASE << 8) | \ >+ VPFE_BUILD) >+ >+#define CAPTURE_DRV_NAME "vpfe-capture" >+ >+struct vpfe_pixel_format { >+ struct v4l2_fmtdesc fmtdesc; >+ /* bytes per pixel */ >+ int bpp; >+}; >+ >+struct vpfe_std_info { >+ int active_pixels; >+ int active_lines; >+ /* current frame format */ >+ int frame_format; >+}; >+ >+struct vpfe_route { >+ u32 input; >+ u32 output; >+}; >+ >+struct vpfe_subdev_info { >+ /* Sub device name */ >+ char name[32]; >+ /* Sub device group id */ >+ int grp_id; >+ /* Number of inputs supported */ >+ int num_inputs; >+ /* inputs available at the sub device */ >+ struct v4l2_input *inputs; >+ /* Sub dev routing information for each input */ >+ struct vpfe_route *routes; >+ /* check if sub dev supports routing */ >+ int can_route; >+ /* ccdc bus/interface configuration */ >+ struct vpfe_hw_if_param ccdc_if_params; >+}; >+ >+struct vpfe_config { >+ /* Number of sub devices connected to vpfe */ >+ int num_subdevs; >+ /* information about each subdev */ >+ struct vpfe_subdev_info *sub_devs; >+ /* evm card info */ >+ char *card_name; >+ /* ccdc name */ >+ char *ccdc; >+ /* vpfe clock */ >+ struct clk *vpssclk; >+ struct clk *slaveclk; >+}; >+ >+struct vpfe_device { >+ /* V4l2 specific parameters */ >+ /* Identifies video device for this channel */ >+ struct video_device *video_dev; >+ /* sub devices */ >+ struct v4l2_subdev **sd; >+ /* vpfe cfg */ >+ struct vpfe_config *cfg; >+ /* V4l2 device */ >+ struct v4l2_device v4l2_dev; >+ /* parent device */ >+ struct device *pdev; >+ /* Used to keep track of state of the priority */ >+ struct v4l2_prio_state prio; >+ /* number of open instances of the channel */ >+ u32 usrs; >+ /* Indicates id of the field which is being displayed */ >+ u32 field_id; >+ /* flag to indicate whether decoder is initialized */ >+ u8 initialized; >+ /* current interface type */ >+ struct vpfe_hw_if_param vpfe_if_params; >+ /* ptr to currently selected sub device */ >+ struct vpfe_subdev_info *current_subdev; >+ /* current input at the sub device */ >+ int current_input; >+ /* Keeps track of the information about the standard */ >+ struct vpfe_std_info std_info; >+ /* std index into std table */ >+ int std_index; >+ /* CCDC IRQs used when CCDC/ISIF output to SDRAM */ >+ unsigned int ccdc_irq0; >+ unsigned int ccdc_irq1; >+ /* number of buffers in fbuffers */ >+ u32 numbuffers; >+ /* List of buffer pointers for storing frames */ >+ u8 *fbuffers[VIDEO_MAX_FRAME]; >+ /* Pointer pointing to current v4l2_buffer */ >+ struct videobuf_buffer *cur_frm; >+ /* Pointer pointing to next v4l2_buffer */ >+ struct videobuf_buffer *next_frm; >+ /* >+ * This field keeps track of type of buffer exchange mechanism >+ * user has selected >+ */ >+ enum v4l2_memory memory; >+ /* Used to store pixel format */ >+ struct v4l2_format fmt; >+ /* >+ * used when IMP is chained to store the crop window which >+ * is different from the image window >+ */ >+ struct v4l2_rect crop; >+ /* Buffer queue used in video-buf */ >+ struct videobuf_queue buffer_queue; >+ /* Queue of filled frames */ >+ struct list_head dma_queue; >+ /* Used in video-buf */ >+ spinlock_t irqlock; >+ /* IRQ lock for DMA queue */ >+ spinlock_t dma_queue_lock; >+ /* lock used to access this structure */ >+ struct mutex lock; >+ /* number of users performing IO */ >+ u32 io_usrs; >+ /* Indicates whether streaming started */ >+ u8 started; >+ /* >+ * offset where second field starts from the starting of the >+ * buffer for field seperated YCbCr formats >+ */ >+ u32 field_off; >+}; >+ >+/* File handle structure */ >+struct vpfe_fh { >+ struct vpfe_device *vpfe_dev; >+ /* Indicates whether this file handle is doing IO */ >+ u8 io_allowed; >+ /* Used to keep track priority of this instance */ >+ enum v4l2_priority prio; >+}; >+ >+struct vpfe_config_params { >+ u8 min_numbuffers; >+ u8 numbuffers; >+ u32 min_bufsize; >+ u32 device_bufsize; >+}; >+ >+#endif /* End of __KERNEL__ */ >+/** >+ * VPFE_CMD_S_CCDC_RAW_PARAMS - Driver private IOCTL to set raw capture >params >+ * This ioctl is used to configure the ccdc module such as defect pixel >+ * correction, color space conversion, culling etc. in raw capture mode. >+ * TODO: This is to be split into multiple ioctls and also explore the >+ * possibility of extending the v4l2 api to include them >+ **/ >+#define VPFE_CMD_S_CCDC_RAW_PARAMS _IOW('V', BASE_VIDIOC_PRIVATE + 1, \ >+ void *) >+#endif /* _DAVINCI_VPFE_H */ >diff --git a/include/media/davinci/vpfe_types.h >b/include/media/davinci/vpfe_types.h >new file mode 100644 >index 0000000..76fb74b >--- /dev/null >+++ b/include/media/davinci/vpfe_types.h >@@ -0,0 +1,51 @@ >+/* >+ * Copyright (C) 2008-2009 Texas Instruments Inc >+ * >+ * This program is free software; you can redistribute it and/or modify >+ * it under the terms of the GNU General Public License as published by >+ * the Free Software Foundation; either version 2 of the License, or >+ * (at your option)any later version. >+ * >+ * This program is distributed in the hope that it will be useful, >+ * but WITHOUT ANY WARRANTY; without even the implied warranty of >+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the >+ * GNU General Public License for more details. >+ * >+ * You should have received a copy of the GNU General Public License >+ * along with this program; if not, write to the Free Software >+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA >+ */ >+#ifndef _VPFE_TYPES_H >+#define _VPFE_TYPES_H >+ >+#ifdef __KERNEL__ >+ >+enum vpfe_pin_pol { >+ VPFE_PINPOL_POSITIVE, >+ VPFE_PINPOL_NEGATIVE >+}; >+ >+enum vpfe_hw_if_type { >+ /* BT656 - 8 bit */ >+ VPFE_BT656, >+ /* BT1120 - 16 bit */ >+ VPFE_BT1120, >+ /* Raw Bayer */ >+ VPFE_RAW_BAYER, >+ /* YCbCr - 8 bit with external sync */ >+ VPFE_YCBCR_SYNC_8, >+ /* YCbCr - 16 bit with external sync */ >+ VPFE_YCBCR_SYNC_16, >+ /* BT656 - 10 bit */ >+ VPFE_BT656_10BIT >+}; >+ >+/* interface description */ >+struct vpfe_hw_if_param { >+ enum vpfe_hw_if_type if_type; >+ enum vpfe_pin_pol hdpol; >+ enum vpfe_pin_pol vdpol; >+}; >+ >+#endif >+#endif >-- >1.6.0.4
On Thursday 02 July 2009 19:05:51 m-karicheri2@ti.com wrote: > From: Muralidharan Karicheri <m-karicheri2@ti.com> > > Re-sending to add description for VPFE_CMD_S_CCDC_RAW_PARAMS and > updating debug prints with \n and fixing an error coder ENOMEM > > VPFE Capture bridge driver > > This is version, v3 of vpfe capture bridge driver for doing video > capture on DM355 and DM6446 evms. The ccdc hw modules register with the > driver and are used for configuring the CCD Controller for a specific > decoder interface. The driver also registers the sub devices required > for a specific evm. More than one sub devices can be registered. > This allows driver to switch dynamically to capture video from > any sub device that is registered. Currently only one sub device > (tvp5146) is supported. But in future this driver is expected > to do capture from sensor devices such as Micron's MT9T001,MT9T031 > and MT9P031 etc. The driver currently supports MMAP based IO. > > Following are the updates based on review comments:- > 1) clean up of setting bus parameters in ccdc > 2) removed v4l2_routing structure type > 3) module authors, description changes > 4) pixel aspect constants removed > > Reviewed by: Hans Verkuil <hverkuil@xs4all.nl> > Reviewed by: Laurent Pinchart <laurent.pinchart@skynet.be> > Reviewed by: Alexey Klimov <klimov.linux@gmail.com> > > Signed-off-by: Muralidharan Karicheri <m-karicheri2@ti.com> > --- > Applies to v4l-dvb repository > > drivers/media/video/davinci/vpfe_capture.c | 2136 ++++++++++++++++++++++++++++ > include/media/davinci/vpfe_capture.h | 194 +++ > include/media/davinci/vpfe_types.h | 51 + > 3 files changed, 2381 insertions(+), 0 deletions(-) > create mode 100644 drivers/media/video/davinci/vpfe_capture.c > create mode 100644 include/media/davinci/vpfe_capture.h > create mode 100644 include/media/davinci/vpfe_types.h > > diff --git a/drivers/media/video/davinci/vpfe_capture.c b/drivers/media/video/davinci/vpfe_capture.c <snip> > +/** > + * VPFE_CMD_S_CCDC_RAW_PARAMS - Driver private IOCTL to set raw capture params > + * This ioctl is used to configure the ccdc module such as defect pixel > + * correction, color space conversion, culling etc. in raw capture mode. > + * TODO: This is to be split into multiple ioctls and also explore the > + * possibility of extending the v4l2 api to include them > + **/ > +#define VPFE_CMD_S_CCDC_RAW_PARAMS _IOW('V', BASE_VIDIOC_PRIVATE + 1, \ > + void *) > +#endif /* _DAVINCI_VPFE_H */ I've only one request: can you add something along the lines of: "This is an experimental ioctl that will change in future kernels. Use with care." And at the top add: "EXPERIMENTAL IOCTL" That way it is unambiguous that this will change. And it definitely has to change! On the other hand I can imagine that it is useful to have this available to experiment with. We have made experimental APIs before, so there is a precedent for this, as long as it is very clearly marked as experimental. In fact, it would be even better if there is a KERN_WARNING message issued mentioning the experimental status of this ioctl whenever it is used. If you can do this asap, then I'll merge everything tomorrow morning and make a new pull request for this. Regards, Hans
Hans, <snip> > >I've only one request: can you add something along the lines of: > >"This is an experimental ioctl that will change in future kernels. >Use with care." > >And at the top add: "EXPERIMENTAL IOCTL" > >That way it is unambiguous that this will change. And it definitely has >to change! On the other hand I can imagine that it is useful to have this >available to experiment with. We have made experimental APIs before, so >there is a precedent for this, as long as it is very clearly marked as >experimental. > >In fact, it would be even better if there is a KERN_WARNING message issued >mentioning the experimental status of this ioctl whenever it is used. > >If you can do this asap, then I'll merge everything tomorrow morning and >make a new pull request for this. > Done. Let me know how it goes. Thanks Murali Karicheri Software Design Engineer Texas Instruments Inc. Germantown, MD 20874 Phone : 301-515-3736 email: m-karicheri2@ti.com >Regards, > > Hans > >-- >Hans Verkuil - video4linux developer - sponsored by TANDBERG Telecom >-- >To unsubscribe from this list: send the line "unsubscribe linux-media" in >the body of a message to majordomo@vger.kernel.org >More majordomo info at http://vger.kernel.org/majordomo-info.html
diff --git a/drivers/media/video/davinci/vpfe_capture.c b/drivers/media/video/davinci/vpfe_capture.c new file mode 100644 index 0000000..8c05d68 --- /dev/null +++ b/drivers/media/video/davinci/vpfe_capture.c @@ -0,0 +1,2136 @@ +/* + * Copyright (C) 2008-2009 Texas Instruments Inc + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + * + * Driver name : VPFE Capture driver + * VPFE Capture driver allows applications to capture and stream video + * frames on DaVinci SoCs (DM6446, DM355 etc) from a YUV source such as + * TVP5146 or Raw Bayer RGB image data from an image sensor + * such as Microns' MT9T001, MT9T031 etc. + * + * These SoCs have, in common, a Video Processing Subsystem (VPSS) that + * consists of a Video Processing Front End (VPFE) for capturing + * video/raw image data and Video Processing Back End (VPBE) for displaying + * YUV data through an in-built analog encoder or Digital LCD port. This + * driver is for capture through VPFE. A typical EVM using these SoCs have + * following high level configuration. + * + * + * decoder(TVP5146/ YUV/ + * MT9T001) --> Raw Bayer RGB ---> MUX -> VPFE (CCDC/ISIF) + * data input | | + * V | + * SDRAM | + * V + * Image Processor + * | + * V + * SDRAM + * The data flow happens from a decoder connected to the VPFE over a + * YUV embedded (BT.656/BT.1120) or separate sync or raw bayer rgb interface + * and to the input of VPFE through an optional MUX (if more inputs are + * to be interfaced on the EVM). The input data is first passed through + * CCDC (CCD Controller, a.k.a Image Sensor Interface, ISIF). The CCDC + * does very little or no processing on YUV data and does pre-process Raw + * Bayer RGB data through modules such as Defect Pixel Correction (DFC) + * Color Space Conversion (CSC), data gain/offset etc. After this, data + * can be written to SDRAM or can be connected to the image processing + * block such as IPIPE (on DM355 only). + * + * Features supported + * - MMAP IO + * - Capture using TVP5146 over BT.656 + * - support for interfacing decoders using sub device model + * - Work with DM355 or DM6446 CCDC to do Raw Bayer RGB/YUV + * data capture to SDRAM. + * TODO list + * - Support multiple REQBUF after open + * - Support for de-allocating buffers through REQBUF + * - Support for Raw Bayer RGB capture + * - Support for chaining Image Processor + * - Support for static allocation of buffers + * - Support for USERPTR IO + * - Support for STREAMON before QBUF + * - Support for control ioctls + */ +#include <linux/module.h> +#include <linux/init.h> +#include <linux/platform_device.h> +#include <linux/interrupt.h> +#include <linux/version.h> +#include <media/v4l2-common.h> +#include <linux/io.h> +#include <media/davinci/vpfe_capture.h> +#include <media/tvp514x.h> +#include <linux/i2c.h> +#include "ccdc_hw_device.h" + +static int debug; +static u32 numbuffers = 3; +static u32 bufsize = (720 * 576 * 2); + +module_param(numbuffers, uint, S_IRUGO); +module_param(bufsize, uint, S_IRUGO); +module_param(debug, int, 0644); + +MODULE_PARM_DESC(numbuffers, "buffer count (default:3)"); +MODULE_PARM_DESC(bufsize, "buffer size in bytes (default:720 x 576 x 2)"); +MODULE_PARM_DESC(debug, "Debug level 0-1"); + +MODULE_DESCRIPTION("VPFE Video for Linux Capture Driver"); +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Texas Instruments"); + +/* standard information */ +struct vpfe_standard { + v4l2_std_id std_id; + unsigned int width; + unsigned int height; + struct v4l2_fract pixelaspect; + /* 0 - progressive, 1 - interlaced */ + int frame_format; +}; + +/* ccdc configuration */ +struct ccdc_config { + /* This make sure vpfe is probed and ready to go */ + int vpfe_probed; + /* name of ccdc device */ + char name[32]; + /* for storing mem maps for CCDC */ + int ccdc_addr_size; + void *__iomem ccdc_addr; +}; + +/* data structures */ +static struct vpfe_config_params config_params = { + .min_numbuffers = 3, + .numbuffers = 3, + .min_bufsize = 720 * 480 * 2, + .device_bufsize = 720 * 576 * 2, +}; + +/* ccdc device registered */ +static struct ccdc_hw_device *ccdc_dev; +/* lock for accessing ccdc information */ +static DEFINE_MUTEX(ccdc_lock); +/* ccdc configuration */ +static struct ccdc_config *ccdc_cfg; + +const struct vpfe_standard vpfe_standards[] = { + {V4L2_STD_525_60, 720, 480, {11, 10}, 1}, + {V4L2_STD_625_50, 720, 576, {54, 59}, 1}, +}; + +/* Used when raw Bayer image from ccdc is directly captured to SDRAM */ +static const struct vpfe_pixel_format vpfe_pix_fmts[] = { + { + .fmtdesc = { + .index = 0, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "Bayer GrRBGb 8bit A-Law compr.", + .pixelformat = V4L2_PIX_FMT_SBGGR8, + }, + .bpp = 1, + }, + { + .fmtdesc = { + .index = 1, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "Bayer GrRBGb - 16bit", + .pixelformat = V4L2_PIX_FMT_SBGGR16, + }, + .bpp = 2, + }, + { + .fmtdesc = { + .index = 2, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "Bayer GrRBGb 8bit DPCM compr.", + .pixelformat = V4L2_PIX_FMT_SGRBG10DPCM8, + }, + .bpp = 1, + }, + { + .fmtdesc = { + .index = 3, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "YCbCr 4:2:2 Interleaved UYVY", + .pixelformat = V4L2_PIX_FMT_UYVY, + }, + .bpp = 2, + }, + { + .fmtdesc = { + .index = 4, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "YCbCr 4:2:2 Interleaved YUYV", + .pixelformat = V4L2_PIX_FMT_YUYV, + }, + .bpp = 2, + }, + { + .fmtdesc = { + .index = 5, + .type = V4L2_BUF_TYPE_VIDEO_CAPTURE, + .description = "Y/CbCr 4:2:0 - Semi planar", + .pixelformat = V4L2_PIX_FMT_NV12, + }, + .bpp = 1, + }, +}; + +/* + * vpfe_lookup_pix_format() + * lookup an entry in the vpfe pix format table based on pix_format + */ +static const struct vpfe_pixel_format *vpfe_lookup_pix_format(u32 pix_format) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(vpfe_pix_fmts); i++) { + if (pix_format == vpfe_pix_fmts[i].fmtdesc.pixelformat) + return &vpfe_pix_fmts[i]; + } + return NULL; +} + +/* + * vpfe_register_ccdc_device. CCDC module calls this to + * register with vpfe capture + */ +int vpfe_register_ccdc_device(struct ccdc_hw_device *dev) +{ + int ret = 0; + printk(KERN_NOTICE "vpfe_register_ccdc_device: %s\n", dev->name); + + BUG_ON(!dev->hw_ops.open); + BUG_ON(!dev->hw_ops.enable); + BUG_ON(!dev->hw_ops.set_hw_if_params); + BUG_ON(!dev->hw_ops.configure); + BUG_ON(!dev->hw_ops.set_buftype); + BUG_ON(!dev->hw_ops.get_buftype); + BUG_ON(!dev->hw_ops.enum_pix); + BUG_ON(!dev->hw_ops.set_frame_format); + BUG_ON(!dev->hw_ops.get_frame_format); + BUG_ON(!dev->hw_ops.get_pixel_format); + BUG_ON(!dev->hw_ops.set_pixel_format); + BUG_ON(!dev->hw_ops.set_params); + BUG_ON(!dev->hw_ops.set_image_window); + BUG_ON(!dev->hw_ops.get_image_window); + BUG_ON(!dev->hw_ops.get_line_length); + BUG_ON(!dev->hw_ops.setfbaddr); + BUG_ON(!dev->hw_ops.getfid); + + mutex_lock(&ccdc_lock); + if (NULL == ccdc_cfg) { + /* + * TODO. Will this ever happen? if so, we need to fix it. + * Proabably we need to add the request to a linked list and + * walk through it during vpfe probe + */ + printk(KERN_ERR "vpfe capture not initialized\n"); + ret = -1; + goto unlock; + } + + if (strcmp(dev->name, ccdc_cfg->name)) { + /* ignore this ccdc */ + ret = -1; + goto unlock; + } + + if (ccdc_dev) { + printk(KERN_ERR "ccdc already registered\n"); + ret = -1; + goto unlock; + } + + ccdc_dev = dev; + dev->hw_ops.set_ccdc_base(ccdc_cfg->ccdc_addr, + ccdc_cfg->ccdc_addr_size); +unlock: + mutex_unlock(&ccdc_lock); + return ret; +} +EXPORT_SYMBOL(vpfe_register_ccdc_device); + +/* + * vpfe_unregister_ccdc_device. CCDC module calls this to + * unregister with vpfe capture + */ +void vpfe_unregister_ccdc_device(struct ccdc_hw_device *dev) +{ + if (NULL == dev) { + printk(KERN_ERR "invalid ccdc device ptr\n"); + return; + } + + printk(KERN_NOTICE "vpfe_unregister_ccdc_device, dev->name = %s\n", + dev->name); + + if (strcmp(dev->name, ccdc_cfg->name)) { + /* ignore this ccdc */ + return; + } + + mutex_lock(&ccdc_lock); + ccdc_dev = NULL; + mutex_unlock(&ccdc_lock); + return; +} +EXPORT_SYMBOL(vpfe_unregister_ccdc_device); + +/* + * vpfe_get_ccdc_image_format - Get image parameters based on CCDC settings + */ +static int vpfe_get_ccdc_image_format(struct vpfe_device *vpfe_dev, + struct v4l2_format *f) +{ + struct v4l2_rect image_win; + enum ccdc_buftype buf_type; + enum ccdc_frmfmt frm_fmt; + + memset(f, 0, sizeof(*f)); + f->type = V4L2_BUF_TYPE_VIDEO_OUTPUT; + ccdc_dev->hw_ops.get_image_window(&image_win); + f->fmt.pix.width = image_win.width; + f->fmt.pix.height = image_win.height; + f->fmt.pix.bytesperline = ccdc_dev->hw_ops.get_line_length(); + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * + f->fmt.pix.height; + buf_type = ccdc_dev->hw_ops.get_buftype(); + f->fmt.pix.pixelformat = ccdc_dev->hw_ops.get_pixel_format(); + frm_fmt = ccdc_dev->hw_ops.get_frame_format(); + if (frm_fmt == CCDC_FRMFMT_PROGRESSIVE) + f->fmt.pix.field = V4L2_FIELD_NONE; + else if (frm_fmt == CCDC_FRMFMT_INTERLACED) { + if (buf_type == CCDC_BUFTYPE_FLD_INTERLEAVED) + f->fmt.pix.field = V4L2_FIELD_INTERLACED; + else if (buf_type == CCDC_BUFTYPE_FLD_SEPARATED) + f->fmt.pix.field = V4L2_FIELD_SEQ_TB; + else { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf_type\n"); + return -EINVAL; + } + } else { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid frm_fmt\n"); + return -EINVAL; + } + return 0; +} + +/* + * vpfe_config_ccdc_image_format() + * For a pix format, configure ccdc to setup the capture + */ +static int vpfe_config_ccdc_image_format(struct vpfe_device *vpfe_dev) +{ + enum ccdc_frmfmt frm_fmt = CCDC_FRMFMT_INTERLACED; + int ret = 0; + + if (ccdc_dev->hw_ops.set_pixel_format( + vpfe_dev->fmt.fmt.pix.pixelformat) < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, + "couldn't set pix format in ccdc\n"); + return -EINVAL; + } + /* configure the image window */ + ccdc_dev->hw_ops.set_image_window(&vpfe_dev->crop); + + switch (vpfe_dev->fmt.fmt.pix.field) { + case V4L2_FIELD_INTERLACED: + /* do nothing, since it is default */ + ret = ccdc_dev->hw_ops.set_buftype( + CCDC_BUFTYPE_FLD_INTERLEAVED); + break; + case V4L2_FIELD_NONE: + frm_fmt = CCDC_FRMFMT_PROGRESSIVE; + /* buffer type only applicable for interlaced scan */ + break; + case V4L2_FIELD_SEQ_TB: + ret = ccdc_dev->hw_ops.set_buftype( + CCDC_BUFTYPE_FLD_SEPARATED); + break; + default: + return -EINVAL; + } + + /* set the frame format */ + if (!ret) + ret = ccdc_dev->hw_ops.set_frame_format(frm_fmt); + return ret; +} +/* + * vpfe_config_image_format() + * For a given standard, this functions sets up the default + * pix format & crop values in the vpfe device and ccdc. It first + * starts with defaults based values from the standard table. + * It then checks if sub device support g_fmt and then override the + * values based on that.Sets crop values to match with scan resolution + * starting at 0,0. It calls vpfe_config_ccdc_image_format() set the + * values in ccdc + */ +static int vpfe_config_image_format(struct vpfe_device *vpfe_dev, + const v4l2_std_id *std_id) +{ + struct vpfe_subdev_info *sdinfo = vpfe_dev->current_subdev; + int i, ret = 0; + + for (i = 0; i < ARRAY_SIZE(vpfe_standards); i++) { + if (vpfe_standards[i].std_id & *std_id) { + vpfe_dev->std_info.active_pixels = + vpfe_standards[i].width; + vpfe_dev->std_info.active_lines = + vpfe_standards[i].height; + vpfe_dev->std_info.frame_format = + vpfe_standards[i].frame_format; + vpfe_dev->std_index = i; + break; + } + } + + if (i == ARRAY_SIZE(vpfe_standards)) { + v4l2_err(&vpfe_dev->v4l2_dev, "standard not supported\n"); + return -EINVAL; + } + + vpfe_dev->crop.top = 0; + vpfe_dev->crop.left = 0; + vpfe_dev->crop.width = vpfe_dev->std_info.active_pixels; + vpfe_dev->crop.height = vpfe_dev->std_info.active_lines; + vpfe_dev->fmt.fmt.pix.width = vpfe_dev->crop.width; + vpfe_dev->fmt.fmt.pix.height = vpfe_dev->crop.height; + + /* first field and frame format based on standard frame format */ + if (vpfe_dev->std_info.frame_format) { + vpfe_dev->fmt.fmt.pix.field = V4L2_FIELD_INTERLACED; + /* assume V4L2_PIX_FMT_UYVY as default */ + vpfe_dev->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_UYVY; + } else { + vpfe_dev->fmt.fmt.pix.field = V4L2_FIELD_NONE; + /* assume V4L2_PIX_FMT_SBGGR8 */ + vpfe_dev->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_SBGGR8; + } + + /* if sub device supports g_fmt, override the defaults */ + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, + sdinfo->grp_id, video, g_fmt, &vpfe_dev->fmt); + + if (ret && ret != -ENOIOCTLCMD) { + v4l2_err(&vpfe_dev->v4l2_dev, + "error in getting g_fmt from sub device\n"); + return ret; + } + + /* Sets the values in CCDC */ + ret = vpfe_config_ccdc_image_format(vpfe_dev); + if (ret) + return ret; + + /* Update the values of sizeimage and bytesperline */ + if (!ret) { + vpfe_dev->fmt.fmt.pix.bytesperline = + ccdc_dev->hw_ops.get_line_length(); + vpfe_dev->fmt.fmt.pix.sizeimage = + vpfe_dev->fmt.fmt.pix.bytesperline * + vpfe_dev->fmt.fmt.pix.height; + } + return ret; +} + +static int vpfe_initialize_device(struct vpfe_device *vpfe_dev) +{ + int ret = 0; + + /* set first input of current subdevice as the current input */ + vpfe_dev->current_input = 0; + + /* set default standard */ + vpfe_dev->std_index = 0; + + /* Configure the default format information */ + ret = vpfe_config_image_format(vpfe_dev, + &vpfe_standards[vpfe_dev->std_index].std_id); + if (ret) + return ret; + + /* now open the ccdc device to initialize it */ + mutex_lock(&ccdc_lock); + if (NULL == ccdc_dev) { + v4l2_err(&vpfe_dev->v4l2_dev, "ccdc device not registered\n"); + ret = -ENODEV; + goto unlock; + } + + if (!try_module_get(ccdc_dev->owner)) { + v4l2_err(&vpfe_dev->v4l2_dev, "Couldn't lock ccdc module\n"); + ret = -ENODEV; + goto unlock; + } + ret = ccdc_dev->hw_ops.open(vpfe_dev->pdev); + if (!ret) + vpfe_dev->initialized = 1; +unlock: + mutex_unlock(&ccdc_lock); + return ret; +} + +/* + * vpfe_open : It creates object of file handle structure and + * stores it in private_data member of filepointer + */ +static int vpfe_open(struct file *file) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_open\n"); + + if (!vpfe_dev->cfg->num_subdevs) { + v4l2_err(&vpfe_dev->v4l2_dev, "No decoder registered\n"); + return -ENODEV; + } + + /* Allocate memory for the file handle object */ + fh = kmalloc(sizeof(struct vpfe_fh), GFP_KERNEL); + if (NULL == fh) { + v4l2_err(&vpfe_dev->v4l2_dev, + "unable to allocate memory for file handle object\n"); + return -ENOMEM; + } + /* store pointer to fh in private_data member of file */ + file->private_data = fh; + fh->vpfe_dev = vpfe_dev; + mutex_lock(&vpfe_dev->lock); + /* If decoder is not initialized. initialize it */ + if (!vpfe_dev->initialized) { + if (vpfe_initialize_device(vpfe_dev)) { + mutex_unlock(&vpfe_dev->lock); + return -ENODEV; + } + } + /* Increment device usrs counter */ + vpfe_dev->usrs++; + /* Set io_allowed member to false */ + fh->io_allowed = 0; + /* Initialize priority of this instance to default priority */ + fh->prio = V4L2_PRIORITY_UNSET; + v4l2_prio_open(&vpfe_dev->prio, &fh->prio); + mutex_unlock(&vpfe_dev->lock); + return 0; +} + +static void vpfe_schedule_next_buffer(struct vpfe_device *vpfe_dev) +{ + unsigned long addr; + + vpfe_dev->next_frm = list_entry(vpfe_dev->dma_queue.next, + struct videobuf_buffer, queue); + list_del(&vpfe_dev->next_frm->queue); + vpfe_dev->next_frm->state = VIDEOBUF_ACTIVE; + addr = videobuf_to_dma_contig(vpfe_dev->next_frm); + ccdc_dev->hw_ops.setfbaddr(addr); +} + +static void vpfe_process_buffer_complete(struct vpfe_device *vpfe_dev) +{ + struct timeval timevalue; + + do_gettimeofday(&timevalue); + vpfe_dev->cur_frm->ts = timevalue; + vpfe_dev->cur_frm->state = VIDEOBUF_DONE; + vpfe_dev->cur_frm->size = vpfe_dev->fmt.fmt.pix.sizeimage; + wake_up_interruptible(&vpfe_dev->cur_frm->done); + vpfe_dev->cur_frm = vpfe_dev->next_frm; +} + +/* ISR for VINT0*/ +static irqreturn_t vpfe_isr(int irq, void *dev_id) +{ + struct vpfe_device *vpfe_dev = dev_id; + enum v4l2_field field; + unsigned long addr; + int fid; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "\nStarting vpfe_isr...\n"); + field = vpfe_dev->fmt.fmt.pix.field; + + /* if streaming not started, don't do anything */ + if (!vpfe_dev->started) + return IRQ_HANDLED; + + /* only for 6446 this will be applicable */ + if (NULL != ccdc_dev->hw_ops.reset) + ccdc_dev->hw_ops.reset(); + + if (field == V4L2_FIELD_NONE) { + /* handle progressive frame capture */ + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, + "frame format is progressive...\n"); + if (vpfe_dev->cur_frm != vpfe_dev->next_frm) + vpfe_process_buffer_complete(vpfe_dev); + return IRQ_HANDLED; + } + + /* interlaced or TB capture check which field we are in hardware */ + fid = ccdc_dev->hw_ops.getfid(); + + /* switch the software maintained field id */ + vpfe_dev->field_id ^= 1; + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "field id = %x:%x.\n", + fid, vpfe_dev->field_id); + if (fid == vpfe_dev->field_id) { + /* we are in-sync here,continue */ + if (fid == 0) { + /* + * One frame is just being captured. If the next frame + * is available, release the current frame and move on + */ + if (vpfe_dev->cur_frm != vpfe_dev->next_frm) + vpfe_process_buffer_complete(vpfe_dev); + /* + * based on whether the two fields are stored + * interleavely or separately in memory, reconfigure + * the CCDC memory address + */ + if (field == V4L2_FIELD_SEQ_TB) { + addr = + videobuf_to_dma_contig(vpfe_dev->cur_frm); + addr += vpfe_dev->field_off; + ccdc_dev->hw_ops.setfbaddr(addr); + } + return IRQ_HANDLED; + } + /* + * if one field is just being captured configure + * the next frame get the next frame from the empty + * queue if no frame is available hold on to the + * current buffer + */ + spin_lock(&vpfe_dev->dma_queue_lock); + if (!list_empty(&vpfe_dev->dma_queue) && + vpfe_dev->cur_frm == vpfe_dev->next_frm) + vpfe_schedule_next_buffer(vpfe_dev); + spin_unlock(&vpfe_dev->dma_queue_lock); + } else if (fid == 0) { + /* + * out of sync. Recover from any hardware out-of-sync. + * May loose one frame + */ + vpfe_dev->field_id = fid; + } + return IRQ_HANDLED; +} + +/* vdint1_isr - isr handler for VINT1 interrupt */ +static irqreturn_t vdint1_isr(int irq, void *dev_id) +{ + struct vpfe_device *vpfe_dev = dev_id; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "\nInside vdint1_isr...\n"); + + /* if streaming not started, don't do anything */ + if (!vpfe_dev->started) + return IRQ_HANDLED; + + spin_lock(&vpfe_dev->dma_queue_lock); + if ((vpfe_dev->fmt.fmt.pix.field == V4L2_FIELD_NONE) && + !list_empty(&vpfe_dev->dma_queue) && + vpfe_dev->cur_frm == vpfe_dev->next_frm) + vpfe_schedule_next_buffer(vpfe_dev); + spin_unlock(&vpfe_dev->dma_queue_lock); + return IRQ_HANDLED; +} + +static void vpfe_detach_irq(struct vpfe_device *vpfe_dev) +{ + enum ccdc_frmfmt frame_format; + + frame_format = ccdc_dev->hw_ops.get_frame_format(); + if (frame_format == CCDC_FRMFMT_PROGRESSIVE) + free_irq(IRQ_VDINT1, vpfe_dev); +} + +static int vpfe_attach_irq(struct vpfe_device *vpfe_dev) +{ + enum ccdc_frmfmt frame_format; + + frame_format = ccdc_dev->hw_ops.get_frame_format(); + if (frame_format == CCDC_FRMFMT_PROGRESSIVE) { + return request_irq(vpfe_dev->ccdc_irq1, vdint1_isr, + IRQF_DISABLED, "vpfe_capture1", + vpfe_dev); + } + return 0; +} + +/* vpfe_stop_ccdc_capture: stop streaming in ccdc/isif */ +static void vpfe_stop_ccdc_capture(struct vpfe_device *vpfe_dev) +{ + vpfe_dev->started = 0; + ccdc_dev->hw_ops.enable(0); + if (ccdc_dev->hw_ops.enable_out_to_sdram) + ccdc_dev->hw_ops.enable_out_to_sdram(0); +} + +/* + * vpfe_release : This function deletes buffer queue, frees the + * buffers and the vpfe file handle + */ +static int vpfe_release(struct file *file) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh = file->private_data; + struct vpfe_subdev_info *sdinfo; + int ret; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_release\n"); + + /* Get the device lock */ + mutex_lock(&vpfe_dev->lock); + /* if this instance is doing IO */ + if (fh->io_allowed) { + if (vpfe_dev->started) { + sdinfo = vpfe_dev->current_subdev; + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, + sdinfo->grp_id, + video, s_stream, 0); + if (ret && (ret != -ENOIOCTLCMD)) + v4l2_err(&vpfe_dev->v4l2_dev, + "stream off failed in subdev\n"); + vpfe_stop_ccdc_capture(vpfe_dev); + vpfe_detach_irq(vpfe_dev); + videobuf_streamoff(&vpfe_dev->buffer_queue); + } + vpfe_dev->io_usrs = 0; + vpfe_dev->numbuffers = config_params.numbuffers; + } + + /* Decrement device usrs counter */ + vpfe_dev->usrs--; + /* Close the priority */ + v4l2_prio_close(&vpfe_dev->prio, &fh->prio); + /* If this is the last file handle */ + if (!vpfe_dev->usrs) { + vpfe_dev->initialized = 0; + if (ccdc_dev->hw_ops.close) + ccdc_dev->hw_ops.close(vpfe_dev->pdev); + module_put(ccdc_dev->owner); + } + mutex_unlock(&vpfe_dev->lock); + file->private_data = NULL; + /* Free memory allocated to file handle object */ + kfree(fh); + return 0; +} + +/* + * vpfe_mmap : It is used to map kernel space buffers + * into user spaces + */ +static int vpfe_mmap(struct file *file, struct vm_area_struct *vma) +{ + /* Get the device object and file handle object */ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_mmap\n"); + + return videobuf_mmap_mapper(&vpfe_dev->buffer_queue, vma); +} + +/* + * vpfe_poll: It is used for select/poll system call + */ +static unsigned int vpfe_poll(struct file *file, poll_table *wait) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_poll\n"); + + if (vpfe_dev->started) + return videobuf_poll_stream(file, + &vpfe_dev->buffer_queue, wait); + return 0; +} + +/* vpfe capture driver file operations */ +static const struct v4l2_file_operations vpfe_fops = { + .owner = THIS_MODULE, + .open = vpfe_open, + .release = vpfe_release, + .unlocked_ioctl = video_ioctl2, + .mmap = vpfe_mmap, + .poll = vpfe_poll +}; + +/* + * vpfe_check_format() + * This function adjust the input pixel format as per hardware + * capabilities and update the same in pixfmt. + * Following algorithm used :- + * + * If given pixformat is not in the vpfe list of pix formats or not + * supported by the hardware, current value of pixformat in the device + * is used + * If given field is not supported, then current field is used. If field + * is different from current, then it is matched with that from sub device. + * Minimum height is 2 lines for interlaced or tb field and 1 line for + * progressive. Maximum height is clamped to active active lines of scan + * Minimum width is 32 bytes in memory and width is clamped to active + * pixels of scan. + * bytesperline is a multiple of 32. + */ +static const struct vpfe_pixel_format * + vpfe_check_format(struct vpfe_device *vpfe_dev, + struct v4l2_pix_format *pixfmt) +{ + u32 min_height = 1, min_width = 32, max_width, max_height; + const struct vpfe_pixel_format *vpfe_pix_fmt; + u32 pix; + int temp, found; + + vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); + if (NULL == vpfe_pix_fmt) { + /* + * use current pixel format in the vpfe device. We + * will find this pix format in the table + */ + pixfmt->pixelformat = vpfe_dev->fmt.fmt.pix.pixelformat; + vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); + } + + /* check if hw supports it */ + temp = 0; + found = 0; + while (ccdc_dev->hw_ops.enum_pix(&pix, temp) >= 0) { + if (vpfe_pix_fmt->fmtdesc.pixelformat == pix) { + found = 1; + break; + } + temp++; + } + + if (!found) { + /* use current pixel format */ + pixfmt->pixelformat = vpfe_dev->fmt.fmt.pix.pixelformat; + /* + * Since this is currently used in the vpfe device, we + * will find this pix format in the table + */ + vpfe_pix_fmt = vpfe_lookup_pix_format(pixfmt->pixelformat); + } + + /* check what field format is supported */ + if (pixfmt->field == V4L2_FIELD_ANY) { + /* if field is any, use current value as default */ + pixfmt->field = vpfe_dev->fmt.fmt.pix.field; + } + + /* + * if field is not same as current field in the vpfe device + * try matching the field with the sub device field + */ + if (vpfe_dev->fmt.fmt.pix.field != pixfmt->field) { + /* + * If field value is not in the supported fields, use current + * field used in the device as default + */ + switch (pixfmt->field) { + case V4L2_FIELD_INTERLACED: + case V4L2_FIELD_SEQ_TB: + /* if sub device is supporting progressive, use that */ + if (!vpfe_dev->std_info.frame_format) + pixfmt->field = V4L2_FIELD_NONE; + break; + case V4L2_FIELD_NONE: + if (vpfe_dev->std_info.frame_format) + pixfmt->field = V4L2_FIELD_INTERLACED; + break; + + default: + /* use current field as default */ + pixfmt->field = vpfe_dev->fmt.fmt.pix.field; + break; + } + } + + /* Now adjust image resolutions supported */ + if (pixfmt->field == V4L2_FIELD_INTERLACED || + pixfmt->field == V4L2_FIELD_SEQ_TB) + min_height = 2; + + max_width = vpfe_dev->std_info.active_pixels; + max_height = vpfe_dev->std_info.active_lines; + min_width /= vpfe_pix_fmt->bpp; + + v4l2_info(&vpfe_dev->v4l2_dev, "width = %d, height = %d, bpp = %d\n", + pixfmt->width, pixfmt->height, vpfe_pix_fmt->bpp); + + pixfmt->width = clamp((pixfmt->width), min_width, max_width); + pixfmt->height = clamp((pixfmt->height), min_height, max_height); + + /* If interlaced, adjust height to be a multiple of 2 */ + if (pixfmt->field == V4L2_FIELD_INTERLACED) + pixfmt->height &= (~1); + /* + * recalculate bytesperline and sizeimage since width + * and height might have changed + */ + pixfmt->bytesperline = (((pixfmt->width * vpfe_pix_fmt->bpp) + 31) + & ~31); + if (pixfmt->pixelformat == V4L2_PIX_FMT_NV12) + pixfmt->sizeimage = + pixfmt->bytesperline * pixfmt->height + + ((pixfmt->bytesperline * pixfmt->height) >> 1); + else + pixfmt->sizeimage = pixfmt->bytesperline * pixfmt->height; + + v4l2_info(&vpfe_dev->v4l2_dev, "adjusted width = %d, height =" + " %d, bpp = %d, bytesperline = %d, sizeimage = %d\n", + pixfmt->width, pixfmt->height, vpfe_pix_fmt->bpp, + pixfmt->bytesperline, pixfmt->sizeimage); + return vpfe_pix_fmt; +} + +static int vpfe_querycap(struct file *file, void *priv, + struct v4l2_capability *cap) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querycap\n"); + + cap->version = VPFE_CAPTURE_VERSION_CODE; + cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; + strlcpy(cap->driver, CAPTURE_DRV_NAME, sizeof(cap->driver)); + strlcpy(cap->bus_info, "VPFE", sizeof(cap->bus_info)); + strlcpy(cap->card, vpfe_dev->cfg->card_name, sizeof(cap->card)); + return 0; +} + +static int vpfe_g_fmt_vid_cap(struct file *file, void *priv, + struct v4l2_format *fmt) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_fmt_vid_cap\n"); + /* Fill in the information about format */ + *fmt = vpfe_dev->fmt; + return ret; +} + +static int vpfe_enum_fmt_vid_cap(struct file *file, void *priv, + struct v4l2_fmtdesc *fmt) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + const struct vpfe_pixel_format *pix_fmt; + int temp_index; + u32 pix; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_enum_fmt_vid_cap\n"); + + if (ccdc_dev->hw_ops.enum_pix(&pix, fmt->index) < 0) + return -EINVAL; + + /* Fill in the information about format */ + pix_fmt = vpfe_lookup_pix_format(pix); + if (NULL != pix_fmt) { + temp_index = fmt->index; + *fmt = pix_fmt->fmtdesc; + fmt->index = temp_index; + return 0; + } + return -EINVAL; +} + +static int vpfe_s_fmt_vid_cap(struct file *file, void *priv, + struct v4l2_format *fmt) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + const struct vpfe_pixel_format *pix_fmts; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_fmt_vid_cap\n"); + + /* If streaming is started, return error */ + if (vpfe_dev->started) { + v4l2_err(&vpfe_dev->v4l2_dev, "Streaming is started\n"); + return -EBUSY; + } + + /* Check for valid frame format */ + pix_fmts = vpfe_check_format(vpfe_dev, &fmt->fmt.pix); + + if (NULL == pix_fmts) + return -EINVAL; + + /* store the pixel format in the device object */ + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + /* First detach any IRQ if currently attached */ + vpfe_detach_irq(vpfe_dev); + vpfe_dev->fmt = *fmt; + /* set image capture parameters in the ccdc */ + ret = vpfe_config_ccdc_image_format(vpfe_dev); + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_try_fmt_vid_cap(struct file *file, void *priv, + struct v4l2_format *f) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + const struct vpfe_pixel_format *pix_fmts; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_try_fmt_vid_cap\n"); + + pix_fmts = vpfe_check_format(vpfe_dev, &f->fmt.pix); + if (NULL == pix_fmts) + return -EINVAL; + return 0; +} + +/* + * vpfe_get_subdev_input_index - Get subdev index and subdev input index for a + * given app input index + */ +static int vpfe_get_subdev_input_index(struct vpfe_device *vpfe_dev, + int *subdev_index, + int *subdev_input_index, + int app_input_index) +{ + struct vpfe_config *cfg = vpfe_dev->cfg; + struct vpfe_subdev_info *sdinfo; + int i, j = 0; + + for (i = 0; i < cfg->num_subdevs; i++) { + sdinfo = &cfg->sub_devs[i]; + if (app_input_index < (j + sdinfo->num_inputs)) { + *subdev_index = i; + *subdev_input_index = app_input_index - j; + return 0; + } + j += sdinfo->num_inputs; + } + return -EINVAL; +} + +/* + * vpfe_get_app_input - Get app input index for a given subdev input index + * driver stores the input index of the current sub device and translate it + * when application request the current input + */ +static int vpfe_get_app_input_index(struct vpfe_device *vpfe_dev, + int *app_input_index) +{ + struct vpfe_config *cfg = vpfe_dev->cfg; + struct vpfe_subdev_info *sdinfo; + int i, j = 0; + + for (i = 0; i < cfg->num_subdevs; i++) { + sdinfo = &cfg->sub_devs[i]; + if (!strcmp(sdinfo->name, vpfe_dev->current_subdev->name)) { + if (vpfe_dev->current_input >= sdinfo->num_inputs) + return -1; + *app_input_index = j + vpfe_dev->current_input; + return 0; + } + j += sdinfo->num_inputs; + } + return -EINVAL; +} + +static int vpfe_enum_input(struct file *file, void *priv, + struct v4l2_input *inp) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_subdev_info *sdinfo; + int subdev, index ; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_enum_input\n"); + + if (vpfe_get_subdev_input_index(vpfe_dev, + &subdev, + &index, + inp->index) < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, "input information not found" + " for the subdev\n"); + return -EINVAL; + } + sdinfo = &vpfe_dev->cfg->sub_devs[subdev]; + memcpy(inp, &sdinfo->inputs[index], sizeof(struct v4l2_input)); + return 0; +} + +static int vpfe_g_input(struct file *file, void *priv, unsigned int *index) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_input\n"); + + return vpfe_get_app_input_index(vpfe_dev, index); +} + + +static int vpfe_s_input(struct file *file, void *priv, unsigned int index) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_subdev_info *sdinfo; + int subdev_index, inp_index; + struct vpfe_route *route; + u32 input = 0, output = 0; + int ret = -EINVAL; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_input\n"); + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + /* + * If streaming is started return device busy + * error + */ + if (vpfe_dev->started) { + v4l2_err(&vpfe_dev->v4l2_dev, "Streaming is on\n"); + ret = -EBUSY; + goto unlock_out; + } + + if (vpfe_get_subdev_input_index(vpfe_dev, + &subdev_index, + &inp_index, + index) < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, "invalid input index\n"); + goto unlock_out; + } + + sdinfo = &vpfe_dev->cfg->sub_devs[subdev_index]; + route = &sdinfo->routes[inp_index]; + if (route && sdinfo->can_route) { + input = route->input; + output = route->output; + } + + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, + video, s_routing, input, output, 0); + + if (ret) { + v4l2_err(&vpfe_dev->v4l2_dev, + "vpfe_doioctl:error in setting input in decoder\n"); + ret = -EINVAL; + goto unlock_out; + } + vpfe_dev->current_subdev = sdinfo; + vpfe_dev->current_input = index; + vpfe_dev->std_index = 0; + + /* set the bus/interface parameter for the sub device in ccdc */ + ret = ccdc_dev->hw_ops.set_hw_if_params(&sdinfo->ccdc_if_params); + if (ret) + goto unlock_out; + + /* set the default image parameters in the device */ + ret = vpfe_config_image_format(vpfe_dev, + &vpfe_standards[vpfe_dev->std_index].std_id); +unlock_out: + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_querystd(struct file *file, void *priv, v4l2_std_id *std_id) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_subdev_info *sdinfo; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querystd\n"); + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + sdinfo = vpfe_dev->current_subdev; + if (ret) + return ret; + /* Call querystd function of decoder device */ + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, + video, querystd, std_id); + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_s_std(struct file *file, void *priv, v4l2_std_id *std_id) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_subdev_info *sdinfo; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_std\n"); + + /* Call decoder driver function to set the standard */ + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + sdinfo = vpfe_dev->current_subdev; + /* If streaming is started, return device busy error */ + if (vpfe_dev->started) { + v4l2_err(&vpfe_dev->v4l2_dev, "streaming is started\n"); + ret = -EBUSY; + goto unlock_out; + } + + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, + core, s_std, *std_id); + if (ret < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, "Failed to set standard\n"); + goto unlock_out; + } + ret = vpfe_config_image_format(vpfe_dev, std_id); + +unlock_out: + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_g_std(struct file *file, void *priv, v4l2_std_id *std_id) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_std\n"); + + *std_id = vpfe_standards[vpfe_dev->std_index].std_id; + return 0; +} +/* + * Videobuf operations + */ +static int vpfe_videobuf_setup(struct videobuf_queue *vq, + unsigned int *count, + unsigned int *size) +{ + struct vpfe_fh *fh = vq->priv_data; + struct vpfe_device *vpfe_dev = fh->vpfe_dev; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_setup\n"); + *size = config_params.device_bufsize; + + if (*count < config_params.min_numbuffers) + *count = config_params.min_numbuffers; + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, + "count=%d, size=%d\n", *count, *size); + return 0; +} + +static int vpfe_videobuf_prepare(struct videobuf_queue *vq, + struct videobuf_buffer *vb, + enum v4l2_field field) +{ + struct vpfe_fh *fh = vq->priv_data; + struct vpfe_device *vpfe_dev = fh->vpfe_dev; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_prepare\n"); + + /* If buffer is not initialized, initialize it */ + if (VIDEOBUF_NEEDS_INIT == vb->state) { + vb->width = vpfe_dev->fmt.fmt.pix.width; + vb->height = vpfe_dev->fmt.fmt.pix.height; + vb->size = vpfe_dev->fmt.fmt.pix.sizeimage; + vb->field = field; + } + vb->state = VIDEOBUF_PREPARED; + return 0; +} + +static void vpfe_videobuf_queue(struct videobuf_queue *vq, + struct videobuf_buffer *vb) +{ + /* Get the file handle object and device object */ + struct vpfe_fh *fh = vq->priv_data; + struct vpfe_device *vpfe_dev = fh->vpfe_dev; + unsigned long flags; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_buffer_queue\n"); + + /* add the buffer to the DMA queue */ + spin_lock_irqsave(&vpfe_dev->dma_queue_lock, flags); + list_add_tail(&vb->queue, &vpfe_dev->dma_queue); + spin_unlock_irqrestore(&vpfe_dev->dma_queue_lock, flags); + + /* Change state of the buffer */ + vb->state = VIDEOBUF_QUEUED; +} + +static void vpfe_videobuf_release(struct videobuf_queue *vq, + struct videobuf_buffer *vb) +{ + struct vpfe_fh *fh = vq->priv_data; + struct vpfe_device *vpfe_dev = fh->vpfe_dev; + unsigned long flags; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_videobuf_release\n"); + + /* + * We need to flush the buffer from the dma queue since + * they are de-allocated + */ + spin_lock_irqsave(&vpfe_dev->dma_queue_lock, flags); + INIT_LIST_HEAD(&vpfe_dev->dma_queue); + spin_unlock_irqrestore(&vpfe_dev->dma_queue_lock, flags); + videobuf_dma_contig_free(vq, vb); + vb->state = VIDEOBUF_NEEDS_INIT; +} + +static struct videobuf_queue_ops vpfe_videobuf_qops = { + .buf_setup = vpfe_videobuf_setup, + .buf_prepare = vpfe_videobuf_prepare, + .buf_queue = vpfe_videobuf_queue, + .buf_release = vpfe_videobuf_release, +}; + +/* + * vpfe_reqbufs. currently support REQBUF only once opening + * the device. + */ +static int vpfe_reqbufs(struct file *file, void *priv, + struct v4l2_requestbuffers *req_buf) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh = file->private_data; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_reqbufs\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != req_buf->type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buffer type\n"); + return -EINVAL; + } + + if (V4L2_MEMORY_USERPTR == req_buf->memory) { + /* we don't support user ptr IO */ + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_reqbufs:" + " USERPTR IO not supported\n"); + return -EINVAL; + } + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + if (vpfe_dev->io_usrs != 0) { + v4l2_err(&vpfe_dev->v4l2_dev, "Only one IO user allowed\n"); + ret = -EBUSY; + goto unlock_out; + } + + vpfe_dev->memory = req_buf->memory; + videobuf_queue_dma_contig_init(&vpfe_dev->buffer_queue, + &vpfe_videobuf_qops, + NULL, + &vpfe_dev->irqlock, + req_buf->type, + vpfe_dev->fmt.fmt.pix.field, + sizeof(struct videobuf_buffer), + fh); + + fh->io_allowed = 1; + vpfe_dev->io_usrs = 1; + INIT_LIST_HEAD(&vpfe_dev->dma_queue); + ret = videobuf_reqbufs(&vpfe_dev->buffer_queue, req_buf); +unlock_out: + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_querybuf(struct file *file, void *priv, + struct v4l2_buffer *buf) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_querybuf\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf->type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); + return -EINVAL; + } + + if (vpfe_dev->memory != V4L2_MEMORY_MMAP) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid memory\n"); + return -EINVAL; + } + /* Call videobuf_querybuf to get information */ + return videobuf_querybuf(&vpfe_dev->buffer_queue, buf); +} + +static int vpfe_qbuf(struct file *file, void *priv, + struct v4l2_buffer *p) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh = file->private_data; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_qbuf\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != p->type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); + return -EINVAL; + } + + /* + * If this file handle is not allowed to do IO, + * return error + */ + if (!fh->io_allowed) { + v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); + return -EACCES; + } + return videobuf_qbuf(&vpfe_dev->buffer_queue, p); +} + +static int vpfe_dqbuf(struct file *file, void *priv, + struct v4l2_buffer *buf) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_dqbuf\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf->type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); + return -EINVAL; + } + return videobuf_dqbuf(&vpfe_dev->buffer_queue, + buf, file->f_flags & O_NONBLOCK); +} + +/* + * vpfe_calculate_offsets : This function calculates buffers offset + * for top and bottom field + */ +static void vpfe_calculate_offsets(struct vpfe_device *vpfe_dev) +{ + struct v4l2_rect image_win; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_calculate_offsets\n"); + + ccdc_dev->hw_ops.get_image_window(&image_win); + vpfe_dev->field_off = image_win.height * image_win.width; +} + +/* vpfe_start_ccdc_capture: start streaming in ccdc/isif */ +static void vpfe_start_ccdc_capture(struct vpfe_device *vpfe_dev) +{ + ccdc_dev->hw_ops.enable(1); + if (ccdc_dev->hw_ops.enable_out_to_sdram) + ccdc_dev->hw_ops.enable_out_to_sdram(1); + vpfe_dev->started = 1; +} + +/* + * vpfe_streamon. Assume the DMA queue is not empty. + * application is expected to call QBUF before calling + * this ioctl. If not, driver returns error + */ +static int vpfe_streamon(struct file *file, void *priv, + enum v4l2_buf_type buf_type) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh = file->private_data; + struct vpfe_subdev_info *sdinfo; + unsigned long addr; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_streamon\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf_type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); + return -EINVAL; + } + + /* If file handle is not allowed IO, return error */ + if (!fh->io_allowed) { + v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); + return -EACCES; + } + + sdinfo = vpfe_dev->current_subdev; + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, + video, s_stream, 1); + + if (ret && (ret != -ENOIOCTLCMD)) { + v4l2_err(&vpfe_dev->v4l2_dev, "stream on failed in subdev\n"); + return -EINVAL; + } + + /* If buffer queue is empty, return error */ + if (list_empty(&vpfe_dev->buffer_queue.stream)) { + v4l2_err(&vpfe_dev->v4l2_dev, "buffer queue is empty\n"); + return -EIO; + } + + /* Call videobuf_streamon to start streaming * in videobuf */ + ret = videobuf_streamon(&vpfe_dev->buffer_queue); + if (ret) + return ret; + + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + goto streamoff; + /* Get the next frame from the buffer queue */ + vpfe_dev->next_frm = list_entry(vpfe_dev->dma_queue.next, + struct videobuf_buffer, queue); + vpfe_dev->cur_frm = vpfe_dev->next_frm; + /* Remove buffer from the buffer queue */ + list_del(&vpfe_dev->cur_frm->queue); + /* Mark state of the current frame to active */ + vpfe_dev->cur_frm->state = VIDEOBUF_ACTIVE; + /* Initialize field_id and started member */ + vpfe_dev->field_id = 0; + addr = videobuf_to_dma_contig(vpfe_dev->cur_frm); + + /* Calculate field offset */ + vpfe_calculate_offsets(vpfe_dev); + + if (vpfe_attach_irq(vpfe_dev) < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, + "Error in attaching interrupt handle\n"); + ret = -EFAULT; + goto unlock_out; + } + if (ccdc_dev->hw_ops.configure() < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, + "Error in configuring ccdc\n"); + ret = -EINVAL; + goto unlock_out; + } + ccdc_dev->hw_ops.setfbaddr((unsigned long)(addr)); + vpfe_start_ccdc_capture(vpfe_dev); + mutex_unlock(&vpfe_dev->lock); + return ret; +unlock_out: + mutex_unlock(&vpfe_dev->lock); +streamoff: + ret = videobuf_streamoff(&vpfe_dev->buffer_queue); + return ret; +} + +static int vpfe_streamoff(struct file *file, void *priv, + enum v4l2_buf_type buf_type) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + struct vpfe_fh *fh = file->private_data; + struct vpfe_subdev_info *sdinfo; + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_streamoff\n"); + + if (V4L2_BUF_TYPE_VIDEO_CAPTURE != buf_type) { + v4l2_err(&vpfe_dev->v4l2_dev, "Invalid buf type\n"); + return -EINVAL; + } + + /* If io is allowed for this file handle, return error */ + if (!fh->io_allowed) { + v4l2_err(&vpfe_dev->v4l2_dev, "fh->io_allowed\n"); + return -EACCES; + } + + /* If streaming is not started, return error */ + if (!vpfe_dev->started) { + v4l2_err(&vpfe_dev->v4l2_dev, "device started\n"); + return -EINVAL; + } + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + vpfe_stop_ccdc_capture(vpfe_dev); + vpfe_detach_irq(vpfe_dev); + + sdinfo = vpfe_dev->current_subdev; + ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev, sdinfo->grp_id, + video, s_stream, 0); + + if (ret && (ret != -ENOIOCTLCMD)) + v4l2_err(&vpfe_dev->v4l2_dev, "stream off failed in subdev\n"); + ret = videobuf_streamoff(&vpfe_dev->buffer_queue); + mutex_unlock(&vpfe_dev->lock); + return ret; +} + +static int vpfe_cropcap(struct file *file, void *priv, + struct v4l2_cropcap *crop) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_cropcap\n"); + + if (vpfe_dev->std_index > ARRAY_SIZE(vpfe_standards)) + return -EINVAL; + + memset(crop, 0, sizeof(struct v4l2_cropcap)); + crop->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + crop->bounds.width = crop->defrect.width = + vpfe_standards[vpfe_dev->std_index].width; + crop->bounds.height = crop->defrect.height = + vpfe_standards[vpfe_dev->std_index].height; + crop->pixelaspect = vpfe_standards[vpfe_dev->std_index].pixelaspect; + return 0; +} + +static int vpfe_g_crop(struct file *file, void *priv, + struct v4l2_crop *crop) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_g_crop\n"); + + crop->c = vpfe_dev->crop; + return 0; +} + +static int vpfe_s_crop(struct file *file, void *priv, + struct v4l2_crop *crop) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_s_crop\n"); + + if (vpfe_dev->started) { + /* make sure streaming is not started */ + v4l2_err(&vpfe_dev->v4l2_dev, + "Cannot change crop when streaming is ON\n"); + return -EBUSY; + } + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + if (crop->c.top < 0 || crop->c.left < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, + "doesn't support negative values for top & left\n"); + ret = -EINVAL; + goto unlock_out; + } + + /* adjust the width to 16 pixel boundry */ + crop->c.width = ((crop->c.width + 15) & ~0xf); + + /* make sure parameters are valid */ + if ((crop->c.left + crop->c.width > + vpfe_dev->std_info.active_pixels) || + (crop->c.top + crop->c.height > + vpfe_dev->std_info.active_lines)) { + v4l2_err(&vpfe_dev->v4l2_dev, "Error in S_CROP params\n"); + ret = -EINVAL; + goto unlock_out; + } + ccdc_dev->hw_ops.set_image_window(&crop->c); + vpfe_dev->fmt.fmt.pix.width = crop->c.width; + vpfe_dev->fmt.fmt.pix.height = crop->c.height; + vpfe_dev->fmt.fmt.pix.bytesperline = + ccdc_dev->hw_ops.get_line_length(); + vpfe_dev->fmt.fmt.pix.sizeimage = + vpfe_dev->fmt.fmt.pix.bytesperline * + vpfe_dev->fmt.fmt.pix.height; + vpfe_dev->crop = crop->c; +unlock_out: + mutex_unlock(&vpfe_dev->lock); + return ret; +} + + +static long vpfe_param_handler(struct file *file, void *priv, + int cmd, void *param) +{ + struct vpfe_device *vpfe_dev = video_drvdata(file); + int ret = 0; + + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, "vpfe_param_handler\n"); + + if (vpfe_dev->started) { + /* only allowed if streaming is not started */ + v4l2_err(&vpfe_dev->v4l2_dev, "device already started\n"); + return -EBUSY; + } + + ret = mutex_lock_interruptible(&vpfe_dev->lock); + if (ret) + return ret; + + switch (cmd) { + case VPFE_CMD_S_CCDC_RAW_PARAMS: + ret = ccdc_dev->hw_ops.set_params(param); + if (ret) { + v4l2_err(&vpfe_dev->v4l2_dev, + "Error in setting parameters in CCDC\n"); + goto unlock_out; + } + if (vpfe_get_ccdc_image_format(vpfe_dev, &vpfe_dev->fmt) < 0) { + v4l2_err(&vpfe_dev->v4l2_dev, + "Invalid image format at CCDC\n"); + goto unlock_out; + } + break; + default: + ret = -EINVAL; + } +unlock_out: + mutex_unlock(&vpfe_dev->lock); + return ret; +} + + +/* vpfe capture ioctl operations */ +static const struct v4l2_ioctl_ops vpfe_ioctl_ops = { + .vidioc_querycap = vpfe_querycap, + .vidioc_g_fmt_vid_cap = vpfe_g_fmt_vid_cap, + .vidioc_enum_fmt_vid_cap = vpfe_enum_fmt_vid_cap, + .vidioc_s_fmt_vid_cap = vpfe_s_fmt_vid_cap, + .vidioc_try_fmt_vid_cap = vpfe_try_fmt_vid_cap, + .vidioc_enum_input = vpfe_enum_input, + .vidioc_g_input = vpfe_g_input, + .vidioc_s_input = vpfe_s_input, + .vidioc_querystd = vpfe_querystd, + .vidioc_s_std = vpfe_s_std, + .vidioc_g_std = vpfe_g_std, + .vidioc_reqbufs = vpfe_reqbufs, + .vidioc_querybuf = vpfe_querybuf, + .vidioc_qbuf = vpfe_qbuf, + .vidioc_dqbuf = vpfe_dqbuf, + .vidioc_streamon = vpfe_streamon, + .vidioc_streamoff = vpfe_streamoff, + .vidioc_cropcap = vpfe_cropcap, + .vidioc_g_crop = vpfe_g_crop, + .vidioc_s_crop = vpfe_s_crop, + .vidioc_default = vpfe_param_handler, +}; + +static struct vpfe_device *vpfe_initialize(void) +{ + struct vpfe_device *vpfe_dev; + + /* Default number of buffers should be 3 */ + if ((numbuffers > 0) && + (numbuffers < config_params.min_numbuffers)) + numbuffers = config_params.min_numbuffers; + + /* + * Set buffer size to min buffers size if invalid buffer size is + * given + */ + if (bufsize < config_params.min_bufsize) + bufsize = config_params.min_bufsize; + + config_params.numbuffers = numbuffers; + + if (numbuffers) + config_params.device_bufsize = bufsize; + + /* Allocate memory for device objects */ + vpfe_dev = kzalloc(sizeof(*vpfe_dev), GFP_KERNEL); + + return vpfe_dev; +} + +static void vpfe_disable_clock(struct vpfe_device *vpfe_dev) +{ + struct vpfe_config *vpfe_cfg = vpfe_dev->cfg; + + clk_disable(vpfe_cfg->vpssclk); + clk_put(vpfe_cfg->vpssclk); + clk_disable(vpfe_cfg->slaveclk); + clk_put(vpfe_cfg->slaveclk); + v4l2_info(vpfe_dev->pdev->driver, + "vpfe vpss master & slave clocks disabled\n"); +} + +static int vpfe_enable_clock(struct vpfe_device *vpfe_dev) +{ + struct vpfe_config *vpfe_cfg = vpfe_dev->cfg; + int ret = -ENOENT; + + vpfe_cfg->vpssclk = clk_get(vpfe_dev->pdev, "vpss_master"); + if (NULL == vpfe_cfg->vpssclk) { + v4l2_err(vpfe_dev->pdev->driver, "No clock defined for" + "vpss_master\n"); + return ret; + } + + if (clk_enable(vpfe_cfg->vpssclk)) { + v4l2_err(vpfe_dev->pdev->driver, + "vpfe vpss master clock not enabled\n"); + goto out; + } + v4l2_info(vpfe_dev->pdev->driver, + "vpfe vpss master clock enabled\n"); + + vpfe_cfg->slaveclk = clk_get(vpfe_dev->pdev, "vpss_slave"); + if (NULL == vpfe_cfg->slaveclk) { + v4l2_err(vpfe_dev->pdev->driver, + "No clock defined for vpss slave\n"); + goto out; + } + + if (clk_enable(vpfe_cfg->slaveclk)) { + v4l2_err(vpfe_dev->pdev->driver, + "vpfe vpss slave clock not enabled\n"); + goto out; + } + v4l2_info(vpfe_dev->pdev->driver, "vpfe vpss slave clock enabled\n"); + return 0; +out: + if (vpfe_cfg->vpssclk) + clk_put(vpfe_cfg->vpssclk); + if (vpfe_cfg->slaveclk) + clk_put(vpfe_cfg->slaveclk); + + return -1; +} + +/* + * vpfe_probe : This function creates device entries by register + * itself to the V4L2 driver and initializes fields of each + * device objects + */ +static __init int vpfe_probe(struct platform_device *pdev) +{ + struct vpfe_config *vpfe_cfg; + struct resource *res1; + struct vpfe_device *vpfe_dev; + struct i2c_adapter *i2c_adap; + struct i2c_client *client; + struct video_device *vfd; + int ret = -ENOMEM, i, j; + int num_subdevs = 0; + + /* Get the pointer to the device object */ + vpfe_dev = vpfe_initialize(); + + if (!vpfe_dev) { + v4l2_err(pdev->dev.driver, + "Failed to allocate memory for vpfe_dev\n"); + return ret; + } + + vpfe_dev->pdev = &pdev->dev; + + if (NULL == pdev->dev.platform_data) { + v4l2_err(pdev->dev.driver, "Unable to get vpfe config\n"); + ret = -ENOENT; + goto probe_free_dev_mem; + } + + vpfe_cfg = pdev->dev.platform_data; + vpfe_dev->cfg = vpfe_cfg; + if (NULL == vpfe_cfg->ccdc || + NULL == vpfe_cfg->card_name || + NULL == vpfe_cfg->sub_devs) { + v4l2_err(pdev->dev.driver, "null ptr in vpfe_cfg\n"); + ret = -ENOENT; + goto probe_free_dev_mem; + } + + /* enable vpss clocks */ + ret = vpfe_enable_clock(vpfe_dev); + if (ret) + goto probe_free_dev_mem; + + mutex_lock(&ccdc_lock); + /* Allocate memory for ccdc configuration */ + ccdc_cfg = kmalloc(sizeof(struct ccdc_config), GFP_KERNEL); + if (NULL == ccdc_cfg) { + v4l2_err(pdev->dev.driver, + "Memory allocation failed for ccdc_cfg\n"); + goto probe_disable_clock; + } + + strncpy(ccdc_cfg->name, vpfe_cfg->ccdc, 32); + /* Get VINT0 irq resource */ + res1 = platform_get_resource(pdev, IORESOURCE_IRQ, 0); + if (!res1) { + v4l2_err(pdev->dev.driver, + "Unable to get interrupt for VINT0\n"); + ret = -ENOENT; + goto probe_disable_clock; + } + vpfe_dev->ccdc_irq0 = res1->start; + + /* Get VINT1 irq resource */ + res1 = platform_get_resource(pdev, + IORESOURCE_IRQ, 1); + if (!res1) { + v4l2_err(pdev->dev.driver, + "Unable to get interrupt for VINT1\n"); + ret = -ENOENT; + goto probe_disable_clock; + } + vpfe_dev->ccdc_irq1 = res1->start; + + /* Get address base of CCDC */ + res1 = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res1) { + v4l2_err(pdev->dev.driver, + "Unable to get register address map\n"); + ret = -ENOENT; + goto probe_disable_clock; + } + + ccdc_cfg->ccdc_addr_size = res1->end - res1->start + 1; + if (!request_mem_region(res1->start, ccdc_cfg->ccdc_addr_size, + pdev->dev.driver->name)) { + v4l2_err(pdev->dev.driver, + "Failed request_mem_region for ccdc base\n"); + ret = -ENXIO; + goto probe_disable_clock; + } + ccdc_cfg->ccdc_addr = ioremap_nocache(res1->start, + ccdc_cfg->ccdc_addr_size); + if (!ccdc_cfg->ccdc_addr) { + v4l2_err(pdev->dev.driver, "Unable to ioremap ccdc addr\n"); + ret = -ENXIO; + goto probe_out_release_mem1; + } + + ret = request_irq(vpfe_dev->ccdc_irq0, vpfe_isr, IRQF_DISABLED, + "vpfe_capture0", vpfe_dev); + + if (0 != ret) { + v4l2_err(pdev->dev.driver, "Unable to request interrupt\n"); + goto probe_out_unmap1; + } + + /* Allocate memory for video device */ + vfd = video_device_alloc(); + if (NULL == vfd) { + ret = -ENOMEM; + v4l2_err(pdev->dev.driver, + "Unable to alloc video device\n"); + goto probe_out_release_irq; + } + + /* Initialize field of video device */ + vfd->release = video_device_release; + vfd->current_norm = V4L2_STD_UNKNOWN; + vfd->fops = &vpfe_fops; + vfd->ioctl_ops = &vpfe_ioctl_ops; + vfd->minor = -1; + vfd->tvnorms = 0; + vfd->current_norm = V4L2_STD_PAL; + vfd->v4l2_dev = &vpfe_dev->v4l2_dev; + snprintf(vfd->name, sizeof(vfd->name), + "%s_V%d.%d.%d", + CAPTURE_DRV_NAME, + (VPFE_CAPTURE_VERSION_CODE >> 16) & 0xff, + (VPFE_CAPTURE_VERSION_CODE >> 8) & 0xff, + (VPFE_CAPTURE_VERSION_CODE) & 0xff); + /* Set video_dev to the video device */ + vpfe_dev->video_dev = vfd; + + ret = v4l2_device_register(&pdev->dev, &vpfe_dev->v4l2_dev); + if (ret) { + v4l2_err(pdev->dev.driver, + "Unable to register v4l2 device.\n"); + goto probe_out_video_release; + } + v4l2_info(&vpfe_dev->v4l2_dev, "v4l2 device registered\n"); + spin_lock_init(&vpfe_dev->irqlock); + spin_lock_init(&vpfe_dev->dma_queue_lock); + mutex_init(&vpfe_dev->lock); + + /* Initialize field of the device objects */ + vpfe_dev->numbuffers = config_params.numbuffers; + + /* Initialize prio member of device object */ + v4l2_prio_init(&vpfe_dev->prio); + /* register video device */ + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, + "trying to register vpfe device.\n"); + v4l2_dbg(1, debug, &vpfe_dev->v4l2_dev, + "video_dev=%x\n", (int)&vpfe_dev->video_dev); + vpfe_dev->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + ret = video_register_device(vpfe_dev->video_dev, + VFL_TYPE_GRABBER, -1); + + if (ret) { + v4l2_err(pdev->dev.driver, + "Unable to register video device.\n"); + goto probe_out_v4l2_unregister; + } + + v4l2_info(&vpfe_dev->v4l2_dev, "video device registered\n"); + /* set the driver data in platform device */ + platform_set_drvdata(pdev, vpfe_dev); + /* set driver private data */ + video_set_drvdata(vpfe_dev->video_dev, vpfe_dev); + i2c_adap = i2c_get_adapter(1); + vpfe_cfg = pdev->dev.platform_data; + num_subdevs = vpfe_cfg->num_subdevs; + vpfe_dev->sd = kmalloc(sizeof(struct v4l2_subdev *) * num_subdevs, + GFP_KERNEL); + if (NULL == vpfe_dev->sd) { + v4l2_err(&vpfe_dev->v4l2_dev, + "unable to allocate memory for subdevice pointers\n"); + ret = -ENOMEM; + goto probe_out_video_unregister; + } + + for (i = 0; i < num_subdevs; i++) { + struct vpfe_subdev_info *sdinfo = &vpfe_cfg->sub_devs[i]; + struct v4l2_input *inps; + + list_for_each_entry(client, &i2c_adap->clients, list) { + if (!strcmp(client->name, sdinfo->name)) + break; + } + + if (NULL == client) { + v4l2_err(&vpfe_dev->v4l2_dev, "No Subdevice found\n"); + ret = -ENODEV; + goto probe_sd_out; + } + + /* Get subdevice data from the client */ + vpfe_dev->sd[i] = i2c_get_clientdata(client); + if (NULL == vpfe_dev->sd[i]) { + v4l2_err(&vpfe_dev->v4l2_dev, + "No Subdevice data\n"); + ret = -ENODEV; + goto probe_sd_out; + } + + vpfe_dev->sd[i]->grp_id = sdinfo->grp_id; + ret = v4l2_device_register_subdev(&vpfe_dev->v4l2_dev, + vpfe_dev->sd[i]); + if (ret) { + ret = -ENODEV; + v4l2_err(&vpfe_dev->v4l2_dev, + "Error registering v4l2 sub-device\n"); + goto probe_sd_out; + } + v4l2_info(&vpfe_dev->v4l2_dev, "v4l2 sub device %s" + " registered\n", client->name); + + /* update tvnorms from the sub devices */ + for (j = 0; j < sdinfo->num_inputs; j++) { + inps = &sdinfo->inputs[j]; + vfd->tvnorms |= inps->std; + } + } + /* We have at least one sub device to work with */ + vpfe_dev->current_subdev = &vpfe_cfg->sub_devs[0]; + mutex_unlock(&ccdc_lock); + return 0; + +probe_sd_out: + for (j = i; j >= 0; j--) + v4l2_device_unregister_subdev(vpfe_dev->sd[j]); + kfree(vpfe_dev->sd); +probe_out_video_unregister: + video_unregister_device(vpfe_dev->video_dev); +probe_out_v4l2_unregister: + v4l2_device_unregister(&vpfe_dev->v4l2_dev); +probe_out_video_release: + video_device_release(vpfe_dev->video_dev); +probe_out_release_irq: + free_irq(vpfe_dev->ccdc_irq0, vpfe_dev); +probe_out_unmap1: + iounmap(ccdc_cfg->ccdc_addr); +probe_out_release_mem1: + release_mem_region(res1->start, res1->end - res1->start + 1); +probe_disable_clock: + vpfe_disable_clock(vpfe_dev); + mutex_unlock(&ccdc_lock); + kfree(ccdc_cfg); +probe_free_dev_mem: + kfree(vpfe_dev); + return ret; +} + +/* + * vpfe_remove : It un-register device from V4L2 driver + */ +static int vpfe_remove(struct platform_device *pdev) +{ + struct vpfe_device *vpfe_dev = platform_get_drvdata(pdev); + struct resource *res; + int j; + + v4l2_info(pdev->dev.driver, "vpfe_remove\n"); + + free_irq(vpfe_dev->ccdc_irq0, vpfe_dev); + /* Unregister video device */ + for (j = 0; j < vpfe_dev->cfg->num_subdevs; j++) + v4l2_device_unregister_subdev(vpfe_dev->sd[j]); + kfree(vpfe_dev->sd); + v4l2_device_unregister(&vpfe_dev->v4l2_dev); + video_unregister_device(vpfe_dev->video_dev); + mutex_lock(&ccdc_lock); + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + release_mem_region(res->start, res->end - res->start + 1); + iounmap(ccdc_cfg->ccdc_addr); + mutex_unlock(&ccdc_lock); + vpfe_disable_clock(vpfe_dev); + kfree(vpfe_dev); + kfree(ccdc_cfg); + return 0; +} + +static int +vpfe_suspend(struct platform_device *dev, pm_message_t state) +{ + /* add suspend code here later */ + return -1; +} + +static int +vpfe_resume(struct platform_device *dev) +{ + /* add resume code here later */ + return -1; +} + +static struct platform_driver vpfe_driver = { + .driver = { + .name = CAPTURE_DRV_NAME, + .owner = THIS_MODULE, + }, + .probe = vpfe_probe, + .remove = __devexit_p(vpfe_remove), + .suspend = vpfe_suspend, + .resume = vpfe_resume, +}; + +static __init int vpfe_init(void) +{ + printk(KERN_NOTICE "vpfe_init\n"); + /* Register driver to the kernel */ + return platform_driver_register(&vpfe_driver); +} + +/* + * vpfe_cleanup : This function un-registers device driver + */ +static void vpfe_cleanup(void) +{ + platform_driver_unregister(&vpfe_driver); +} + +module_init(vpfe_init); +module_exit(vpfe_cleanup); diff --git a/include/media/davinci/vpfe_capture.h b/include/media/davinci/vpfe_capture.h new file mode 100644 index 0000000..cda5c9e --- /dev/null +++ b/include/media/davinci/vpfe_capture.h @@ -0,0 +1,194 @@ +/* + * Copyright (C) 2008-2009 Texas Instruments Inc + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + +#ifndef _VPFE_CAPTURE_H +#define _VPFE_CAPTURE_H + +#ifdef __KERNEL__ + +/* Header files */ +#include <media/v4l2-dev.h> +#include <linux/videodev2.h> +#include <linux/clk.h> +#include <media/v4l2-ioctl.h> +#include <media/v4l2-device.h> +#include <media/videobuf-dma-contig.h> +#include <media/davinci/vpfe_types.h> + +#define VPFE_CAPTURE_NUM_DECODERS 5 + +/* Macros */ +#define VPFE_MAJOR_RELEASE 0 +#define VPFE_MINOR_RELEASE 0 +#define VPFE_BUILD 1 +#define VPFE_CAPTURE_VERSION_CODE ((VPFE_MAJOR_RELEASE << 16) | \ + (VPFE_MINOR_RELEASE << 8) | \ + VPFE_BUILD) + +#define CAPTURE_DRV_NAME "vpfe-capture" + +struct vpfe_pixel_format { + struct v4l2_fmtdesc fmtdesc; + /* bytes per pixel */ + int bpp; +}; + +struct vpfe_std_info { + int active_pixels; + int active_lines; + /* current frame format */ + int frame_format; +}; + +struct vpfe_route { + u32 input; + u32 output; +}; + +struct vpfe_subdev_info { + /* Sub device name */ + char name[32]; + /* Sub device group id */ + int grp_id; + /* Number of inputs supported */ + int num_inputs; + /* inputs available at the sub device */ + struct v4l2_input *inputs; + /* Sub dev routing information for each input */ + struct vpfe_route *routes; + /* check if sub dev supports routing */ + int can_route; + /* ccdc bus/interface configuration */ + struct vpfe_hw_if_param ccdc_if_params; +}; + +struct vpfe_config { + /* Number of sub devices connected to vpfe */ + int num_subdevs; + /* information about each subdev */ + struct vpfe_subdev_info *sub_devs; + /* evm card info */ + char *card_name; + /* ccdc name */ + char *ccdc; + /* vpfe clock */ + struct clk *vpssclk; + struct clk *slaveclk; +}; + +struct vpfe_device { + /* V4l2 specific parameters */ + /* Identifies video device for this channel */ + struct video_device *video_dev; + /* sub devices */ + struct v4l2_subdev **sd; + /* vpfe cfg */ + struct vpfe_config *cfg; + /* V4l2 device */ + struct v4l2_device v4l2_dev; + /* parent device */ + struct device *pdev; + /* Used to keep track of state of the priority */ + struct v4l2_prio_state prio; + /* number of open instances of the channel */ + u32 usrs; + /* Indicates id of the field which is being displayed */ + u32 field_id; + /* flag to indicate whether decoder is initialized */ + u8 initialized; + /* current interface type */ + struct vpfe_hw_if_param vpfe_if_params; + /* ptr to currently selected sub device */ + struct vpfe_subdev_info *current_subdev; + /* current input at the sub device */ + int current_input; + /* Keeps track of the information about the standard */ + struct vpfe_std_info std_info; + /* std index into std table */ + int std_index; + /* CCDC IRQs used when CCDC/ISIF output to SDRAM */ + unsigned int ccdc_irq0; + unsigned int ccdc_irq1; + /* number of buffers in fbuffers */ + u32 numbuffers; + /* List of buffer pointers for storing frames */ + u8 *fbuffers[VIDEO_MAX_FRAME]; + /* Pointer pointing to current v4l2_buffer */ + struct videobuf_buffer *cur_frm; + /* Pointer pointing to next v4l2_buffer */ + struct videobuf_buffer *next_frm; + /* + * This field keeps track of type of buffer exchange mechanism + * user has selected + */ + enum v4l2_memory memory; + /* Used to store pixel format */ + struct v4l2_format fmt; + /* + * used when IMP is chained to store the crop window which + * is different from the image window + */ + struct v4l2_rect crop; + /* Buffer queue used in video-buf */ + struct videobuf_queue buffer_queue; + /* Queue of filled frames */ + struct list_head dma_queue; + /* Used in video-buf */ + spinlock_t irqlock; + /* IRQ lock for DMA queue */ + spinlock_t dma_queue_lock; + /* lock used to access this structure */ + struct mutex lock; + /* number of users performing IO */ + u32 io_usrs; + /* Indicates whether streaming started */ + u8 started; + /* + * offset where second field starts from the starting of the + * buffer for field seperated YCbCr formats + */ + u32 field_off; +}; + +/* File handle structure */ +struct vpfe_fh { + struct vpfe_device *vpfe_dev; + /* Indicates whether this file handle is doing IO */ + u8 io_allowed; + /* Used to keep track priority of this instance */ + enum v4l2_priority prio; +}; + +struct vpfe_config_params { + u8 min_numbuffers; + u8 numbuffers; + u32 min_bufsize; + u32 device_bufsize; +}; + +#endif /* End of __KERNEL__ */ +/** + * VPFE_CMD_S_CCDC_RAW_PARAMS - Driver private IOCTL to set raw capture params + * This ioctl is used to configure the ccdc module such as defect pixel + * correction, color space conversion, culling etc. in raw capture mode. + * TODO: This is to be split into multiple ioctls and also explore the + * possibility of extending the v4l2 api to include them + **/ +#define VPFE_CMD_S_CCDC_RAW_PARAMS _IOW('V', BASE_VIDIOC_PRIVATE + 1, \ + void *) +#endif /* _DAVINCI_VPFE_H */ diff --git a/include/media/davinci/vpfe_types.h b/include/media/davinci/vpfe_types.h new file mode 100644 index 0000000..76fb74b --- /dev/null +++ b/include/media/davinci/vpfe_types.h @@ -0,0 +1,51 @@ +/* + * Copyright (C) 2008-2009 Texas Instruments Inc + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option)any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ +#ifndef _VPFE_TYPES_H +#define _VPFE_TYPES_H + +#ifdef __KERNEL__ + +enum vpfe_pin_pol { + VPFE_PINPOL_POSITIVE, + VPFE_PINPOL_NEGATIVE +}; + +enum vpfe_hw_if_type { + /* BT656 - 8 bit */ + VPFE_BT656, + /* BT1120 - 16 bit */ + VPFE_BT1120, + /* Raw Bayer */ + VPFE_RAW_BAYER, + /* YCbCr - 8 bit with external sync */ + VPFE_YCBCR_SYNC_8, + /* YCbCr - 16 bit with external sync */ + VPFE_YCBCR_SYNC_16, + /* BT656 - 10 bit */ + VPFE_BT656_10BIT +}; + +/* interface description */ +struct vpfe_hw_if_param { + enum vpfe_hw_if_type if_type; + enum vpfe_pin_pol hdpol; + enum vpfe_pin_pol vdpol; +}; + +#endif +#endif