[media] V4L: mx1_camera: convert to the new mbus-config subdev operations
authorGuennadi Liakhovetski <g.liakhovetski@gmx.de>
Wed, 27 Jul 2011 15:30:21 +0000 (12:30 -0300)
committerMauro Carvalho Chehab <mchehab@redhat.com>
Thu, 3 Nov 2011 20:27:43 +0000 (18:27 -0200)
Switch from soc-camera specific .{query,set}_bus_param() to V4L2
subdevice .[gs]_mbus_config() operations.

Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
drivers/media/video/mx1_camera.c

index 087db12a3a678eed5ef67f2b273746828da10d91..18e94c7d2be83e1668bdf6c6664ed50907761d40 100644 (file)
 #define CSI_IRQ_MASK   (CSISR_SFF_OR_INT | CSISR_RFF_OR_INT | \
                        CSISR_STATFF_INT | CSISR_RXFF_INT | CSISR_SOF_INT)
 
-#define CSI_BUS_FLAGS  (SOCAM_MASTER | SOCAM_HSYNC_ACTIVE_HIGH | \
-                       SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_LOW | \
-                       SOCAM_PCLK_SAMPLE_RISING | SOCAM_PCLK_SAMPLE_FALLING | \
-                       SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATA_ACTIVE_LOW | \
-                       SOCAM_DATAWIDTH_8)
+#define CSI_BUS_FLAGS  (V4L2_MBUS_MASTER | V4L2_MBUS_HSYNC_ACTIVE_HIGH | \
+                       V4L2_MBUS_VSYNC_ACTIVE_HIGH | V4L2_MBUS_VSYNC_ACTIVE_LOW | \
+                       V4L2_MBUS_PCLK_SAMPLE_RISING | V4L2_MBUS_PCLK_SAMPLE_FALLING | \
+                       V4L2_MBUS_DATA_ACTIVE_HIGH | V4L2_MBUS_DATA_ACTIVE_LOW)
 
 #define MAX_VIDEO_MEM 16       /* Video memory limit in megabytes */
 
@@ -490,59 +489,73 @@ static int mx1_camera_set_crop(struct soc_camera_device *icd,
 
 static int mx1_camera_set_bus_param(struct soc_camera_device *icd, __u32 pixfmt)
 {
+       struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
        struct soc_camera_host *ici = to_soc_camera_host(icd->parent);
        struct mx1_camera_dev *pcdev = ici->priv;
-       unsigned long camera_flags, common_flags;
+       struct v4l2_mbus_config cfg = {.type = V4L2_MBUS_PARALLEL,};
+       unsigned long common_flags;
        unsigned int csicr1;
        int ret;
 
-       camera_flags = icd->ops->query_bus_param(icd);
-
        /* MX1 supports only 8bit buswidth */
-       common_flags = soc_camera_bus_param_compatible(camera_flags,
-                                                      CSI_BUS_FLAGS);
-       if (!common_flags)
-               return -EINVAL;
+       ret = v4l2_subdev_call(sd, video, g_mbus_config, &cfg);
+       if (!ret) {
+               common_flags = soc_mbus_config_compatible(&cfg, CSI_BUS_FLAGS);
+               if (!common_flags) {
+                       dev_warn(icd->parent,
+                                "Flags incompatible: camera 0x%x, host 0x%x\n",
+                                cfg.flags, CSI_BUS_FLAGS);
+                       return -EINVAL;
+               }
+       } else if (ret != -ENOIOCTLCMD) {
+               return ret;
+       } else {
+               common_flags = CSI_BUS_FLAGS;
+       }
 
        /* Make choises, based on platform choice */
-       if ((common_flags & SOCAM_VSYNC_ACTIVE_HIGH) &&
-               (common_flags & SOCAM_VSYNC_ACTIVE_LOW)) {
+       if ((common_flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH) &&
+               (common_flags & V4L2_MBUS_VSYNC_ACTIVE_LOW)) {
                        if (!pcdev->pdata ||
                             pcdev->pdata->flags & MX1_CAMERA_VSYNC_HIGH)
-                               common_flags &= ~SOCAM_VSYNC_ACTIVE_LOW;
+                               common_flags &= ~V4L2_MBUS_VSYNC_ACTIVE_LOW;
                        else
-                               common_flags &= ~SOCAM_VSYNC_ACTIVE_HIGH;
+                               common_flags &= ~V4L2_MBUS_VSYNC_ACTIVE_HIGH;
        }
 
-       if ((common_flags & SOCAM_PCLK_SAMPLE_RISING) &&
-               (common_flags & SOCAM_PCLK_SAMPLE_FALLING)) {
+       if ((common_flags & V4L2_MBUS_PCLK_SAMPLE_RISING) &&
+               (common_flags & V4L2_MBUS_PCLK_SAMPLE_FALLING)) {
                        if (!pcdev->pdata ||
                             pcdev->pdata->flags & MX1_CAMERA_PCLK_RISING)
-                               common_flags &= ~SOCAM_PCLK_SAMPLE_FALLING;
+                               common_flags &= ~V4L2_MBUS_PCLK_SAMPLE_FALLING;
                        else
-                               common_flags &= ~SOCAM_PCLK_SAMPLE_RISING;
+                               common_flags &= ~V4L2_MBUS_PCLK_SAMPLE_RISING;
        }
 
-       if ((common_flags & SOCAM_DATA_ACTIVE_HIGH) &&
-               (common_flags & SOCAM_DATA_ACTIVE_LOW)) {
+       if ((common_flags & V4L2_MBUS_DATA_ACTIVE_HIGH) &&
+               (common_flags & V4L2_MBUS_DATA_ACTIVE_LOW)) {
                        if (!pcdev->pdata ||
                             pcdev->pdata->flags & MX1_CAMERA_DATA_HIGH)
-                               common_flags &= ~SOCAM_DATA_ACTIVE_LOW;
+                               common_flags &= ~V4L2_MBUS_DATA_ACTIVE_LOW;
                        else
-                               common_flags &= ~SOCAM_DATA_ACTIVE_HIGH;
+                               common_flags &= ~V4L2_MBUS_DATA_ACTIVE_HIGH;
        }
 
-       ret = icd->ops->set_bus_param(icd, common_flags);
-       if (ret < 0)
+       cfg.flags = common_flags;
+       ret = v4l2_subdev_call(sd, video, s_mbus_config, &cfg);
+       if (ret < 0 && ret != -ENOIOCTLCMD) {
+               dev_dbg(icd->parent, "camera s_mbus_config(0x%lx) returned %d\n",
+                       common_flags, ret);
                return ret;
+       }
 
        csicr1 = __raw_readl(pcdev->base + CSICR1);
 
-       if (common_flags & SOCAM_PCLK_SAMPLE_RISING)
+       if (common_flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
                csicr1 |= CSICR1_REDGE;
-       if (common_flags & SOCAM_VSYNC_ACTIVE_HIGH)
+       if (common_flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH)
                csicr1 |= CSICR1_SOF_POL;
-       if (common_flags & SOCAM_DATA_ACTIVE_LOW)
+       if (common_flags & V4L2_MBUS_DATA_ACTIVE_LOW)
                csicr1 |= CSICR1_DATA_POL;
 
        __raw_writel(csicr1, pcdev->base + CSICR1);