The light sensor's power supply could be controlled by regulator
on some platforms, such as i.MX6Q-SABRESD board, the light sensor
isl29023's power supply is controlled by a GPIO fixed regulator,
need to make sure the regulator is enabled before any operation of
sensor, this patch adds optional vdd/vdda regulator operation support.

Signed-off-by: Anson Huang <anson.hu...@nxp.com>
---
ChangeLog since V2:
    - Add defer_probe check if the return value from 
devm_regulator_get_optional is ERR_PTR(-EPROBE_DEFER);
    - Replace the "vcc" with "vdd" according to datasheet, and add optional 
"vdda" supply as well since
      isl29018 also has a vdda supply.
---
 drivers/iio/light/isl29018.c | 59 ++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 59 insertions(+)

diff --git a/drivers/iio/light/isl29018.c b/drivers/iio/light/isl29018.c
index b45400f..477eb95 100644
--- a/drivers/iio/light/isl29018.c
+++ b/drivers/iio/light/isl29018.c
@@ -23,6 +23,7 @@
 #include <linux/mutex.h>
 #include <linux/delay.h>
 #include <linux/regmap.h>
+#include <linux/regulator/consumer.h>
 #include <linux/slab.h>
 #include <linux/iio/iio.h>
 #include <linux/iio/sysfs.h>
@@ -95,6 +96,8 @@ struct isl29018_chip {
        struct isl29018_scale   scale;
        int                     prox_scheme;
        bool                    suspended;
+       struct regulator        *vdd_reg;
+       struct regulator        *vdda_reg;
 };
 
 static int isl29018_set_integration_time(struct isl29018_chip *chip,
@@ -735,6 +738,28 @@ static int isl29018_probe(struct i2c_client *client,
 
        mutex_init(&chip->lock);
 
+       chip->vdd_reg = devm_regulator_get_optional(&client->dev, "vdd");
+       if (!IS_ERR(chip->vdd_reg)) {
+               err = regulator_enable(chip->vdd_reg);
+               if (err) {
+                       dev_err(&client->dev, "failed to enable VDD 
regulator\n");
+                       return err;
+               }
+       } else if (chip->vdd_reg == ERR_PTR(-EPROBE_DEFER)) {
+               return -EPROBE_DEFER;
+       }
+
+       chip->vdda_reg = devm_regulator_get_optional(&client->dev, "vdda");
+       if (!IS_ERR(chip->vdda_reg)) {
+               err = regulator_enable(chip->vdda_reg);
+               if (err) {
+                       dev_err(&client->dev, "failed to enable VDDA 
regulator\n");
+                       return err;
+               }
+       } else if (chip->vdda_reg == ERR_PTR(-EPROBE_DEFER)) {
+               return -EPROBE_DEFER;
+       }
+
        chip->type = dev_id;
        chip->calibscale = 1;
        chip->ucalibscale = 0;
@@ -768,6 +793,7 @@ static int isl29018_probe(struct i2c_client *client,
 static int isl29018_suspend(struct device *dev)
 {
        struct isl29018_chip *chip = iio_priv(dev_get_drvdata(dev));
+       int ret;
 
        mutex_lock(&chip->lock);
 
@@ -777,6 +803,22 @@ static int isl29018_suspend(struct device *dev)
         * So we do not have much to do here.
         */
        chip->suspended = true;
+       if (!IS_ERR(chip->vdd_reg)) {
+               ret = regulator_disable(chip->vdd_reg);
+               if (ret) {
+                       dev_err(dev, "failed to disable VDD regulator\n");
+                       mutex_unlock(&chip->lock);
+                       return ret;
+               }
+       }
+       if (!IS_ERR(chip->vdda_reg)) {
+               ret = regulator_disable(chip->vdda_reg);
+               if (ret) {
+                       dev_err(dev, "failed to disable VDDA regulator\n");
+                       mutex_unlock(&chip->lock);
+                       return ret;
+               }
+       }
 
        mutex_unlock(&chip->lock);
 
@@ -790,6 +832,23 @@ static int isl29018_resume(struct device *dev)
 
        mutex_lock(&chip->lock);
 
+       if (!IS_ERR(chip->vdd_reg)) {
+               err = regulator_enable(chip->vdd_reg);
+               if (err) {
+                       dev_err(dev, "failed to enable VDD regulator\n");
+                       mutex_unlock(&chip->lock);
+                       return err;
+               }
+       }
+       if (!IS_ERR(chip->vdda_reg)) {
+               err = regulator_enable(chip->vdda_reg);
+               if (err) {
+                       dev_err(dev, "failed to enable VDDA regulator\n");
+                       mutex_unlock(&chip->lock);
+                       return err;
+               }
+       }
+
        err = isl29018_chip_init(chip);
        if (!err)
                chip->suspended = false;
-- 
2.7.4

Reply via email to