media: camss: use v4l2_get_link_freq() to calculate the relevant clocks

[linux-2.6-microblaze.git] / drivers / media / platform / qcom / camss / camss.c

diff --git a/drivers/media/platform/qcom/camss/camss.c b/drivers/media/platform/qcom/camss/camss.c
index 7c0f669..eb8fb8c 100644 (file)
--- a/drivers/media/platform/qcom/camss/camss.c
+++ b/drivers/media/platform/qcom/camss/camss.c
@@ -548,6 +548,29 @@ struct media_entity *camss_find_sensor(struct media_entity *entity)
        }
 }
 
+/**
+ * camss_get_link_freq - Get link frequency from sensor
+ * @entity: Media entity in the current pipeline
+ * @bpp: Number of bits per pixel for the current format
+ * @lanes: Number of lanes in the link to the sensor
+ *
+ * Return link frequency on success or a negative error code otherwise
+ */
+s64 camss_get_link_freq(struct media_entity *entity, unsigned int bpp,
+                       unsigned int lanes)
+{
+       struct media_entity *sensor;
+       struct v4l2_subdev *subdev;
+
+       sensor = camss_find_sensor(entity);
+       if (!sensor)
+               return -ENODEV;
+
+       subdev = media_entity_to_v4l2_subdev(sensor);
+
+       return v4l2_get_link_freq(subdev->ctrl_handler, bpp, 2 * lanes);
+}
+
 /*
  * camss_get_pixel_clock - Get pixel clock rate from sensor
  * @entity: Media entity in the current pipeline