iio:pressure:ms5611: power regulator support

Add support for an optional regulator which, if found into device-tree,
will power on device at probing time.
The regulator is declared into ms5611 DTS entry as a "vdd-supply" property.

Signed-off-by: Gregor Boirie <gregor.boirie@parrot.com>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

diff --git a/drivers/iio/pressure/ms5611_core.c b/drivers/iio/pressure/ms5611_core.c
index acd8e37195bc6f07496590d8740aaed57101aeb9..992ad8d3b67ad7839c733b196830f8c97249201a 100644 (file)
--- a/drivers/iio/pressure/ms5611_core.c
+++ b/drivers/iio/pressure/ms5611_core.c
@@ -16,6 +16,7 @@
 #include <linux/module.h>
 #include <linux/iio/iio.h>
 #include <linux/delay.h>
+#include <linux/regulator/consumer.h>
 
 #include <linux/iio/buffer.h>
 #include <linux/iio/triggered_buffer.h>
@@ -290,6 +291,18 @@ static const struct iio_info ms5611_info = {
 static int ms5611_init(struct iio_dev *indio_dev)
 {
        int ret;
+       struct regulator *vdd = devm_regulator_get(indio_dev->dev.parent,
+                                                  "vdd");
+
+       /* Enable attached regulator if any. */
+       if (!IS_ERR(vdd)) {
+               ret = regulator_enable(vdd);
+               if (ret) {
+                       dev_err(indio_dev->dev.parent,
+                               "failed to enable Vdd supply: %d\n", ret);
+                       return ret;
+               }
+       }
 
        ret = ms5611_reset(indio_dev);
        if (ret < 0)