[PATCH 1/2] media: i2c: ov772x: Add support for BT656 mode

[Lad Prabhakar]

Add support to read the bus-type and enable BT656 mode if needed.

Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad...@bp.renesas.com>
Reviewed-by: Biju Das <biju.das...@bp.renesas.com>
---
 drivers/media/i2c/ov772x.c | 23 +++++++++++++++++++++--
 1 file changed, 21 insertions(+), 2 deletions(-)

diff --git a/drivers/media/i2c/ov772x.c b/drivers/media/i2c/ov772x.c
index 2cc6a67..3b7dfba 100644
--- a/drivers/media/i2c/ov772x.c
+++ b/drivers/media/i2c/ov772x.c
@@ -31,6 +31,7 @@
 #include <media/v4l2-ctrls.h>
 #include <media/v4l2-device.h>
 #include <media/v4l2-event.h>
+#include <media/v4l2-fwnode.h>
 #include <media/v4l2-image-sizes.h>
 #include <media/v4l2-subdev.h>
 
@@ -434,6 +435,7 @@ struct ov772x_priv {
 #ifdef CONFIG_MEDIA_CONTROLLER
        struct media_pad pad;
 #endif
+       struct v4l2_fwnode_endpoint ep;
 };
 
 /*
@@ -585,7 +587,6 @@ static int ov772x_s_stream(struct v4l2_subdev *sd, int 
enable)
                                 enable ? 0 : SOFT_SLEEP_MODE);
        if (ret)
                goto done;
-
        if (enable) {
                dev_dbg(&client->dev, "format %d, win %s\n",
                        priv->cfmt->code, priv->win->name);
@@ -1104,7 +1105,10 @@ static int ov772x_set_params(struct ov772x_priv *priv,
                goto ov772x_set_fmt_error;
 
        /* COM7: Sensor resolution and output format control. */
-       ret = regmap_write(priv->regmap, COM7, win->com7_bit | cfmt->com7);
+       val = win->com7_bit | cfmt->com7;
+       if (priv->ep.bus_type == V4L2_MBUS_BT656)
+               val |= ITU656_ON_OFF;
+       ret = regmap_write(priv->regmap, COM7, val);
        if (ret < 0)
                goto ov772x_set_fmt_error;
 
@@ -1354,6 +1358,7 @@ static const struct v4l2_subdev_ops ov772x_subdev_ops = {
 
 static int ov772x_probe(struct i2c_client *client)
 {
+       struct fwnode_handle *endpoint;
        struct ov772x_priv      *priv;
        int                     ret;
        static const struct regmap_config ov772x_regmap_config = {
@@ -1415,6 +1420,20 @@ static int ov772x_probe(struct i2c_client *client)
                goto error_clk_put;
        }
 
+       endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(&client->dev),
+                                                 NULL);
+       if (!endpoint) {
+               dev_err(&client->dev, "endpoint node not found\n");
+               goto error_clk_put;
+       }
+
+       ret = v4l2_fwnode_endpoint_parse(endpoint, &priv->ep);
+       fwnode_handle_put(endpoint);
+       if (ret) {
+               dev_err(&client->dev, "Could not parse endpoint\n");
+               goto error_clk_put;
+       }
+
        ret = ov772x_video_probe(priv);
        if (ret < 0)
                goto error_gpio_put;
-- 
2.7.4