From: Ondrej Jirman <[email protected]>

It was documented in DT, but not implemented.

Signed-off-by: Ondrej Jirman <[email protected]>
Signed-off-by: Luis Garcia <[email protected]>
Reviewed-by: Pavel Machek <[email protected]>
Reviewed-by: Tommaso Merciai <[email protected]>
---
 drivers/media/i2c/imx258.c | 16 +++++++++++++++-
 1 file changed, 15 insertions(+), 1 deletion(-)

diff --git a/drivers/media/i2c/imx258.c b/drivers/media/i2c/imx258.c
index f043200e336e..671fe176c64c 100644
--- a/drivers/media/i2c/imx258.c
+++ b/drivers/media/i2c/imx258.c
@@ -698,6 +698,8 @@ struct imx258 {
        unsigned int lane_mode_idx;
        unsigned int csi2_flags;
 
+       struct gpio_desc *reset_gpio;
+
        /*
         * Mutex for serialized access:
         * Protect sensor module set pad format and start/stop streaming safely.
@@ -1245,7 +1247,10 @@ static int imx258_power_on(struct device *dev)
                regulator_bulk_disable(IMX258_NUM_SUPPLIES, imx258->supplies);
        }
 
-       return ret;
+       gpiod_set_value_cansleep(imx258->reset_gpio, 0);
+       usleep_range(400, 500);
+
+       return 0;
 }
 
 static int imx258_power_off(struct device *dev)
@@ -1254,6 +1259,9 @@ static int imx258_power_off(struct device *dev)
        struct imx258 *imx258 = to_imx258(sd);
 
        clk_disable_unprepare(imx258->clk);
+
+       gpiod_set_value_cansleep(imx258->reset_gpio, 1);
+
        regulator_bulk_disable(IMX258_NUM_SUPPLIES, imx258->supplies);
 
        return 0;
@@ -1559,6 +1567,12 @@ static int imx258_probe(struct i2c_client *client)
        if (!imx258->variant_cfg)
                imx258->variant_cfg = &imx258_cfg;
 
+       /* request optional reset pin */
+       imx258->reset_gpio = devm_gpiod_get_optional(&client->dev, "reset",
+                                                    GPIOD_OUT_HIGH);
+       if (IS_ERR(imx258->reset_gpio))
+               return PTR_ERR(imx258->reset_gpio);
+
        /* Initialize subdev */
        v4l2_i2c_subdev_init(&imx258->sd, client, &imx258_subdev_ops);
 
-- 
2.44.0


Reply via email to