[media] mt9p031: Add support for regulators

Enable the regulators when powering the sensor up, and disable them when
powering it down.
The regulators are mandatory. Boards that don't allow controlling the
sensor power lines must provide fixed voltage regulators.

Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

diff --git a/drivers/media/i2c/mt9p031.c b/drivers/media/i2c/mt9p031.c
index e0bad594c8da7e6e834b9a2f039ae639bab31adc..ecf4492c6b8ed4f8de74fce0ae8932255f864f9b 100644 (file)
--- a/drivers/media/i2c/mt9p031.c
+++ b/drivers/media/i2c/mt9p031.c
@@ -19,6 +19,7 @@
 #include <linux/i2c.h>
 #include <linux/log2.h>
 #include <linux/pm.h>
+#include <linux/regulator/consumer.h>
 #include <linux/slab.h>
 #include <linux/videodev2.h>
 
@@ -121,6 +122,10 @@ struct mt9p031 {
        struct mutex power_lock; /* lock to protect power_count */
        int power_count;
 
+       struct regulator *vaa;
+       struct regulator *vdd;
+       struct regulator *vdd_io;
+
        enum mt9p031_model model;
        struct aptina_pll pll;
        int reset;
@@ -264,6 +269,11 @@ static int mt9p031_power_on(struct mt9p031 *mt9p031)
                usleep_range(1000, 2000);
        }
 
+       /* Bring up the supplies */
+       regulator_enable(mt9p031->vdd);
+       regulator_enable(mt9p031->vdd_io);
+       regulator_enable(mt9p031->vaa);
+
        /* Emable clock */
        if (mt9p031->pdata->set_xclk)
                mt9p031->pdata->set_xclk(&mt9p031->subdev,
@@ -285,6 +295,10 @@ static void mt9p031_power_off(struct mt9p031 *mt9p031)
                usleep_range(1000, 2000);
        }
 
+       regulator_disable(mt9p031->vaa);
+       regulator_disable(mt9p031->vdd_io);
+       regulator_disable(mt9p031->vdd);
+
        if (mt9p031->pdata->set_xclk)
                mt9p031->pdata->set_xclk(&mt9p031->subdev, 0);
 }
@@ -937,6 +951,16 @@ static int mt9p031_probe(struct i2c_client *client,
        mt9p031->model = did->driver_data;
        mt9p031->reset = -1;
 
+       mt9p031->vaa = devm_regulator_get(&client->dev, "vaa");
+       mt9p031->vdd = devm_regulator_get(&client->dev, "vdd");
+       mt9p031->vdd_io = devm_regulator_get(&client->dev, "vdd_io");
+
+       if (IS_ERR(mt9p031->vaa) || IS_ERR(mt9p031->vdd) ||
+           IS_ERR(mt9p031->vdd_io)) {
+               dev_err(&client->dev, "Unable to get regulators\n");
+               return -ENODEV;
+       }
+
        v4l2_ctrl_handler_init(&mt9p031->ctrls, ARRAY_SIZE(mt9p031_ctrls) + 6);
 
        v4l2_ctrl_new_std(&mt9p031->ctrls, &mt9p031_ctrl_ops,