Add support to read the bus-type for V4L2_MBUS_BT656 and enable BT.656 mode in the sensor if needed.
Signed-off-by: Lad Prabhakar <[email protected]> Reviewed-by: Biju Das <[email protected]> --- drivers/media/i2c/ov772x.c | 19 +++++++++++++++++-- 1 file changed, 17 insertions(+), 2 deletions(-) diff --git a/drivers/media/i2c/ov772x.c b/drivers/media/i2c/ov772x.c index 4ab4b3c883d0..869f2d94faec 100644 --- a/drivers/media/i2c/ov772x.c +++ b/drivers/media/i2c/ov772x.c @@ -583,6 +583,13 @@ static int ov772x_s_stream(struct v4l2_subdev *sd, int enable) if (priv->streaming == enable) goto done; + if (priv->bus_type == V4L2_MBUS_BT656) { + ret = regmap_update_bits(priv->regmap, COM7, ITU656_ON_OFF, + enable ? ITU656_ON_OFF : ~ITU656_ON_OFF); + if (ret) + goto done; + } + ret = regmap_update_bits(priv->regmap, COM2, SOFT_SLEEP_MODE, enable ? 0 : SOFT_SLEEP_MODE); if (ret) @@ -1436,9 +1443,17 @@ static int ov772x_probe(struct i2c_client *client) ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); priv->bus_type = bus_cfg.bus_type; v4l2_fwnode_endpoint_free(&bus_cfg); + if (ret) { + bus_cfg = (struct v4l2_fwnode_endpoint) + { .bus_type = V4L2_MBUS_BT656 }; + ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); + if (ret) { + fwnode_handle_put(ep); + goto error_clk_put; + } + priv->bus_type = bus_cfg.bus_type; + } fwnode_handle_put(ep); - if (ret) - goto error_clk_put; ret = ov772x_video_probe(priv); if (ret < 0) -- 2.17.1
