ENGR00299224 ov5640 mipi: support internal enum_frameintervals ioctrl

This patch adds internal v4l2 enum_frameintervals ioctrl support for
the ov5640 mipi camera driver.

Signed-off-by: Liu Ying <Ying.Liu@freescale.com>

1 files changed, 39 insertions, 1 deletions

diff --git a/drivers/media/platform/mxc/capture/ov5640_mipi.c b/drivers/media/platform/mxc/capture/ov5640_mipi.c
index 79264bc63796..21b702f5782a 100644
--- a/drivers/media/platform/mxc/capture/ov5640_mipi.c
+++ b/drivers/media/platform/mxc/capture/ov5640_mipi.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (C) 2011-2013 Freescale Semiconductor, Inc. All Rights Reserved.
+ * Copyright (C) 2011-2014 Freescale Semiconductor, Inc. All Rights Reserved.
  */
 
 /*
@@ -70,6 +70,11 @@ enum ov5640_frame_rate {
         ov5640_30_fps
 };
 
+static int ov5640_framerates[] = {
+        [ov5640_15_fps] = 15,
+        [ov5640_30_fps] = 30,
+};
+
 /* image size under 1280 * 960 are SUBSAMPLING
  * image size upper 1280 * 960 are SCALING
  */
@@ -1770,6 +1775,37 @@ static int ioctl_enum_framesizes(struct v4l2_int_device *s,
 }
 
 /*!
+ * ioctl_enum_frameintervals - V4L2 sensor interface handler for
+ *                             VIDIOC_ENUM_FRAMEINTERVALS ioctl
+ * @s: pointer to standard V4L2 device structure
+ * @fival: standard V4L2 VIDIOC_ENUM_FRAMEINTERVALS ioctl structure
+ *
+ * Return 0 if successful, otherwise -EINVAL.
+ */
+static int ioctl_enum_frameintervals(struct v4l2_int_device *s,
+                                         struct v4l2_frmivalenum *fival)
+{
+        int i, j, count = 0;
+
+        fival->type = V4L2_FRMIVAL_TYPE_DISCRETE;
+        fival->discrete.numerator = 1;
+
+        for (i = 0; i < ARRAY_SIZE(ov5640_mode_info_data); i++)
+                for (j = 0; j < (ov5640_mode_MAX + 1); j++)
+                        if (fival->pixel_format == ov5640_data.pix.pixelformat
+                         && fival->width == ov5640_mode_info_data[i][j].width
+                         && fival->height == ov5640_mode_info_data[i][j].height
+                         && ov5640_mode_info_data[i][j].init_data_ptr != NULL
+                         && fival->index == count++) {
+                                fival->discrete.denominator =
+                                                ov5640_framerates[i];
+                                return 0;
+                        }
+
+        return -EINVAL;
+}
+
+/*!
  * ioctl_g_chip_ident - V4L2 sensor interface handler for
  *                      VIDIOC_DBG_G_CHIP_IDENT ioctl
  * @s: pointer to standard V4L2 device structure
@@ -1913,6 +1949,8 @@ static struct v4l2_int_ioctl_desc ov5640_ioctl_desc[] = {
         {vidioc_int_s_ctrl_num, (v4l2_int_ioctl_func *) ioctl_s_ctrl},
         {vidioc_int_enum_framesizes_num,
                                 (v4l2_int_ioctl_func *) ioctl_enum_framesizes},
+        {vidioc_int_enum_frameintervals_num,
+                        (v4l2_int_ioctl_func *) ioctl_enum_frameintervals},
         {vidioc_int_g_chip_ident_num,
                                 (v4l2_int_ioctl_func *) ioctl_g_chip_ident},
 };