drivers/media/video/davinci/vpif_capture.c

   1 /*
   2  * Copyright (C) 2009 Texas Instruments Inc
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, write to the Free Software
  16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  17  *
  18  * TODO : add support for VBI & HBI data service
  19  *        add static buffer allocation
  20  */
  21 #include <linux/kernel.h>
  22 #include <linux/init.h>
  23 #include <linux/module.h>
  24 #include <linux/errno.h>
  25 #include <linux/fs.h>
  26 #include <linux/mm.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/workqueue.h>
  29 #include <linux/string.h>
  30 #include <linux/videodev2.h>
  31 #include <linux/wait.h>
  32 #include <linux/time.h>
  33 #include <linux/i2c.h>
  34 #include <linux/platform_device.h>
  35 #include <linux/io.h>
  36 #include <linux/version.h>
  37 #include <linux/slab.h>
  38 #include <media/v4l2-device.h>
  39 #include <media/v4l2-ioctl.h>
  40 #include <media/v4l2-chip-ident.h>
  41
  42 #include "vpif_capture.h"
  43 #include "vpif.h"
  44
  45 MODULE_DESCRIPTION("TI DaVinci VPIF Capture driver");
  46 MODULE_LICENSE("GPL");
  47
  48 #define vpif_err(fmt, arg...)   v4l2_err(&vpif_obj.v4l2_dev, fmt, ## arg)
  49 #define vpif_dbg(level, debug, fmt, arg...)     \
  50                 v4l2_dbg(level, debug, &vpif_obj.v4l2_dev, fmt, ## arg)
  51
  52 static int debug = 1;
  53 static u32 ch0_numbuffers = 3;
  54 static u32 ch1_numbuffers = 3;
  55 static u32 ch0_bufsize = 1920 * 1080 * 2;
  56 static u32 ch1_bufsize = 720 * 576 * 2;
  57
  58 module_param(debug, int, 0644);
  59 module_param(ch0_numbuffers, uint, S_IRUGO);
  60 module_param(ch1_numbuffers, uint, S_IRUGO);
  61 module_param(ch0_bufsize, uint, S_IRUGO);
  62 module_param(ch1_bufsize, uint, S_IRUGO);
  63
  64 MODULE_PARM_DESC(debug, "Debug level 0-1");
  65 MODULE_PARM_DESC(ch2_numbuffers, "Channel0 buffer count (default:3)");
  66 MODULE_PARM_DESC(ch3_numbuffers, "Channel1 buffer count (default:3)");
  67 MODULE_PARM_DESC(ch2_bufsize, "Channel0 buffer size (default:1920 x 1080 x 2)");
  68 MODULE_PARM_DESC(ch3_bufsize, "Channel1 buffer size (default:720 x 576 x 2)");
  69
  70 static struct vpif_config_params config_params = {
  71         .min_numbuffers = 3,
  72         .numbuffers[0] = 3,
  73         .numbuffers[1] = 3,
  74         .min_bufsize[0] = 720 * 480 * 2,
  75         .min_bufsize[1] = 720 * 480 * 2,
  76         .channel_bufsize[0] = 1920 * 1080 * 2,
  77         .channel_bufsize[1] = 720 * 576 * 2,
  78 };
  79
  80 /* global variables */
  81 static struct vpif_device vpif_obj = { {NULL} };
  82 static struct device *vpif_dev;
  83
  84 /**
  85  * vpif_uservirt_to_phys : translate user/virtual address to phy address
  86  * @virtp: user/virtual address
  87  *
  88  * This inline function is used to convert user space virtual address to
  89  * physical address.
  90  */
  91 static inline u32 vpif_uservirt_to_phys(u32 virtp)
  92 {
  93         unsigned long physp = 0;
  94         struct mm_struct *mm = current->mm;
  95         struct vm_area_struct *vma;
  96
  97         vma = find_vma(mm, virtp);
  98
  99         /* For kernel direct-mapped memory, take the easy way */
 100         if (virtp >= PAGE_OFFSET)
 101                 physp = virt_to_phys((void *)virtp);
 102         else if (vma && (vma->vm_flags & VM_IO) && (vma->vm_pgoff))
 103                 /**
 104                  * this will catch, kernel-allocated, mmaped-to-usermode
 105                  * addresses
 106                  */
 107                 physp = (vma->vm_pgoff << PAGE_SHIFT) + (virtp - vma->vm_start);
 108         else {
 109                 /* otherwise, use get_user_pages() for general userland pages */
 110                 int res, nr_pages = 1;
 111                         struct page *pages;
 112
 113                 down_read(&current->mm->mmap_sem);
 114
 115                 res = get_user_pages(current, current->mm,
 116                                      virtp, nr_pages, 1, 0, &pages, NULL);
 117                 up_read(&current->mm->mmap_sem);
 118
 119                 if (res == nr_pages)
 120                         physp = __pa(page_address(&pages[0]) +
 121                                      (virtp & ~PAGE_MASK));
 122                 else {
 123                         vpif_err("get_user_pages failed\n");
 124                         return 0;
 125                 }
 126         }
 127         return physp;
 128 }
 129
 130 /**
 131  * buffer_prepare :  callback function for buffer prepare
 132  * @q : buffer queue ptr
 133  * @vb: ptr to video buffer
 134  * @field: field info
 135  *
 136  * This is the callback function for buffer prepare when videobuf_qbuf()
 137  * function is called. The buffer is prepared and user space virtual address
 138  * or user address is converted into  physical address
 139  */
 140 static int vpif_buffer_prepare(struct videobuf_queue *q,
 141                                struct videobuf_buffer *vb,
 142                                enum v4l2_field field)
 143 {
 144         /* Get the file handle object and channel object */
 145         struct vpif_fh *fh = q->priv_data;
 146         struct channel_obj *ch = fh->channel;
 147         struct common_obj *common;
 148         unsigned long addr;
 149
 150
 151         vpif_dbg(2, debug, "vpif_buffer_prepare\n");
 152
 153         common = &ch->common[VPIF_VIDEO_INDEX];
 154
 155         /* If buffer is not initialized, initialize it */
 156         if (VIDEOBUF_NEEDS_INIT == vb->state) {
 157                 vb->width = common->width;
 158                 vb->height = common->height;
 159                 vb->size = vb->width * vb->height;
 160                 vb->field = field;
 161         }
 162         vb->state = VIDEOBUF_PREPARED;
 163         /**
 164          * if user pointer memory mechanism is used, get the physical
 165          * address of the buffer
 166          */
 167         if (V4L2_MEMORY_USERPTR == common->memory) {
 168                 if (0 == vb->baddr) {
 169                         vpif_dbg(1, debug, "buffer address is 0\n");
 170                         return -EINVAL;
 171
 172                 }
 173                 vb->boff = vpif_uservirt_to_phys(vb->baddr);
 174                 if (!IS_ALIGNED(vb->boff, 8))
 175                         goto exit;
 176         }
 177
 178         addr = vb->boff;
 179         if (q->streaming) {
 180                 if (!IS_ALIGNED((addr + common->ytop_off), 8) ||
 181                     !IS_ALIGNED((addr + common->ybtm_off), 8) ||
 182                     !IS_ALIGNED((addr + common->ctop_off), 8) ||
 183                     !IS_ALIGNED((addr + common->cbtm_off), 8))
 184                         goto exit;
 185         }
 186         return 0;
 187 exit:
 188         vpif_dbg(1, debug, "buffer_prepare:offset is not aligned to 8 bytes\n");
 189         return -EINVAL;
 190 }
 191
 192 /**
 193  * vpif_buffer_setup : Callback function for buffer setup.
 194  * @q: buffer queue ptr
 195  * @count: number of buffers
 196  * @size: size of the buffer
 197  *
 198  * This callback function is called when reqbuf() is called to adjust
 199  * the buffer count and buffer size
 200  */
 201 static int vpif_buffer_setup(struct videobuf_queue *q, unsigned int *count,
 202                              unsigned int *size)
 203 {
 204         /* Get the file handle object and channel object */
 205         struct vpif_fh *fh = q->priv_data;
 206         struct channel_obj *ch = fh->channel;
 207         struct common_obj *common;
 208
 209         common = &ch->common[VPIF_VIDEO_INDEX];
 210
 211         vpif_dbg(2, debug, "vpif_buffer_setup\n");
 212
 213         /* If memory type is not mmap, return */
 214         if (V4L2_MEMORY_MMAP != common->memory)
 215                 return 0;
 216
 217         /* Calculate the size of the buffer */
 218         *size = config_params.channel_bufsize[ch->channel_id];
 219
 220         if (*count < config_params.min_numbuffers)
 221                 *count = config_params.min_numbuffers;
 222         return 0;
 223 }
 224
 225 /**
 226  * vpif_buffer_queue : Callback function to add buffer to DMA queue
 227  * @q: ptr to videobuf_queue
 228  * @vb: ptr to videobuf_buffer
 229  */
 230 static void vpif_buffer_queue(struct videobuf_queue *q,
 231                               struct videobuf_buffer *vb)
 232 {
 233         /* Get the file handle object and channel object */
 234         struct vpif_fh *fh = q->priv_data;
 235         struct channel_obj *ch = fh->channel;
 236         struct common_obj *common;
 237
 238         common = &ch->common[VPIF_VIDEO_INDEX];
 239
 240         vpif_dbg(2, debug, "vpif_buffer_queue\n");
 241
 242         /* add the buffer to the DMA queue */
 243         list_add_tail(&vb->queue, &common->dma_queue);
 244         /* Change state of the buffer */
 245         vb->state = VIDEOBUF_QUEUED;
 246 }
 247
 248 /**
 249  * vpif_buffer_release : Callback function to free buffer
 250  * @q: buffer queue ptr
 251  * @vb: ptr to video buffer
 252  *
 253  * This function is called from the videobuf layer to free memory
 254  * allocated to  the buffers
 255  */
 256 static void vpif_buffer_release(struct videobuf_queue *q,
 257                                 struct videobuf_buffer *vb)
 258 {
 259         /* Get the file handle object and channel object */
 260         struct vpif_fh *fh = q->priv_data;
 261         struct channel_obj *ch = fh->channel;
 262         struct common_obj *common;
 263
 264         common = &ch->common[VPIF_VIDEO_INDEX];
 265
 266         videobuf_dma_contig_free(q, vb);
 267         vb->state = VIDEOBUF_NEEDS_INIT;
 268 }
 269
 270 static struct videobuf_queue_ops video_qops = {
 271         .buf_setup = vpif_buffer_setup,
 272         .buf_prepare = vpif_buffer_prepare,
 273         .buf_queue = vpif_buffer_queue,
 274         .buf_release = vpif_buffer_release,
 275 };
 276
 277 static u8 channel_first_int[VPIF_NUMBER_OF_OBJECTS][2] =
 278         { {1, 1} };
 279
 280 /**
 281  * vpif_process_buffer_complete: process a completed buffer
 282  * @common: ptr to common channel object
 283  *
 284  * This function time stamp the buffer and mark it as DONE. It also
 285  * wake up any process waiting on the QUEUE and set the next buffer
 286  * as current
 287  */
 288 static void vpif_process_buffer_complete(struct common_obj *common)
 289 {
 290         do_gettimeofday(&common->cur_frm->ts);
 291         common->cur_frm->state = VIDEOBUF_DONE;
 292         wake_up_interruptible(&common->cur_frm->done);
 293         /* Make curFrm pointing to nextFrm */
 294         common->cur_frm = common->next_frm;
 295 }
 296
 297 /**
 298  * vpif_schedule_next_buffer: set next buffer address for capture
 299  * @common : ptr to common channel object
 300  *
 301  * This function will get next buffer from the dma queue and
 302  * set the buffer address in the vpif register for capture.
 303  * the buffer is marked active
 304  */
 305 static void vpif_schedule_next_buffer(struct common_obj *common)
 306 {
 307         unsigned long addr = 0;
 308
 309         common->next_frm = list_entry(common->dma_queue.next,
 310                                      struct videobuf_buffer, queue);
 311         /* Remove that buffer from the buffer queue */
 312         list_del(&common->next_frm->queue);
 313         common->next_frm->state = VIDEOBUF_ACTIVE;
 314         if (V4L2_MEMORY_USERPTR == common->memory)
 315                 addr = common->next_frm->boff;
 316         else
 317                 addr = videobuf_to_dma_contig(common->next_frm);
 318
 319         /* Set top and bottom field addresses in VPIF registers */
 320         common->set_addr(addr + common->ytop_off,
 321                          addr + common->ybtm_off,
 322                          addr + common->ctop_off,
 323                          addr + common->cbtm_off);
 324 }
 325
 326 /**
 327  * vpif_channel_isr : ISR handler for vpif capture
 328  * @irq: irq number
 329  * @dev_id: dev_id ptr
 330  *
 331  * It changes status of the captured buffer, takes next buffer from the queue
 332  * and sets its address in VPIF registers
 333  */
 334 static irqreturn_t vpif_channel_isr(int irq, void *dev_id)
 335 {
 336         struct vpif_device *dev = &vpif_obj;
 337         struct common_obj *common;
 338         struct channel_obj *ch;
 339         enum v4l2_field field;
 340         int channel_id = 0;
 341         int fid = -1, i;
 342
 343         channel_id = *(int *)(dev_id);
 344         ch = dev->dev[channel_id];
 345
 346         field = ch->common[VPIF_VIDEO_INDEX].fmt.fmt.pix.field;
 347
 348         for (i = 0; i < VPIF_NUMBER_OF_OBJECTS; i++) {
 349                 common = &ch->common[i];
 350                 /* skip If streaming is not started in this channel */
 351                 if (0 == common->started)
 352                         continue;
 353
 354                 /* Check the field format */
 355                 if (1 == ch->vpifparams.std_info.frm_fmt) {
 356                         /* Progressive mode */
 357                         if (list_empty(&common->dma_queue))
 358                                 continue;
 359
 360                         if (!channel_first_int[i][channel_id])
 361                                 vpif_process_buffer_complete(common);
 362
 363                         channel_first_int[i][channel_id] = 0;
 364
 365                         vpif_schedule_next_buffer(common);
 366
 367
 368                         channel_first_int[i][channel_id] = 0;
 369                 } else {
 370                         /**
 371                          * Interlaced mode. If it is first interrupt, ignore
 372                          * it
 373                          */
 374                         if (channel_first_int[i][channel_id]) {
 375                                 channel_first_int[i][channel_id] = 0;
 376                                 continue;
 377                         }
 378                         if (0 == i) {
 379                                 ch->field_id ^= 1;
 380                                 /* Get field id from VPIF registers */
 381                                 fid = vpif_channel_getfid(ch->channel_id);
 382                                 if (fid != ch->field_id) {
 383                                         /**
 384                                          * If field id does not match stored
 385                                          * field id, make them in sync
 386                                          */
 387                                         if (0 == fid)
 388                                                 ch->field_id = fid;
 389                                         return IRQ_HANDLED;
 390                                 }
 391                         }
 392                         /* device field id and local field id are in sync */
 393                         if (0 == fid) {
 394                                 /* this is even field */
 395                                 if (common->cur_frm == common->next_frm)
 396                                         continue;
 397
 398                                 /* mark the current buffer as done */
 399                                 vpif_process_buffer_complete(common);
 400                         } else if (1 == fid) {
 401                                 /* odd field */
 402                                 if (list_empty(&common->dma_queue) ||
 403                                     (common->cur_frm != common->next_frm))
 404                                         continue;
 405
 406                                 vpif_schedule_next_buffer(common);
 407                         }
 408                 }
 409         }
 410         return IRQ_HANDLED;
 411 }
 412
 413 /**
 414  * vpif_update_std_info() - update standard related info
 415  * @ch: ptr to channel object
 416  *
 417  * For a given standard selected by application, update values
 418  * in the device data structures
 419  */
 420 static int vpif_update_std_info(struct channel_obj *ch)
 421 {
 422         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
 423         struct vpif_params *vpifparams = &ch->vpifparams;
 424         const struct vpif_channel_config_params *config;
 425         struct vpif_channel_config_params *std_info = &vpifparams->std_info;
 426         struct video_obj *vid_ch = &ch->video;
 427         int index;
 428
 429         vpif_dbg(2, debug, "vpif_update_std_info\n");
 430
 431         for (index = 0; index < vpif_ch_params_count; index++) {
 432                 config = &ch_params[index];
 433                 if (config->hd_sd == 0) {
 434                         vpif_dbg(2, debug, "SD format\n");
 435                         if (config->stdid & vid_ch->stdid) {
 436                                 memcpy(std_info, config, sizeof(*config));
 437                                 break;
 438                         }
 439                 } else {
 440                         vpif_dbg(2, debug, "HD format\n");
 441                         if (config->dv_preset == vid_ch->dv_preset) {
 442                                 memcpy(std_info, config, sizeof(*config));
 443                                 break;
 444                         }
 445                 }
 446         }
 447
 448         /* standard not found */
 449         if (index == vpif_ch_params_count)
 450                 return -EINVAL;
 451
 452         common->fmt.fmt.pix.width = std_info->width;
 453         common->width = std_info->width;
 454         common->fmt.fmt.pix.height = std_info->height;
 455         common->height = std_info->height;
 456         common->fmt.fmt.pix.bytesperline = std_info->width;
 457         vpifparams->video_params.hpitch = std_info->width;
 458         vpifparams->video_params.storage_mode = std_info->frm_fmt;
 459
 460         return 0;
 461 }
 462
 463 /**
 464  * vpif_calculate_offsets : This function calculates buffers offsets
 465  * @ch : ptr to channel object
 466  *
 467  * This function calculates buffer offsets for Y and C in the top and
 468  * bottom field
 469  */
 470 static void vpif_calculate_offsets(struct channel_obj *ch)
 471 {
 472         unsigned int hpitch, vpitch, sizeimage;
 473         struct video_obj *vid_ch = &(ch->video);
 474         struct vpif_params *vpifparams = &ch->vpifparams;
 475         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
 476         enum v4l2_field field = common->fmt.fmt.pix.field;
 477
 478         vpif_dbg(2, debug, "vpif_calculate_offsets\n");
 479
 480         if (V4L2_FIELD_ANY == field) {
 481                 if (vpifparams->std_info.frm_fmt)
 482                         vid_ch->buf_field = V4L2_FIELD_NONE;
 483                 else
 484                         vid_ch->buf_field = V4L2_FIELD_INTERLACED;
 485         } else
 486                 vid_ch->buf_field = common->fmt.fmt.pix.field;
 487
 488         if (V4L2_MEMORY_USERPTR == common->memory)
 489                 sizeimage = common->fmt.fmt.pix.sizeimage;
 490         else
 491                 sizeimage = config_params.channel_bufsize[ch->channel_id];
 492
 493         hpitch = common->fmt.fmt.pix.bytesperline;
 494         vpitch = sizeimage / (hpitch * 2);
 495
 496         if ((V4L2_FIELD_NONE == vid_ch->buf_field) ||
 497             (V4L2_FIELD_INTERLACED == vid_ch->buf_field)) {
 498                 /* Calculate offsets for Y top, Y Bottom, C top and C Bottom */
 499                 common->ytop_off = 0;
 500                 common->ybtm_off = hpitch;
 501                 common->ctop_off = sizeimage / 2;
 502                 common->cbtm_off = sizeimage / 2 + hpitch;
 503         } else if (V4L2_FIELD_SEQ_TB == vid_ch->buf_field) {
 504                 /* Calculate offsets for Y top, Y Bottom, C top and C Bottom */
 505                 common->ytop_off = 0;
 506                 common->ybtm_off = sizeimage / 4;
 507                 common->ctop_off = sizeimage / 2;
 508                 common->cbtm_off = common->ctop_off + sizeimage / 4;
 509         } else if (V4L2_FIELD_SEQ_BT == vid_ch->buf_field) {
 510                 /* Calculate offsets for Y top, Y Bottom, C top and C Bottom */
 511                 common->ybtm_off = 0;
 512                 common->ytop_off = sizeimage / 4;
 513                 common->cbtm_off = sizeimage / 2;
 514                 common->ctop_off = common->cbtm_off + sizeimage / 4;
 515         }
 516         if ((V4L2_FIELD_NONE == vid_ch->buf_field) ||
 517             (V4L2_FIELD_INTERLACED == vid_ch->buf_field))
 518                 vpifparams->video_params.storage_mode = 1;
 519         else
 520                 vpifparams->video_params.storage_mode = 0;
 521
 522         if (1 == vpifparams->std_info.frm_fmt)
 523                 vpifparams->video_params.hpitch =
 524                     common->fmt.fmt.pix.bytesperline;
 525         else {
 526                 if ((field == V4L2_FIELD_ANY)
 527                     || (field == V4L2_FIELD_INTERLACED))
 528                         vpifparams->video_params.hpitch =
 529                             common->fmt.fmt.pix.bytesperline * 2;
 530                 else
 531                         vpifparams->video_params.hpitch =
 532                             common->fmt.fmt.pix.bytesperline;
 533         }
 534
 535         ch->vpifparams.video_params.stdid = vpifparams->std_info.stdid;
 536 }
 537
 538 /**
 539  * vpif_config_format: configure default frame format in the device
 540  * ch : ptr to channel object
 541  */
 542 static void vpif_config_format(struct channel_obj *ch)
 543 {
 544         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
 545
 546         vpif_dbg(2, debug, "vpif_config_format\n");
 547
 548         common->fmt.fmt.pix.field = V4L2_FIELD_ANY;
 549         if (config_params.numbuffers[ch->channel_id] == 0)
 550                 common->memory = V4L2_MEMORY_USERPTR;
 551         else
 552                 common->memory = V4L2_MEMORY_MMAP;
 553
 554         common->fmt.fmt.pix.sizeimage
 555             = config_params.channel_bufsize[ch->channel_id];
 556
 557         if (ch->vpifparams.iface.if_type == VPIF_IF_RAW_BAYER)
 558                 common->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_SBGGR8;
 559         else
 560                 common->fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUV422P;
 561         common->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 562 }
 563
 564 /**
 565  * vpif_get_default_field() - Get default field type based on interface
 566  * @vpif_params - ptr to vpif params
 567  */
 568 static inline enum v4l2_field vpif_get_default_field(
 569                                 struct vpif_interface *iface)
 570 {
 571         return (iface->if_type == VPIF_IF_RAW_BAYER) ? V4L2_FIELD_NONE :
 572                                                 V4L2_FIELD_INTERLACED;
 573 }
 574
 575 /**
 576  * vpif_check_format()  - check given pixel format for compatibility
 577  * @ch - channel  ptr
 578  * @pixfmt - Given pixel format
 579  * @update - update the values as per hardware requirement
 580  *
 581  * Check the application pixel format for S_FMT and update the input
 582  * values as per hardware limits for TRY_FMT. The default pixel and
 583  * field format is selected based on interface type.
 584  */
 585 static int vpif_check_format(struct channel_obj *ch,
 586                              struct v4l2_pix_format *pixfmt,
 587                              int update)
 588 {
 589         struct common_obj *common = &(ch->common[VPIF_VIDEO_INDEX]);
 590         struct vpif_params *vpif_params = &ch->vpifparams;
 591         enum v4l2_field field = pixfmt->field;
 592         u32 sizeimage, hpitch, vpitch;
 593         int ret = -EINVAL;
 594
 595         vpif_dbg(2, debug, "vpif_check_format\n");
 596         /**
 597          * first check for the pixel format. If if_type is Raw bayer,
 598          * only V4L2_PIX_FMT_SBGGR8 format is supported. Otherwise only
 599          * V4L2_PIX_FMT_YUV422P is supported
 600          */
 601         if (vpif_params->iface.if_type == VPIF_IF_RAW_BAYER) {
 602                 if (pixfmt->pixelformat != V4L2_PIX_FMT_SBGGR8) {
 603                         if (!update) {
 604                                 vpif_dbg(2, debug, "invalid pix format\n");
 605                                 goto exit;
 606                         }
 607                         pixfmt->pixelformat = V4L2_PIX_FMT_SBGGR8;
 608                 }
 609         } else {
 610                 if (pixfmt->pixelformat != V4L2_PIX_FMT_YUV422P) {
 611                         if (!update) {
 612                                 vpif_dbg(2, debug, "invalid pixel format\n");
 613                                 goto exit;
 614                         }
 615                         pixfmt->pixelformat = V4L2_PIX_FMT_YUV422P;
 616                 }
 617         }
 618
 619         if (!(VPIF_VALID_FIELD(field))) {
 620                 if (!update) {
 621                         vpif_dbg(2, debug, "invalid field format\n");
 622                         goto exit;
 623                 }
 624                 /**
 625                  * By default use FIELD_NONE for RAW Bayer capture
 626                  * and FIELD_INTERLACED for other interfaces
 627                  */
 628                 field = vpif_get_default_field(&vpif_params->iface);
 629         } else if (field == V4L2_FIELD_ANY)
 630                 /* unsupported field. Use default */
 631                 field = vpif_get_default_field(&vpif_params->iface);
 632
 633         /* validate the hpitch */
 634         hpitch = pixfmt->bytesperline;
 635         if (hpitch < vpif_params->std_info.width) {
 636                 if (!update) {
 637                         vpif_dbg(2, debug, "invalid hpitch\n");
 638                         goto exit;
 639                 }
 640                 hpitch = vpif_params->std_info.width;
 641         }
 642
 643         if (V4L2_MEMORY_USERPTR == common->memory)
 644                 sizeimage = pixfmt->sizeimage;
 645         else
 646                 sizeimage = config_params.channel_bufsize[ch->channel_id];
 647
 648         vpitch = sizeimage / (hpitch * 2);
 649
 650         /* validate the vpitch */
 651         if (vpitch < vpif_params->std_info.height) {
 652                 if (!update) {
 653                         vpif_dbg(2, debug, "Invalid vpitch\n");
 654                         goto exit;
 655                 }
 656                 vpitch = vpif_params->std_info.height;
 657         }
 658
 659         /* Check for 8 byte alignment */
 660         if (!ALIGN(hpitch, 8)) {
 661                 if (!update) {
 662                         vpif_dbg(2, debug, "invalid pitch alignment\n");
 663                         goto exit;
 664                 }
 665                 /* adjust to next 8 byte boundary */
 666                 hpitch = (((hpitch + 7) / 8) * 8);
 667         }
 668         /* if update is set, modify the bytesperline and sizeimage */
 669         if (update) {
 670                 pixfmt->bytesperline = hpitch;
 671                 pixfmt->sizeimage = hpitch * vpitch * 2;
 672         }
 673         /**
 674          * Image width and height is always based on current standard width and
 675          * height
 676          */
 677         pixfmt->width = common->fmt.fmt.pix.width;
 678         pixfmt->height = common->fmt.fmt.pix.height;
 679         return 0;
 680 exit:
 681         return ret;
 682 }
 683
 684 /**
 685  * vpif_config_addr() - function to configure buffer address in vpif
 686  * @ch - channel ptr
 687  * @muxmode - channel mux mode
 688  */
 689 static void vpif_config_addr(struct channel_obj *ch, int muxmode)
 690 {
 691         struct common_obj *common;
 692
 693         vpif_dbg(2, debug, "vpif_config_addr\n");
 694
 695         common = &(ch->common[VPIF_VIDEO_INDEX]);
 696
 697         if (VPIF_CHANNEL1_VIDEO == ch->channel_id)
 698                 common->set_addr = ch1_set_videobuf_addr;
 699         else if (2 == muxmode)
 700                 common->set_addr = ch0_set_videobuf_addr_yc_nmux;
 701         else
 702                 common->set_addr = ch0_set_videobuf_addr;
 703 }
 704
 705 /**
 706  * vpfe_mmap : It is used to map kernel space buffers into user spaces
 707  * @filep: file pointer
 708  * @vma: ptr to vm_area_struct
 709  */
 710 static int vpif_mmap(struct file *filep, struct vm_area_struct *vma)
 711 {
 712         /* Get the channel object and file handle object */
 713         struct vpif_fh *fh = filep->private_data;
 714         struct channel_obj *ch = fh->channel;
 715         struct common_obj *common = &(ch->common[VPIF_VIDEO_INDEX]);
 716
 717         vpif_dbg(2, debug, "vpif_mmap\n");
 718
 719         return videobuf_mmap_mapper(&common->buffer_queue, vma);
 720 }
 721
 722 /**
 723  * vpif_poll: It is used for select/poll system call
 724  * @filep: file pointer
 725  * @wait: poll table to wait
 726  */
 727 static unsigned int vpif_poll(struct file *filep, poll_table * wait)
 728 {
 729         struct vpif_fh *fh = filep->private_data;
 730         struct channel_obj *channel = fh->channel;
 731         struct common_obj *common = &(channel->common[VPIF_VIDEO_INDEX]);
 732
 733         vpif_dbg(2, debug, "vpif_poll\n");
 734
 735         if (common->started)
 736                 return videobuf_poll_stream(filep, &common->buffer_queue, wait);
 737         return 0;
 738 }
 739
 740 /**
 741  * vpif_open : vpif open handler
 742  * @filep: file ptr
 743  *
 744  * It creates object of file handle structure and stores it in private_data
 745  * member of filepointer
 746  */
 747 static int vpif_open(struct file *filep)
 748 {
 749         struct vpif_capture_config *config = vpif_dev->platform_data;
 750         struct video_device *vdev = video_devdata(filep);
 751         struct common_obj *common;
 752         struct video_obj *vid_ch;
 753         struct channel_obj *ch;
 754         struct vpif_fh *fh;
 755         int i;
 756
 757         vpif_dbg(2, debug, "vpif_open\n");
 758
 759         ch = video_get_drvdata(vdev);
 760
 761         vid_ch = &ch->video;
 762         common = &ch->common[VPIF_VIDEO_INDEX];
 763
 764         if (NULL == ch->curr_subdev_info) {
 765                 /**
 766                  * search through the sub device to see a registered
 767                  * sub device and make it as current sub device
 768                  */
 769                 for (i = 0; i < config->subdev_count; i++) {
 770                         if (vpif_obj.sd[i]) {
 771                                 /* the sub device is registered */
 772                                 ch->curr_subdev_info = &config->subdev_info[i];
 773                                 /* make first input as the current input */
 774                                 vid_ch->input_idx = 0;
 775                                 break;
 776                         }
 777                 }
 778                 if (i == config->subdev_count) {
 779                         vpif_err("No sub device registered\n");
 780                         return -ENOENT;
 781                 }
 782         }
 783
 784         /* Allocate memory for the file handle object */
 785         fh = kzalloc(sizeof(struct vpif_fh), GFP_KERNEL);
 786         if (NULL == fh) {
 787                 vpif_err("unable to allocate memory for file handle object\n");
 788                 return -ENOMEM;
 789         }
 790
 791         /* store pointer to fh in private_data member of filep */
 792         filep->private_data = fh;
 793         fh->channel = ch;
 794         fh->initialized = 0;
 795         /* If decoder is not initialized. initialize it */
 796         if (!ch->initialized) {
 797                 fh->initialized = 1;
 798                 ch->initialized = 1;
 799                 memset(&(ch->vpifparams), 0, sizeof(struct vpif_params));
 800         }
 801         /* Increment channel usrs counter */
 802         ch->usrs++;
 803         /* Set io_allowed member to false */
 804         fh->io_allowed[VPIF_VIDEO_INDEX] = 0;
 805         /* Initialize priority of this instance to default priority */
 806         fh->prio = V4L2_PRIORITY_UNSET;
 807         v4l2_prio_open(&ch->prio, &fh->prio);
 808         return 0;
 809 }
 810
 811 /**
 812  * vpif_release : function to clean up file close
 813  * @filep: file pointer
 814  *
 815  * This function deletes buffer queue, frees the buffers and the vpfe file
 816  * handle
 817  */
 818 static int vpif_release(struct file *filep)
 819 {
 820         struct vpif_fh *fh = filep->private_data;
 821         struct channel_obj *ch = fh->channel;
 822         struct common_obj *common;
 823
 824         vpif_dbg(2, debug, "vpif_release\n");
 825
 826         common = &ch->common[VPIF_VIDEO_INDEX];
 827
 828         /* if this instance is doing IO */
 829         if (fh->io_allowed[VPIF_VIDEO_INDEX]) {
 830                 /* Reset io_usrs member of channel object */
 831                 common->io_usrs = 0;
 832                 /* Disable channel as per its device type and channel id */
 833                 if (VPIF_CHANNEL0_VIDEO == ch->channel_id) {
 834                         enable_channel0(0);
 835                         channel0_intr_enable(0);
 836                 }
 837                 if ((VPIF_CHANNEL1_VIDEO == ch->channel_id) ||
 838                     (2 == common->started)) {
 839                         enable_channel1(0);
 840                         channel1_intr_enable(0);
 841                 }
 842                 common->started = 0;
 843                 /* Free buffers allocated */
 844                 videobuf_queue_cancel(&common->buffer_queue);
 845                 videobuf_mmap_free(&common->buffer_queue);
 846         }
 847
 848         /* Decrement channel usrs counter */
 849         ch->usrs--;
 850
 851         /* Close the priority */
 852         v4l2_prio_close(&ch->prio, fh->prio);
 853
 854         if (fh->initialized)
 855                 ch->initialized = 0;
 856
 857         filep->private_data = NULL;
 858         kfree(fh);
 859         return 0;
 860 }
 861
 862 /**
 863  * vpif_reqbufs() - request buffer handler
 864  * @file: file ptr
 865  * @priv: file handle
 866  * @reqbuf: request buffer structure ptr
 867  */
 868 static int vpif_reqbufs(struct file *file, void *priv,
 869                         struct v4l2_requestbuffers *reqbuf)
 870 {
 871         struct vpif_fh *fh = priv;
 872         struct channel_obj *ch = fh->channel;
 873         struct common_obj *common;
 874         u8 index = 0;
 875
 876         vpif_dbg(2, debug, "vpif_reqbufs\n");
 877
 878         /**
 879          * This file handle has not initialized the channel,
 880          * It is not allowed to do settings
 881          */
 882         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id)
 883             || (VPIF_CHANNEL1_VIDEO == ch->channel_id)) {
 884                 if (!fh->initialized) {
 885                         vpif_dbg(1, debug, "Channel Busy\n");
 886                         return -EBUSY;
 887                 }
 888         }
 889
 890         if (V4L2_BUF_TYPE_VIDEO_CAPTURE != reqbuf->type)
 891                 return -EINVAL;
 892
 893         index = VPIF_VIDEO_INDEX;
 894
 895         common = &ch->common[index];
 896
 897         if (0 != common->io_usrs)
 898                 return -EBUSY;
 899
 900         /* Initialize videobuf queue as per the buffer type */
 901         videobuf_queue_dma_contig_init(&common->buffer_queue,
 902                                             &video_qops, NULL,
 903                                             &common->irqlock,
 904                                             reqbuf->type,
 905                                             common->fmt.fmt.pix.field,
 906                                             sizeof(struct videobuf_buffer), fh,
 907                                             &common->lock);
 908
 909         /* Set io allowed member of file handle to TRUE */
 910         fh->io_allowed[index] = 1;
 911         /* Increment io usrs member of channel object to 1 */
 912         common->io_usrs = 1;
 913         /* Store type of memory requested in channel object */
 914         common->memory = reqbuf->memory;
 915         INIT_LIST_HEAD(&common->dma_queue);
 916
 917         /* Allocate buffers */
 918         return videobuf_reqbufs(&common->buffer_queue, reqbuf);
 919 }
 920
 921 /**
 922  * vpif_querybuf() - query buffer handler
 923  * @file: file ptr
 924  * @priv: file handle
 925  * @buf: v4l2 buffer structure ptr
 926  */
 927 static int vpif_querybuf(struct file *file, void *priv,
 928                                 struct v4l2_buffer *buf)
 929 {
 930         struct vpif_fh *fh = priv;
 931         struct channel_obj *ch = fh->channel;
 932         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
 933
 934         vpif_dbg(2, debug, "vpif_querybuf\n");
 935
 936         if (common->fmt.type != buf->type)
 937                 return -EINVAL;
 938
 939         if (common->memory != V4L2_MEMORY_MMAP) {
 940                 vpif_dbg(1, debug, "Invalid memory\n");
 941                 return -EINVAL;
 942         }
 943
 944         return videobuf_querybuf(&common->buffer_queue, buf);
 945 }
 946
 947 /**
 948  * vpif_qbuf() - query buffer handler
 949  * @file: file ptr
 950  * @priv: file handle
 951  * @buf: v4l2 buffer structure ptr
 952  */
 953 static int vpif_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
 954 {
 955
 956         struct vpif_fh *fh = priv;
 957         struct channel_obj *ch = fh->channel;
 958         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
 959         struct v4l2_buffer tbuf = *buf;
 960         struct videobuf_buffer *buf1;
 961         unsigned long addr = 0;
 962         unsigned long flags;
 963         int ret = 0;
 964
 965         vpif_dbg(2, debug, "vpif_qbuf\n");
 966
 967         if (common->fmt.type != tbuf.type) {
 968                 vpif_err("invalid buffer type\n");
 969                 return -EINVAL;
 970         }
 971
 972         if (!fh->io_allowed[VPIF_VIDEO_INDEX]) {
 973                 vpif_err("fh io not allowed \n");
 974                 return -EACCES;
 975         }
 976
 977         if (!(list_empty(&common->dma_queue)) ||
 978             (common->cur_frm != common->next_frm) ||
 979             !common->started ||
 980             (common->started && (0 == ch->field_id)))
 981                 return videobuf_qbuf(&common->buffer_queue, buf);
 982
 983         /* bufferqueue is empty store buffer address in VPIF registers */
 984         mutex_lock(&common->buffer_queue.vb_lock);
 985         buf1 = common->buffer_queue.bufs[tbuf.index];
 986
 987         if ((buf1->state == VIDEOBUF_QUEUED) ||
 988             (buf1->state == VIDEOBUF_ACTIVE)) {
 989                 vpif_err("invalid state\n");
 990                 goto qbuf_exit;
 991         }
 992
 993         switch (buf1->memory) {
 994         case V4L2_MEMORY_MMAP:
 995                 if (buf1->baddr == 0)
 996                         goto qbuf_exit;
 997                 break;
 998
 999         case V4L2_MEMORY_USERPTR:
1000                 if (tbuf.length < buf1->bsize)
1001                         goto qbuf_exit;
1002
1003                 if ((VIDEOBUF_NEEDS_INIT != buf1->state)
1004                             && (buf1->baddr != tbuf.m.userptr)) {
1005                         vpif_buffer_release(&common->buffer_queue, buf1);
1006                         buf1->baddr = tbuf.m.userptr;
1007                 }
1008                 break;
1009
1010         default:
1011                 goto qbuf_exit;
1012         }
1013
1014         local_irq_save(flags);
1015         ret = vpif_buffer_prepare(&common->buffer_queue, buf1,
1016                                         common->buffer_queue.field);
1017         if (ret < 0) {
1018                 local_irq_restore(flags);
1019                 goto qbuf_exit;
1020         }
1021
1022         buf1->state = VIDEOBUF_ACTIVE;
1023
1024         if (V4L2_MEMORY_USERPTR == common->memory)
1025                 addr = buf1->boff;
1026         else
1027                 addr = videobuf_to_dma_contig(buf1);
1028
1029         common->next_frm = buf1;
1030         common->set_addr(addr + common->ytop_off,
1031                          addr + common->ybtm_off,
1032                          addr + common->ctop_off,
1033                          addr + common->cbtm_off);
1034
1035         local_irq_restore(flags);
1036         list_add_tail(&buf1->stream, &common->buffer_queue.stream);
1037         mutex_unlock(&common->buffer_queue.vb_lock);
1038         return 0;
1039
1040 qbuf_exit:
1041         mutex_unlock(&common->buffer_queue.vb_lock);
1042         return -EINVAL;
1043 }
1044
1045 /**
1046  * vpif_dqbuf() - query buffer handler
1047  * @file: file ptr
1048  * @priv: file handle
1049  * @buf: v4l2 buffer structure ptr
1050  */
1051 static int vpif_dqbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
1052 {
1053         struct vpif_fh *fh = priv;
1054         struct channel_obj *ch = fh->channel;
1055         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1056
1057         vpif_dbg(2, debug, "vpif_dqbuf\n");
1058
1059         return videobuf_dqbuf(&common->buffer_queue, buf,
1060                                         file->f_flags & O_NONBLOCK);
1061 }
1062
1063 /**
1064  * vpif_streamon() - streamon handler
1065  * @file: file ptr
1066  * @priv: file handle
1067  * @buftype: v4l2 buffer type
1068  */
1069 static int vpif_streamon(struct file *file, void *priv,
1070                                 enum v4l2_buf_type buftype)
1071 {
1072
1073         struct vpif_capture_config *config = vpif_dev->platform_data;
1074         struct vpif_fh *fh = priv;
1075         struct channel_obj *ch = fh->channel;
1076         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1077         struct channel_obj *oth_ch = vpif_obj.dev[!ch->channel_id];
1078         struct vpif_params *vpif;
1079         unsigned long addr = 0;
1080         int ret = 0;
1081
1082         vpif_dbg(2, debug, "vpif_streamon\n");
1083
1084         vpif = &ch->vpifparams;
1085
1086         if (buftype != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
1087                 vpif_dbg(1, debug, "buffer type not supported\n");
1088                 return -EINVAL;
1089         }
1090
1091         /* If file handle is not allowed IO, return error */
1092         if (!fh->io_allowed[VPIF_VIDEO_INDEX]) {
1093                 vpif_dbg(1, debug, "io not allowed\n");
1094                 return -EACCES;
1095         }
1096
1097         /* If Streaming is already started, return error */
1098         if (common->started) {
1099                 vpif_dbg(1, debug, "channel->started\n");
1100                 return -EBUSY;
1101         }
1102
1103         if ((ch->channel_id == VPIF_CHANNEL0_VIDEO &&
1104             oth_ch->common[VPIF_VIDEO_INDEX].started &&
1105             vpif->std_info.ycmux_mode == 0) ||
1106            ((ch->channel_id == VPIF_CHANNEL1_VIDEO) &&
1107             (2 == oth_ch->common[VPIF_VIDEO_INDEX].started))) {
1108                 vpif_dbg(1, debug, "other channel is being used\n");
1109                 return -EBUSY;
1110         }
1111
1112         ret = vpif_check_format(ch, &common->fmt.fmt.pix, 0);
1113         if (ret)
1114                 return ret;
1115
1116         /* Enable streamon on the sub device */
1117         ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], video,
1118                                 s_stream, 1);
1119
1120         if (ret && (ret != -ENOIOCTLCMD)) {
1121                 vpif_dbg(1, debug, "stream on failed in subdev\n");
1122                 return ret;
1123         }
1124
1125         /* Call videobuf_streamon to start streaming in videobuf */
1126         ret = videobuf_streamon(&common->buffer_queue);
1127         if (ret) {
1128                 vpif_dbg(1, debug, "videobuf_streamon\n");
1129                 return ret;
1130         }
1131
1132         /* If buffer queue is empty, return error */
1133         if (list_empty(&common->dma_queue)) {
1134                 vpif_dbg(1, debug, "buffer queue is empty\n");
1135                 ret = -EIO;
1136                 goto exit;
1137         }
1138
1139         /* Get the next frame from the buffer queue */
1140         common->cur_frm = list_entry(common->dma_queue.next,
1141                                     struct videobuf_buffer, queue);
1142         common->next_frm = common->cur_frm;
1143
1144         /* Remove buffer from the buffer queue */
1145         list_del(&common->cur_frm->queue);
1146         /* Mark state of the current frame to active */
1147         common->cur_frm->state = VIDEOBUF_ACTIVE;
1148         /* Initialize field_id and started member */
1149         ch->field_id = 0;
1150         common->started = 1;
1151
1152         if (V4L2_MEMORY_USERPTR == common->memory)
1153                 addr = common->cur_frm->boff;
1154         else
1155                 addr = videobuf_to_dma_contig(common->cur_frm);
1156
1157         /* Calculate the offset for Y and C data in the buffer */
1158         vpif_calculate_offsets(ch);
1159
1160         if ((vpif->std_info.frm_fmt &&
1161             ((common->fmt.fmt.pix.field != V4L2_FIELD_NONE) &&
1162              (common->fmt.fmt.pix.field != V4L2_FIELD_ANY))) ||
1163             (!vpif->std_info.frm_fmt &&
1164              (common->fmt.fmt.pix.field == V4L2_FIELD_NONE))) {
1165                 vpif_dbg(1, debug, "conflict in field format and std format\n");
1166                 ret = -EINVAL;
1167                 goto exit;
1168         }
1169
1170         /* configure 1 or 2 channel mode */
1171         ret = config->setup_input_channel_mode(vpif->std_info.ycmux_mode);
1172
1173         if (ret < 0) {
1174                 vpif_dbg(1, debug, "can't set vpif channel mode\n");
1175                 goto exit;
1176         }
1177
1178         /* Call vpif_set_params function to set the parameters and addresses */
1179         ret = vpif_set_video_params(vpif, ch->channel_id);
1180
1181         if (ret < 0) {
1182                 vpif_dbg(1, debug, "can't set video params\n");
1183                 goto exit;
1184         }
1185
1186         common->started = ret;
1187         vpif_config_addr(ch, ret);
1188
1189         common->set_addr(addr + common->ytop_off,
1190                          addr + common->ybtm_off,
1191                          addr + common->ctop_off,
1192                          addr + common->cbtm_off);
1193
1194         /**
1195          * Set interrupt for both the fields in VPIF Register enable channel in
1196          * VPIF register
1197          */
1198         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id)) {
1199                 channel0_intr_assert();
1200                 channel0_intr_enable(1);
1201                 enable_channel0(1);
1202         }
1203         if ((VPIF_CHANNEL1_VIDEO == ch->channel_id) ||
1204             (common->started == 2)) {
1205                 channel1_intr_assert();
1206                 channel1_intr_enable(1);
1207                 enable_channel1(1);
1208         }
1209         channel_first_int[VPIF_VIDEO_INDEX][ch->channel_id] = 1;
1210         return ret;
1211
1212 exit:
1213         videobuf_streamoff(&common->buffer_queue);
1214         return ret;
1215 }
1216
1217 /**
1218  * vpif_streamoff() - streamoff handler
1219  * @file: file ptr
1220  * @priv: file handle
1221  * @buftype: v4l2 buffer type
1222  */
1223 static int vpif_streamoff(struct file *file, void *priv,
1224                                 enum v4l2_buf_type buftype)
1225 {
1226
1227         struct vpif_fh *fh = priv;
1228         struct channel_obj *ch = fh->channel;
1229         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1230         int ret;
1231
1232         vpif_dbg(2, debug, "vpif_streamoff\n");
1233
1234         if (buftype != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
1235                 vpif_dbg(1, debug, "buffer type not supported\n");
1236                 return -EINVAL;
1237         }
1238
1239         /* If io is allowed for this file handle, return error */
1240         if (!fh->io_allowed[VPIF_VIDEO_INDEX]) {
1241                 vpif_dbg(1, debug, "io not allowed\n");
1242                 return -EACCES;
1243         }
1244
1245         /* If streaming is not started, return error */
1246         if (!common->started) {
1247                 vpif_dbg(1, debug, "channel->started\n");
1248                 return -EINVAL;
1249         }
1250
1251         /* disable channel */
1252         if (VPIF_CHANNEL0_VIDEO == ch->channel_id) {
1253                 enable_channel0(0);
1254                 channel0_intr_enable(0);
1255         } else {
1256                 enable_channel1(0);
1257                 channel1_intr_enable(0);
1258         }
1259
1260         common->started = 0;
1261
1262         ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], video,
1263                                 s_stream, 0);
1264
1265         if (ret && (ret != -ENOIOCTLCMD))
1266                 vpif_dbg(1, debug, "stream off failed in subdev\n");
1267
1268         return videobuf_streamoff(&common->buffer_queue);
1269 }
1270
1271 /**
1272  * vpif_map_sub_device_to_input() - Maps sub device to input
1273  * @ch - ptr to channel
1274  * @config - ptr to capture configuration
1275  * @input_index - Given input index from application
1276  * @sub_device_index - index into sd table
1277  *
1278  * lookup the sub device information for a given input index.
1279  * we report all the inputs to application. inputs table also
1280  * has sub device name for the each input
1281  */
1282 static struct vpif_subdev_info *vpif_map_sub_device_to_input(
1283                                 struct channel_obj *ch,
1284                                 struct vpif_capture_config *vpif_cfg,
1285                                 int input_index,
1286                                 int *sub_device_index)
1287 {
1288         struct vpif_capture_chan_config *chan_cfg;
1289         struct vpif_subdev_info *subdev_info = NULL;
1290         const char *subdev_name = NULL;
1291         int i;
1292
1293         vpif_dbg(2, debug, "vpif_map_sub_device_to_input\n");
1294
1295         chan_cfg = &vpif_cfg->chan_config[ch->channel_id];
1296
1297         /**
1298          * search through the inputs to find the sub device supporting
1299          * the input
1300          */
1301         for (i = 0; i < chan_cfg->input_count; i++) {
1302                 /* For each sub device, loop through input */
1303                 if (i == input_index) {
1304                         subdev_name = chan_cfg->inputs[i].subdev_name;
1305                         break;
1306                 }
1307         }
1308
1309         /* if reached maximum. return null */
1310         if (i == chan_cfg->input_count || (NULL == subdev_name))
1311                 return subdev_info;
1312
1313         /* loop through the sub device list to get the sub device info */
1314         for (i = 0; i < vpif_cfg->subdev_count; i++) {
1315                 subdev_info = &vpif_cfg->subdev_info[i];
1316                 if (!strcmp(subdev_info->name, subdev_name))
1317                         break;
1318         }
1319
1320         if (i == vpif_cfg->subdev_count)
1321                 return subdev_info;
1322
1323         /* check if the sub device is registered */
1324         if (NULL == vpif_obj.sd[i])
1325                 return NULL;
1326
1327         *sub_device_index = i;
1328         return subdev_info;
1329 }
1330
1331 /**
1332  * vpif_querystd() - querystd handler
1333  * @file: file ptr
1334  * @priv: file handle
1335  * @std_id: ptr to std id
1336  *
1337  * This function is called to detect standard at the selected input
1338  */
1339 static int vpif_querystd(struct file *file, void *priv, v4l2_std_id *std_id)
1340 {
1341         struct vpif_fh *fh = priv;
1342         struct channel_obj *ch = fh->channel;
1343         int ret = 0;
1344
1345         vpif_dbg(2, debug, "vpif_querystd\n");
1346
1347         /* Call querystd function of decoder device */
1348         ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], video,
1349                                 querystd, std_id);
1350         if (ret < 0)
1351                 vpif_dbg(1, debug, "Failed to set standard for sub devices\n");
1352
1353         return ret;
1354 }
1355
1356 /**
1357  * vpif_g_std() - get STD handler
1358  * @file: file ptr
1359  * @priv: file handle
1360  * @std_id: ptr to std id
1361  */
1362 static int vpif_g_std(struct file *file, void *priv, v4l2_std_id *std)
1363 {
1364         struct vpif_fh *fh = priv;
1365         struct channel_obj *ch = fh->channel;
1366
1367         vpif_dbg(2, debug, "vpif_g_std\n");
1368
1369         *std = ch->video.stdid;
1370         return 0;
1371 }
1372
1373 /**
1374  * vpif_s_std() - set STD handler
1375  * @file: file ptr
1376  * @priv: file handle
1377  * @std_id: ptr to std id
1378  */
1379 static int vpif_s_std(struct file *file, void *priv, v4l2_std_id *std_id)
1380 {
1381         struct vpif_fh *fh = priv;
1382         struct channel_obj *ch = fh->channel;
1383         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1384         int ret = 0;
1385
1386         vpif_dbg(2, debug, "vpif_s_std\n");
1387
1388         if (common->started) {
1389                 vpif_err("streaming in progress\n");
1390                 return -EBUSY;
1391         }
1392
1393         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id) ||
1394             (VPIF_CHANNEL1_VIDEO == ch->channel_id)) {
1395                 if (!fh->initialized) {
1396                         vpif_dbg(1, debug, "Channel Busy\n");
1397                         return -EBUSY;
1398                 }
1399         }
1400
1401         ret = v4l2_prio_check(&ch->prio, fh->prio);
1402         if (0 != ret)
1403                 return ret;
1404
1405         fh->initialized = 1;
1406
1407         /* Call encoder subdevice function to set the standard */
1408         ch->video.stdid = *std_id;
1409         ch->video.dv_preset = V4L2_DV_INVALID;
1410         memset(&ch->video.bt_timings, 0, sizeof(ch->video.bt_timings));
1411
1412         /* Get the information about the standard */
1413         if (vpif_update_std_info(ch)) {
1414                 vpif_err("Error getting the standard info\n");
1415                 return -EINVAL;
1416         }
1417
1418         /* Configure the default format information */
1419         vpif_config_format(ch);
1420
1421         /* set standard in the sub device */
1422         ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], core,
1423                                 s_std, *std_id);
1424         if (ret < 0)
1425                 vpif_dbg(1, debug, "Failed to set standard for sub devices\n");
1426         return ret;
1427 }
1428
1429 /**
1430  * vpif_enum_input() - ENUMINPUT handler
1431  * @file: file ptr
1432  * @priv: file handle
1433  * @input: ptr to input structure
1434  */
1435 static int vpif_enum_input(struct file *file, void *priv,
1436                                 struct v4l2_input *input)
1437 {
1438
1439         struct vpif_capture_config *config = vpif_dev->platform_data;
1440         struct vpif_capture_chan_config *chan_cfg;
1441         struct vpif_fh *fh = priv;
1442         struct channel_obj *ch = fh->channel;
1443
1444         chan_cfg = &config->chan_config[ch->channel_id];
1445
1446         if (input->index >= chan_cfg->input_count) {
1447                 vpif_dbg(1, debug, "Invalid input index\n");
1448                 return -EINVAL;
1449         }
1450
1451         memcpy(input, &chan_cfg->inputs[input->index].input,
1452                 sizeof(*input));
1453         return 0;
1454 }
1455
1456 /**
1457  * vpif_g_input() - Get INPUT handler
1458  * @file: file ptr
1459  * @priv: file handle
1460  * @index: ptr to input index
1461  */
1462 static int vpif_g_input(struct file *file, void *priv, unsigned int *index)
1463 {
1464         struct vpif_fh *fh = priv;
1465         struct channel_obj *ch = fh->channel;
1466         struct video_obj *vid_ch = &ch->video;
1467
1468         *index = vid_ch->input_idx;
1469
1470         return 0;
1471 }
1472
1473 /**
1474  * vpif_s_input() - Set INPUT handler
1475  * @file: file ptr
1476  * @priv: file handle
1477  * @index: input index
1478  */
1479 static int vpif_s_input(struct file *file, void *priv, unsigned int index)
1480 {
1481         struct vpif_capture_config *config = vpif_dev->platform_data;
1482         struct vpif_capture_chan_config *chan_cfg;
1483         struct vpif_fh *fh = priv;
1484         struct channel_obj *ch = fh->channel;
1485         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1486         struct video_obj *vid_ch = &ch->video;
1487         struct vpif_subdev_info *subdev_info;
1488         int ret = 0, sd_index = 0;
1489         u32 input = 0, output = 0;
1490
1491         chan_cfg = &config->chan_config[ch->channel_id];
1492
1493         if (common->started) {
1494                 vpif_err("Streaming in progress\n");
1495                 return -EBUSY;
1496         }
1497
1498         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id) ||
1499             (VPIF_CHANNEL1_VIDEO == ch->channel_id)) {
1500                 if (!fh->initialized) {
1501                         vpif_dbg(1, debug, "Channel Busy\n");
1502                         return -EBUSY;
1503                 }
1504         }
1505
1506         ret = v4l2_prio_check(&ch->prio, fh->prio);
1507         if (0 != ret)
1508                 return ret;
1509
1510         fh->initialized = 1;
1511         subdev_info = vpif_map_sub_device_to_input(ch, config, index,
1512                                                    &sd_index);
1513         if (NULL == subdev_info) {
1514                 vpif_dbg(1, debug,
1515                         "couldn't lookup sub device for the input index\n");
1516                 return -EINVAL;
1517         }
1518
1519         /* first setup input path from sub device to vpif */
1520         if (config->setup_input_path) {
1521                 ret = config->setup_input_path(ch->channel_id,
1522                                                subdev_info->name);
1523                 if (ret < 0) {
1524                         vpif_dbg(1, debug, "couldn't setup input path for the"
1525                                 " sub device %s, for input index %d\n",
1526                                 subdev_info->name, index);
1527                         return ret;
1528                 }
1529         }
1530
1531         if (subdev_info->can_route) {
1532                 input = subdev_info->input;
1533                 output = subdev_info->output;
1534                 ret = v4l2_subdev_call(vpif_obj.sd[sd_index], video, s_routing,
1535                                         input, output, 0);
1536                 if (ret < 0) {
1537                         vpif_dbg(1, debug, "Failed to set input\n");
1538                         return ret;
1539                 }
1540         }
1541         vid_ch->input_idx = index;
1542         ch->curr_subdev_info = subdev_info;
1543         ch->curr_sd_index = sd_index;
1544         /* copy interface parameters to vpif */
1545         ch->vpifparams.iface = subdev_info->vpif_if;
1546
1547         /* update tvnorms from the sub device input info */
1548         ch->video_dev->tvnorms = chan_cfg->inputs[index].input.std;
1549         return ret;
1550 }
1551
1552 /**
1553  * vpif_enum_fmt_vid_cap() - ENUM_FMT handler
1554  * @file: file ptr
1555  * @priv: file handle
1556  * @index: input index
1557  */
1558 static int vpif_enum_fmt_vid_cap(struct file *file, void  *priv,
1559                                         struct v4l2_fmtdesc *fmt)
1560 {
1561         struct vpif_fh *fh = priv;
1562         struct channel_obj *ch = fh->channel;
1563
1564         if (fmt->index != 0) {
1565                 vpif_dbg(1, debug, "Invalid format index\n");
1566                 return -EINVAL;
1567         }
1568
1569         /* Fill in the information about format */
1570         if (ch->vpifparams.iface.if_type == VPIF_IF_RAW_BAYER) {
1571                 fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1572                 strcpy(fmt->description, "Raw Mode -Bayer Pattern GrRBGb");
1573                 fmt->pixelformat = V4L2_PIX_FMT_SBGGR8;
1574         } else {
1575                 fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1576                 strcpy(fmt->description, "YCbCr4:2:2 YC Planar");
1577                 fmt->pixelformat = V4L2_PIX_FMT_YUV422P;
1578         }
1579         return 0;
1580 }
1581
1582 /**
1583  * vpif_try_fmt_vid_cap() - TRY_FMT handler
1584  * @file: file ptr
1585  * @priv: file handle
1586  * @fmt: ptr to v4l2 format structure
1587  */
1588 static int vpif_try_fmt_vid_cap(struct file *file, void *priv,
1589                                 struct v4l2_format *fmt)
1590 {
1591         struct vpif_fh *fh = priv;
1592         struct channel_obj *ch = fh->channel;
1593         struct v4l2_pix_format *pixfmt = &fmt->fmt.pix;
1594
1595         return vpif_check_format(ch, pixfmt, 1);
1596 }
1597
1598
1599 /**
1600  * vpif_g_fmt_vid_cap() - Set INPUT handler
1601  * @file: file ptr
1602  * @priv: file handle
1603  * @fmt: ptr to v4l2 format structure
1604  */
1605 static int vpif_g_fmt_vid_cap(struct file *file, void *priv,
1606                                 struct v4l2_format *fmt)
1607 {
1608         struct vpif_fh *fh = priv;
1609         struct channel_obj *ch = fh->channel;
1610         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1611
1612         /* Check the validity of the buffer type */
1613         if (common->fmt.type != fmt->type)
1614                 return -EINVAL;
1615
1616         /* Fill in the information about format */
1617         *fmt = common->fmt;
1618         return 0;
1619 }
1620
1621 /**
1622  * vpif_s_fmt_vid_cap() - Set FMT handler
1623  * @file: file ptr
1624  * @priv: file handle
1625  * @fmt: ptr to v4l2 format structure
1626  */
1627 static int vpif_s_fmt_vid_cap(struct file *file, void *priv,
1628                                 struct v4l2_format *fmt)
1629 {
1630         struct vpif_fh *fh = priv;
1631         struct channel_obj *ch = fh->channel;
1632         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1633         struct v4l2_pix_format *pixfmt;
1634         int ret = 0;
1635
1636         vpif_dbg(2, debug, "%s\n", __func__);
1637
1638         /* If streaming is started, return error */
1639         if (common->started) {
1640                 vpif_dbg(1, debug, "Streaming is started\n");
1641                 return -EBUSY;
1642         }
1643
1644         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id) ||
1645             (VPIF_CHANNEL1_VIDEO == ch->channel_id)) {
1646                 if (!fh->initialized) {
1647                         vpif_dbg(1, debug, "Channel Busy\n");
1648                         return -EBUSY;
1649                 }
1650         }
1651
1652         ret = v4l2_prio_check(&ch->prio, fh->prio);
1653         if (0 != ret)
1654                 return ret;
1655
1656         fh->initialized = 1;
1657
1658         pixfmt = &fmt->fmt.pix;
1659         /* Check for valid field format */
1660         ret = vpif_check_format(ch, pixfmt, 0);
1661
1662         if (ret)
1663                 return ret;
1664         /* store the format in the channel object */
1665         common->fmt = *fmt;
1666         return 0;
1667 }
1668
1669 /**
1670  * vpif_querycap() - QUERYCAP handler
1671  * @file: file ptr
1672  * @priv: file handle
1673  * @cap: ptr to v4l2_capability structure
1674  */
1675 static int vpif_querycap(struct file *file, void  *priv,
1676                                 struct v4l2_capability *cap)
1677 {
1678         struct vpif_capture_config *config = vpif_dev->platform_data;
1679
1680         cap->version = VPIF_CAPTURE_VERSION_CODE;
1681         cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING;
1682         strlcpy(cap->driver, "vpif capture", sizeof(cap->driver));
1683         strlcpy(cap->bus_info, "DM646x Platform", sizeof(cap->bus_info));
1684         strlcpy(cap->card, config->card_name, sizeof(cap->card));
1685
1686         return 0;
1687 }
1688
1689 /**
1690  * vpif_g_priority() - get priority handler
1691  * @file: file ptr
1692  * @priv: file handle
1693  * @prio: ptr to v4l2_priority structure
1694  */
1695 static int vpif_g_priority(struct file *file, void *priv,
1696                            enum v4l2_priority *prio)
1697 {
1698         struct vpif_fh *fh = priv;
1699         struct channel_obj *ch = fh->channel;
1700
1701         *prio = v4l2_prio_max(&ch->prio);
1702
1703         return 0;
1704 }
1705
1706 /**
1707  * vpif_s_priority() - set priority handler
1708  * @file: file ptr
1709  * @priv: file handle
1710  * @prio: ptr to v4l2_priority structure
1711  */
1712 static int vpif_s_priority(struct file *file, void *priv, enum v4l2_priority p)
1713 {
1714         struct vpif_fh *fh = priv;
1715         struct channel_obj *ch = fh->channel;
1716
1717         return v4l2_prio_change(&ch->prio, &fh->prio, p);
1718 }
1719
1720 /**
1721  * vpif_cropcap() - cropcap handler
1722  * @file: file ptr
1723  * @priv: file handle
1724  * @crop: ptr to v4l2_cropcap structure
1725  */
1726 static int vpif_cropcap(struct file *file, void *priv,
1727                         struct v4l2_cropcap *crop)
1728 {
1729         struct vpif_fh *fh = priv;
1730         struct channel_obj *ch = fh->channel;
1731         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1732
1733         if (V4L2_BUF_TYPE_VIDEO_CAPTURE != crop->type)
1734                 return -EINVAL;
1735
1736         crop->bounds.left = 0;
1737         crop->bounds.top = 0;
1738         crop->bounds.height = common->height;
1739         crop->bounds.width = common->width;
1740         crop->defrect = crop->bounds;
1741         return 0;
1742 }
1743
1744 /**
1745  * vpif_enum_dv_presets() - ENUM_DV_PRESETS handler
1746  * @file: file ptr
1747  * @priv: file handle
1748  * @preset: input preset
1749  */
1750 static int vpif_enum_dv_presets(struct file *file, void *priv,
1751                 struct v4l2_dv_enum_preset *preset)
1752 {
1753         struct vpif_fh *fh = priv;
1754         struct channel_obj *ch = fh->channel;
1755
1756         return v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index],
1757                         video, enum_dv_presets, preset);
1758 }
1759
1760 /**
1761  * vpif_query_dv_presets() - QUERY_DV_PRESET handler
1762  * @file: file ptr
1763  * @priv: file handle
1764  * @preset: input preset
1765  */
1766 static int vpif_query_dv_preset(struct file *file, void *priv,
1767                 struct v4l2_dv_preset *preset)
1768 {
1769         struct vpif_fh *fh = priv;
1770         struct channel_obj *ch = fh->channel;
1771
1772         return v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index],
1773                        video, query_dv_preset, preset);
1774 }
1775 /**
1776  * vpif_s_dv_presets() - S_DV_PRESETS handler
1777  * @file: file ptr
1778  * @priv: file handle
1779  * @preset: input preset
1780  */
1781 static int vpif_s_dv_preset(struct file *file, void *priv,
1782                 struct v4l2_dv_preset *preset)
1783 {
1784         struct vpif_fh *fh = priv;
1785         struct channel_obj *ch = fh->channel;
1786         struct common_obj *common = &ch->common[VPIF_VIDEO_INDEX];
1787         int ret = 0;
1788
1789         if (common->started) {
1790                 vpif_dbg(1, debug, "streaming in progress\n");
1791                 return -EBUSY;
1792         }
1793
1794         if ((VPIF_CHANNEL0_VIDEO == ch->channel_id) ||
1795             (VPIF_CHANNEL1_VIDEO == ch->channel_id)) {
1796                 if (!fh->initialized) {
1797                         vpif_dbg(1, debug, "Channel Busy\n");
1798                         return -EBUSY;
1799                 }
1800         }
1801
1802         ret = v4l2_prio_check(&ch->prio, fh->prio);
1803         if (ret)
1804                 return ret;
1805
1806         fh->initialized = 1;
1807
1808         /* Call encoder subdevice function to set the standard */
1809         if (mutex_lock_interruptible(&common->lock))
1810                 return -ERESTARTSYS;
1811
1812         ch->video.dv_preset = preset->preset;
1813         ch->video.stdid = V4L2_STD_UNKNOWN;
1814         memset(&ch->video.bt_timings, 0, sizeof(ch->video.bt_timings));
1815
1816         /* Get the information about the standard */
1817         if (vpif_update_std_info(ch)) {
1818                 vpif_dbg(1, debug, "Error getting the standard info\n");
1819                 ret = -EINVAL;
1820         } else {
1821                 /* Configure the default format information */
1822                 vpif_config_format(ch);
1823
1824                 ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index],
1825                                 video, s_dv_preset, preset);
1826         }
1827
1828         mutex_unlock(&common->lock);
1829
1830         return ret;
1831 }
1832 /**
1833  * vpif_g_dv_presets() - G_DV_PRESETS handler
1834  * @file: file ptr
1835  * @priv: file handle
1836  * @preset: input preset
1837  */
1838 static int vpif_g_dv_preset(struct file *file, void *priv,
1839                 struct v4l2_dv_preset *preset)
1840 {
1841         struct vpif_fh *fh = priv;
1842         struct channel_obj *ch = fh->channel;
1843
1844         preset->preset = ch->video.dv_preset;
1845
1846         return 0;
1847 }
1848
1849 /**
1850  * vpif_s_dv_timings() - S_DV_TIMINGS handler
1851  * @file: file ptr
1852  * @priv: file handle
1853  * @timings: digital video timings
1854  */
1855 static int vpif_s_dv_timings(struct file *file, void *priv,
1856                 struct v4l2_dv_timings *timings)
1857 {
1858         struct vpif_fh *fh = priv;
1859         struct channel_obj *ch = fh->channel;
1860         struct vpif_params *vpifparams = &ch->vpifparams;
1861         struct vpif_channel_config_params *std_info = &vpifparams->std_info;
1862         struct video_obj *vid_ch = &ch->video;
1863         struct v4l2_bt_timings *bt = &vid_ch->bt_timings;
1864         int ret;
1865
1866         if (timings->type != V4L2_DV_BT_656_1120) {
1867                 vpif_dbg(2, debug, "Timing type not defined\n");
1868                 return -EINVAL;
1869         }
1870
1871         /* Configure subdevice timings, if any */
1872         ret = v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index],
1873                         video, s_dv_timings, timings);
1874         if (ret == -ENOIOCTLCMD) {
1875                 vpif_dbg(2, debug, "Custom DV timings not supported by "
1876                                 "subdevice\n");
1877                 return -EINVAL;
1878         }
1879         if (ret < 0) {
1880                 vpif_dbg(2, debug, "Error setting custom DV timings\n");
1881                 return ret;
1882         }
1883
1884         if (!(timings->bt.width && timings->bt.height &&
1885                                 (timings->bt.hbackporch ||
1886                                  timings->bt.hfrontporch ||
1887                                  timings->bt.hsync) &&
1888                                 timings->bt.vfrontporch &&
1889                                 (timings->bt.vbackporch ||
1890                                  timings->bt.vsync))) {
1891                 vpif_dbg(2, debug, "Timings for width, height, "
1892                                 "horizontal back porch, horizontal sync, "
1893                                 "horizontal front porch, vertical back porch, "
1894                                 "vertical sync and vertical back porch "
1895                                 "must be defined\n");
1896                 return -EINVAL;
1897         }
1898
1899         *bt = timings->bt;
1900
1901         /* Configure video port timings */
1902
1903         std_info->eav2sav = bt->hbackporch + bt->hfrontporch +
1904                 bt->hsync - 8;
1905         std_info->sav2eav = bt->width;
1906
1907         std_info->l1 = 1;
1908         std_info->l3 = bt->vsync + bt->vbackporch + 1;
1909
1910         if (bt->interlaced) {
1911                 if (bt->il_vbackporch || bt->il_vfrontporch || bt->il_vsync) {
1912                         std_info->vsize = bt->height * 2 +
1913                                 bt->vfrontporch + bt->vsync + bt->vbackporch +
1914                                 bt->il_vfrontporch + bt->il_vsync +
1915                                 bt->il_vbackporch;
1916                         std_info->l5 = std_info->vsize/2 -
1917                                 (bt->vfrontporch - 1);
1918                         std_info->l7 = std_info->vsize/2 + 1;
1919                         std_info->l9 = std_info->l7 + bt->il_vsync +
1920                                 bt->il_vbackporch + 1;
1921                         std_info->l11 = std_info->vsize -
1922                                 (bt->il_vfrontporch - 1);
1923                 } else {
1924                         vpif_dbg(2, debug, "Required timing values for "
1925                                         "interlaced BT format missing\n");
1926                         return -EINVAL;
1927                 }
1928         } else {
1929                 std_info->vsize = bt->height + bt->vfrontporch +
1930                         bt->vsync + bt->vbackporch;
1931                 std_info->l5 = std_info->vsize - (bt->vfrontporch - 1);
1932         }
1933         strncpy(std_info->name, "Custom timings BT656/1120", VPIF_MAX_NAME);
1934         std_info->width = bt->width;
1935         std_info->height = bt->height;
1936         std_info->frm_fmt = bt->interlaced ? 0 : 1;
1937         std_info->ycmux_mode = 0;
1938         std_info->capture_format = 0;
1939         std_info->vbi_supported = 0;
1940         std_info->hd_sd = 1;
1941         std_info->stdid = 0;
1942         std_info->dv_preset = V4L2_DV_INVALID;
1943
1944         vid_ch->stdid = 0;
1945         vid_ch->dv_preset = V4L2_DV_INVALID;
1946         return 0;
1947 }
1948
1949 /**
1950  * vpif_g_dv_timings() - G_DV_TIMINGS handler
1951  * @file: file ptr
1952  * @priv: file handle
1953  * @timings: digital video timings
1954  */
1955 static int vpif_g_dv_timings(struct file *file, void *priv,
1956                 struct v4l2_dv_timings *timings)
1957 {
1958         struct vpif_fh *fh = priv;
1959         struct channel_obj *ch = fh->channel;
1960         struct video_obj *vid_ch = &ch->video;
1961         struct v4l2_bt_timings *bt = &vid_ch->bt_timings;
1962
1963         timings->bt = *bt;
1964
1965         return 0;
1966 }
1967
1968 /*
1969  * vpif_g_chip_ident() - Identify the chip
1970  * @file: file ptr
1971  * @priv: file handle
1972  * @chip: chip identity
1973  *
1974  * Returns zero or -EINVAL if read operations fails.
1975  */
1976 static int vpif_g_chip_ident(struct file *file, void *priv,
1977                 struct v4l2_dbg_chip_ident *chip)
1978 {
1979         chip->ident = V4L2_IDENT_NONE;
1980         chip->revision = 0;
1981         if (chip->match.type != V4L2_CHIP_MATCH_I2C_DRIVER &&
1982                         chip->match.type != V4L2_CHIP_MATCH_I2C_ADDR) {
1983                 vpif_dbg(2, debug, "match_type is invalid.\n");
1984                 return -EINVAL;
1985         }
1986
1987         return v4l2_device_call_until_err(&vpif_obj.v4l2_dev, 0, core,
1988                         g_chip_ident, chip);
1989 }
1990
1991 #ifdef CONFIG_VIDEO_ADV_DEBUG
1992 /*
1993  * vpif_dbg_g_register() - Read register
1994  * @file: file ptr
1995  * @priv: file handle
1996  * @reg: register to be read
1997  *
1998  * Debugging only
1999  * Returns zero or -EINVAL if read operations fails.
2000  */
2001 static int vpif_dbg_g_register(struct file *file, void *priv,
2002                 struct v4l2_dbg_register *reg){
2003         struct vpif_fh *fh = priv;
2004         struct channel_obj *ch = fh->channel;
2005
2006         return v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], core,
2007                         g_register, reg);
2008 }
2009
2010 /*
2011  * vpif_dbg_s_register() - Write to register
2012  * @file: file ptr
2013  * @priv: file handle
2014  * @reg: register to be modified
2015  *
2016  * Debugging only
2017  * Returns zero or -EINVAL if write operations fails.
2018  */
2019 static int vpif_dbg_s_register(struct file *file, void *priv,
2020                 struct v4l2_dbg_register *reg){
2021         struct vpif_fh *fh = priv;
2022         struct channel_obj *ch = fh->channel;
2023
2024         return v4l2_subdev_call(vpif_obj.sd[ch->curr_sd_index], core,
2025                         s_register, reg);
2026 }
2027 #endif
2028
2029 /*
2030  * vpif_log_status() - Status information
2031  * @file: file ptr
2032  * @priv: file handle
2033  *
2034  * Returns zero.
2035  */
2036 static int vpif_log_status(struct file *filep, void *priv)
2037 {
2038         /* status for sub devices */
2039         v4l2_device_call_all(&vpif_obj.v4l2_dev, 0, core, log_status);
2040
2041         return 0;
2042 }
2043
2044 /* vpif capture ioctl operations */
2045 static const struct v4l2_ioctl_ops vpif_ioctl_ops = {
2046         .vidioc_querycap                = vpif_querycap,
2047         .vidioc_g_priority              = vpif_g_priority,
2048         .vidioc_s_priority              = vpif_s_priority,
2049         .vidioc_enum_fmt_vid_cap        = vpif_enum_fmt_vid_cap,
2050         .vidioc_g_fmt_vid_cap           = vpif_g_fmt_vid_cap,
2051         .vidioc_s_fmt_vid_cap           = vpif_s_fmt_vid_cap,
2052         .vidioc_try_fmt_vid_cap         = vpif_try_fmt_vid_cap,
2053         .vidioc_enum_input              = vpif_enum_input,
2054         .vidioc_s_input                 = vpif_s_input,
2055         .vidioc_g_input                 = vpif_g_input,
2056         .vidioc_reqbufs                 = vpif_reqbufs,
2057         .vidioc_querybuf                = vpif_querybuf,
2058         .vidioc_querystd                = vpif_querystd,
2059         .vidioc_s_std                   = vpif_s_std,
2060         .vidioc_g_std                   = vpif_g_std,
2061         .vidioc_qbuf                    = vpif_qbuf,
2062         .vidioc_dqbuf                   = vpif_dqbuf,
2063         .vidioc_streamon                = vpif_streamon,
2064         .vidioc_streamoff               = vpif_streamoff,
2065         .vidioc_cropcap                 = vpif_cropcap,
2066         .vidioc_enum_dv_presets         = vpif_enum_dv_presets,
2067         .vidioc_s_dv_preset             = vpif_s_dv_preset,
2068         .vidioc_g_dv_preset             = vpif_g_dv_preset,
2069         .vidioc_query_dv_preset         = vpif_query_dv_preset,
2070         .vidioc_s_dv_timings            = vpif_s_dv_timings,
2071         .vidioc_g_dv_timings            = vpif_g_dv_timings,
2072         .vidioc_g_chip_ident            = vpif_g_chip_ident,
2073 #ifdef CONFIG_VIDEO_ADV_DEBUG
2074         .vidioc_g_register              = vpif_dbg_g_register,
2075         .vidioc_s_register              = vpif_dbg_s_register,
2076 #endif
2077         .vidioc_log_status              = vpif_log_status,
2078 };
2079
2080 /* vpif file operations */
2081 static struct v4l2_file_operations vpif_fops = {
2082         .owner = THIS_MODULE,
2083         .open = vpif_open,
2084         .release = vpif_release,
2085         .unlocked_ioctl = video_ioctl2,
2086         .mmap = vpif_mmap,
2087         .poll = vpif_poll
2088 };
2089
2090 /* vpif video template */
2091 static struct video_device vpif_video_template = {
2092         .name           = "vpif",
2093         .fops           = &vpif_fops,
2094         .minor          = -1,
2095         .ioctl_ops      = &vpif_ioctl_ops,
2096 };
2097
2098 /**
2099  * initialize_vpif() - Initialize vpif data structures
2100  *
2101  * Allocate memory for data structures and initialize them
2102  */
2103 static int initialize_vpif(void)
2104 {
2105         int err = 0, i, j;
2106         int free_channel_objects_index;
2107
2108         /* Default number of buffers should be 3 */
2109         if ((ch0_numbuffers > 0) &&
2110             (ch0_numbuffers < config_params.min_numbuffers))
2111                 ch0_numbuffers = config_params.min_numbuffers;
2112         if ((ch1_numbuffers > 0) &&
2113             (ch1_numbuffers < config_params.min_numbuffers))
2114                 ch1_numbuffers = config_params.min_numbuffers;
2115
2116         /* Set buffer size to min buffers size if it is invalid */
2117         if (ch0_bufsize < config_params.min_bufsize[VPIF_CHANNEL0_VIDEO])
2118                 ch0_bufsize =
2119                     config_params.min_bufsize[VPIF_CHANNEL0_VIDEO];
2120         if (ch1_bufsize < config_params.min_bufsize[VPIF_CHANNEL1_VIDEO])
2121                 ch1_bufsize =
2122                     config_params.min_bufsize[VPIF_CHANNEL1_VIDEO];
2123
2124         config_params.numbuffers[VPIF_CHANNEL0_VIDEO] = ch0_numbuffers;
2125         config_params.numbuffers[VPIF_CHANNEL1_VIDEO] = ch1_numbuffers;
2126         if (ch0_numbuffers) {
2127                 config_params.channel_bufsize[VPIF_CHANNEL0_VIDEO]
2128                     = ch0_bufsize;
2129         }
2130         if (ch1_numbuffers) {
2131                 config_params.channel_bufsize[VPIF_CHANNEL1_VIDEO]
2132                     = ch1_bufsize;
2133         }
2134
2135         /* Allocate memory for six channel objects */
2136         for (i = 0; i < VPIF_CAPTURE_MAX_DEVICES; i++) {
2137                 vpif_obj.dev[i] =
2138                     kzalloc(sizeof(*vpif_obj.dev[i]), GFP_KERNEL);
2139                 /* If memory allocation fails, return error */
2140                 if (!vpif_obj.dev[i]) {
2141                         free_channel_objects_index = i;
2142                         err = -ENOMEM;
2143                         goto vpif_init_free_channel_objects;
2144                 }
2145         }
2146         return 0;
2147
2148 vpif_init_free_channel_objects:
2149         for (j = 0; j < free_channel_objects_index; j++)
2150                 kfree(vpif_obj.dev[j]);
2151         return err;
2152 }
2153
2154 /**
2155  * vpif_probe : This function probes the vpif capture driver
2156  * @pdev: platform device pointer
2157  *
2158  * This creates device entries by register itself to the V4L2 driver and
2159  * initializes fields of each channel objects
2160  */
2161 static __init int vpif_probe(struct platform_device *pdev)
2162 {
2163         struct vpif_subdev_info *subdevdata;
2164         struct vpif_capture_config *config;
2165         int i, j, k, m, q, err;
2166         struct i2c_adapter *i2c_adap;
2167         struct channel_obj *ch;
2168         struct common_obj *common;
2169         struct video_device *vfd;
2170         struct resource *res;
2171         int subdev_count;
2172
2173         vpif_dev = &pdev->dev;
2174
2175         err = initialize_vpif();
2176         if (err) {
2177                 v4l2_err(vpif_dev->driver, "Error initializing vpif\n");
2178                 return err;
2179         }
2180
2181         k = 0;
2182         while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, k))) {
2183                 for (i = res->start; i <= res->end; i++) {
2184                         if (request_irq(i, vpif_channel_isr, IRQF_DISABLED,
2185                                         "DM646x_Capture",
2186                                 (void *)(&vpif_obj.dev[k]->channel_id))) {
2187                                 err = -EBUSY;
2188                                 i--;
2189                                 goto vpif_int_err;
2190                         }
2191                 }
2192                 k++;
2193         }
2194
2195         for (i = 0; i < VPIF_CAPTURE_MAX_DEVICES; i++) {
2196                 /* Get the pointer to the channel object */
2197                 ch = vpif_obj.dev[i];
2198                 /* Allocate memory for video device */
2199                 vfd = video_device_alloc();
2200                 if (NULL == vfd) {
2201                         for (j = 0; j < i; j++) {
2202                                 ch = vpif_obj.dev[j];
2203                                 video_device_release(ch->video_dev);
2204                         }
2205                         err = -ENOMEM;
2206                         goto vpif_dev_alloc_err;
2207                 }
2208
2209                 /* Initialize field of video device */
2210                 *vfd = vpif_video_template;
2211                 vfd->v4l2_dev = &vpif_obj.v4l2_dev;
2212                 vfd->release = video_device_release;
2213                 snprintf(vfd->name, sizeof(vfd->name),
2214                          "DM646x_VPIFCapture_DRIVER_V%d.%d.%d",
2215                          (VPIF_CAPTURE_VERSION_CODE >> 16) & 0xff,
2216                          (VPIF_CAPTURE_VERSION_CODE >> 8) & 0xff,
2217                          (VPIF_CAPTURE_VERSION_CODE) & 0xff);
2218                 /* Set video_dev to the video device */
2219                 ch->video_dev = vfd;
2220         }
2221
2222         for (j = 0; j < VPIF_CAPTURE_MAX_DEVICES; j++) {
2223                 ch = vpif_obj.dev[j];
2224                 ch->channel_id = j;
2225                 common = &(ch->common[VPIF_VIDEO_INDEX]);
2226                 spin_lock_init(&common->irqlock);
2227                 mutex_init(&common->lock);
2228                 ch->video_dev->lock = &common->lock;
2229                 /* Initialize prio member of channel object */
2230                 v4l2_prio_init(&ch->prio);
2231                 err = video_register_device(ch->video_dev,
2232                                             VFL_TYPE_GRABBER, (j ? 1 : 0));
2233                 if (err)
2234                         goto probe_out;
2235
2236                 video_set_drvdata(ch->video_dev, ch);
2237
2238         }
2239
2240         i2c_adap = i2c_get_adapter(1);
2241         config = pdev->dev.platform_data;
2242
2243         subdev_count = config->subdev_count;
2244         vpif_obj.sd = kzalloc(sizeof(struct v4l2_subdev *) * subdev_count,
2245                                 GFP_KERNEL);
2246         if (vpif_obj.sd == NULL) {
2247                 vpif_err("unable to allocate memory for subdevice pointers\n");
2248                 err = -ENOMEM;
2249                 goto probe_out;
2250         }
2251
2252         err = v4l2_device_register(vpif_dev, &vpif_obj.v4l2_dev);
2253         if (err) {
2254                 v4l2_err(vpif_dev->driver, "Error registering v4l2 device\n");
2255                 goto probe_subdev_out;
2256         }
2257
2258         for (i = 0; i < subdev_count; i++) {
2259                 subdevdata = &config->subdev_info[i];
2260                 vpif_obj.sd[i] =
2261                         v4l2_i2c_new_subdev_board(&vpif_obj.v4l2_dev,
2262                                                   i2c_adap,
2263                                                   &subdevdata->board_info,
2264                                                   NULL);
2265
2266                 if (!vpif_obj.sd[i]) {
2267                         vpif_err("Error registering v4l2 subdevice\n");
2268                         goto probe_subdev_out;
2269                 }
2270                 v4l2_info(&vpif_obj.v4l2_dev, "registered sub device %s\n",
2271                           subdevdata->name);
2272
2273                 if (vpif_obj.sd[i])
2274                         vpif_obj.sd[i]->grp_id = 1 << i;
2275         }
2276
2277         v4l2_info(&vpif_obj.v4l2_dev,
2278                         "DM646x VPIF capture driver initialized\n");
2279         return 0;
2280
2281 probe_subdev_out:
2282         /* free sub devices memory */
2283         kfree(vpif_obj.sd);
2284
2285         j = VPIF_CAPTURE_MAX_DEVICES;
2286 probe_out:
2287         v4l2_device_unregister(&vpif_obj.v4l2_dev);
2288         for (k = 0; k < j; k++) {
2289                 /* Get the pointer to the channel object */
2290                 ch = vpif_obj.dev[k];
2291                 /* Unregister video device */
2292                 video_unregister_device(ch->video_dev);
2293         }
2294
2295 vpif_dev_alloc_err:
2296         k = VPIF_CAPTURE_MAX_DEVICES-1;
2297         res = platform_get_resource(pdev, IORESOURCE_IRQ, k);
2298         i = res->end;
2299
2300 vpif_int_err:
2301         for (q = k; q >= 0; q--) {
2302                 for (m = i; m >= (int)res->start; m--)
2303                         free_irq(m, (void *)(&vpif_obj.dev[q]->channel_id));
2304
2305                 res = platform_get_resource(pdev, IORESOURCE_IRQ, q-1);
2306                 if (res)
2307                         i = res->end;
2308         }
2309         return err;
2310 }
2311
2312 /**
2313  * vpif_remove() - driver remove handler
2314  * @device: ptr to platform device structure
2315  *
2316  * The vidoe device is unregistered
2317  */
2318 static int vpif_remove(struct platform_device *device)
2319 {
2320         int i;
2321         struct channel_obj *ch;
2322
2323         v4l2_device_unregister(&vpif_obj.v4l2_dev);
2324
2325         /* un-register device */
2326         for (i = 0; i < VPIF_CAPTURE_MAX_DEVICES; i++) {
2327                 /* Get the pointer to the channel object */
2328                 ch = vpif_obj.dev[i];
2329                 /* Unregister video device */
2330                 video_unregister_device(ch->video_dev);
2331         }
2332         return 0;
2333 }
2334
2335 /**
2336  * vpif_suspend: vpif device suspend
2337  *
2338  * TODO: Add suspend code here
2339  */
2340 static int
2341 vpif_suspend(struct device *dev)
2342 {
2343         return -1;
2344 }
2345
2346 /**
2347  * vpif_resume: vpif device suspend
2348  *
2349  * TODO: Add resume code here
2350  */
2351 static int
2352 vpif_resume(struct device *dev)
2353 {
2354         return -1;
2355 }
2356
2357 static const struct dev_pm_ops vpif_dev_pm_ops = {
2358         .suspend = vpif_suspend,
2359         .resume = vpif_resume,
2360 };
2361
2362 static __refdata struct platform_driver vpif_driver = {
2363         .driver = {
2364                 .name   = "vpif_capture",
2365                 .owner  = THIS_MODULE,
2366                 .pm = &vpif_dev_pm_ops,
2367         },
2368         .probe = vpif_probe,
2369         .remove = vpif_remove,
2370 };
2371
2372 /**
2373  * vpif_init: initialize the vpif driver
2374  *
2375  * This function registers device and driver to the kernel, requests irq
2376  * handler and allocates memory
2377  * for channel objects
2378  */
2379 static __init int vpif_init(void)
2380 {
2381         return platform_driver_register(&vpif_driver);
2382 }
2383
2384 /**
2385  * vpif_cleanup : This function clean up the vpif capture resources
2386  *
2387  * This will un-registers device and driver to the kernel, frees
2388  * requested irq handler and de-allocates memory allocated for channel
2389  * objects.
2390  */
2391 static void vpif_cleanup(void)
2392 {
2393         struct platform_device *pdev;
2394         struct resource *res;
2395         int irq_num;
2396         int i = 0;
2397
2398         pdev = container_of(vpif_dev, struct platform_device, dev);
2399         while ((res = platform_get_resource(pdev, IORESOURCE_IRQ, i))) {
2400                 for (irq_num = res->start; irq_num <= res->end; irq_num++)
2401                         free_irq(irq_num,
2402                                  (void *)(&vpif_obj.dev[i]->channel_id));
2403                 i++;
2404         }
2405
2406         platform_driver_unregister(&vpif_driver);
2407
2408         kfree(vpif_obj.sd);
2409         for (i = 0; i < VPIF_CAPTURE_MAX_DEVICES; i++)
2410                 kfree(vpif_obj.dev[i]);
2411 }
2412
2413 /* Function for module initialization and cleanup */
2414 module_init(vpif_init);
2415 module_exit(vpif_cleanup);