Add devicetree based initialization support for TI tps65910 regulators.

Signed-off-by: Rhyland Klein <[email protected]>
---
 v2: split off regulator specific dt initialization
     made use of new function to match regulator nodes to names to fill in
       init_data

 drivers/regulator/tps65910-regulator.c |  106 ++++++++++++++++++++++++++++++++
 1 files changed, 106 insertions(+), 0 deletions(-)

diff --git a/drivers/regulator/tps65910-regulator.c 
b/drivers/regulator/tps65910-regulator.c
index 855bbec..519be51 100644
--- a/drivers/regulator/tps65910-regulator.c
+++ b/drivers/regulator/tps65910-regulator.c
@@ -24,6 +24,7 @@
 #include <linux/slab.h>
 #include <linux/gpio.h>
 #include <linux/mfd/tps65910.h>
+#include <linux/regulator/of_regulator.h>
 
 #define TPS65910_SUPPLY_STATE_ENABLED  0x1
 #define EXT_SLEEP_CONTROL (TPS65910_SLEEP_CONTROL_EXT_INPUT_EN1 |      \
@@ -1090,6 +1091,104 @@ static int tps65910_set_ext_sleep_config(struct 
tps65910_reg *pmic,
        return ret;
 }
 
+#ifdef CONFIG_OF
+
+static const char * const tps65910_reg_names[] = {
+       "VRTC",
+       "VIO",
+       "VDD1",
+       "VDD2",
+       "VDD3",
+       "VDIG1",
+       "VDIG2",
+       "VPLL",
+       "VDAC",
+       "VAUX1",
+       "VAUX2",
+       "VAUX33",
+       "VMMC",
+};
+
+static const char * const tps65911_reg_names[] = {
+       "VRTC",
+       "VIO",
+       "VDD1",
+       "VDD2",
+       "VDDCTRL",
+       "LDO1",
+       "LDO2",
+       "LDO3",
+       "LDO4",
+       "LDO5",
+       "LDO6",
+       "LDO7",
+       "LDO8",
+};
+
+static struct tps65910_board *tps65910_parse_dt_reg_data(
+                               struct platform_device *pdev)
+{
+       struct tps65910_board *pmic_plat_data;
+       struct tps65910 *tps65910 = dev_get_drvdata(pdev->dev.parent);
+       struct device_node *np = pdev->dev.parent->of_node;
+       struct device_node *regulators, *child;
+       unsigned int prop;
+       struct regulator_init_data **all_data;
+       int idx = 0, ret;
+
+       pmic_plat_data = devm_kzalloc(&pdev->dev, sizeof(*pmic_plat_data),
+                                       GFP_KERNEL);
+
+       if (!pmic_plat_data) {
+               dev_err(&pdev->dev, "Failure to alloc pdata for regulators.\n");
+               return NULL;
+       }
+
+       all_data = pmic_plat_data->tps65910_pmic_init_data;
+
+       regulators = of_find_node_by_name(np, "regulators");
+
+       switch (tps65910_chip_id(tps65910)) {
+       case TPS65910:
+               ret = of_find_regulator_init_data_from_device(pdev->dev.parent,
+                       regulators, tps65910_reg_names, all_data,
+                       ARRAY_SIZE(tps65910_reg_names));
+               break;
+       case TPS65911:
+               ret = of_find_regulator_init_data_from_device(pdev->dev.parent,
+                       regulators, tps65911_reg_names, all_data,
+                       ARRAY_SIZE(tps65911_reg_names));
+               break;
+       default:
+               pr_err("Invalid tps chip version\n");
+               return NULL;
+       }
+
+       if (ret) {
+               dev_err(&pdev->dev, "Error parsing regulator init data: %d\n",
+                       ret);
+               return NULL;
+       }
+
+       idx = 0;
+       for_each_child_of_node(regulators, child) {
+               ret = of_property_read_u32(child,
+                               "ti,regulator-ext-sleep-control", &prop);
+               if (!ret)
+                       pmic_plat_data->regulator_ext_sleep_control[idx] = prop;
+               idx++;
+       }
+
+       return pmic_plat_data;
+}
+#else
+static inline struct tps65910_board *tps65910_parse_dt_reg_data(
+                               struct platform_device *pdev)
+{
+       return 0;
+}
+#endif
+
 static __devinit int tps65910_probe(struct platform_device *pdev)
 {
        struct tps65910 *tps65910 = dev_get_drvdata(pdev->dev.parent);
@@ -1102,6 +1201,9 @@ static __devinit int tps65910_probe(struct 
platform_device *pdev)
        int i, err;
 
        pmic_plat_data = dev_get_platdata(tps65910->dev);
+       if (!pmic_plat_data && tps65910->dev->of_node)
+               pmic_plat_data = tps65910_parse_dt_reg_data(pdev);
+
        if (!pmic_plat_data)
                return -EINVAL;
 
@@ -1205,6 +1307,10 @@ static __devinit int tps65910_probe(struct 
platform_device *pdev)
                config.dev = tps65910->dev;
                config.init_data = reg_data;
                config.driver_data = pmic;
+#ifdef CONFIG_OF
+               config.of_node = of_find_node_by_name(tps65910->dev->of_node,
+                                                       info->name);
+#endif
 
                rdev = regulator_register(&pmic->desc[i], &config);
                if (IS_ERR(rdev)) {
-- 
1.7.0.4

_______________________________________________
devicetree-discuss mailing list
[email protected]
https://lists.ozlabs.org/listinfo/devicetree-discuss

Reply via email to