From: Marek Belisko <marek.beli...@gmail.com>

Signed-off-by: Marek Belisko <marek.beli...@gmail.com>
---
 drivers/power/supply/generic-adc-battery.c | 68 ++++++++++++++++++++++++++++++
 1 file changed, 68 insertions(+)

diff --git a/drivers/power/supply/generic-adc-battery.c 
b/drivers/power/supply/generic-adc-battery.c
index b5e9208..d4daa6a 100644
--- a/drivers/power/supply/generic-adc-battery.c
+++ b/drivers/power/supply/generic-adc-battery.c
@@ -23,6 +23,7 @@
 #include <linux/iio/consumer.h>
 #include <linux/iio/types.h>
 #include <linux/power/generic-adc-battery.h>
+#include <linux/of_gpio.h>
 
 #define JITTER_DEFAULT 10 /* hope 10ms is enough */
 
@@ -241,6 +242,69 @@ static irqreturn_t gab_charged(int irq, void *dev_id)
        return IRQ_HANDLED;
 }
 
+#ifdef CONFIG_OF
+static struct gab_platform_data *gab_dt_probe(struct platform_device *pdev)
+{
+       struct gab_platform_data *pdata;
+       struct device_node *np = pdev->dev.of_node;
+       const char *name;
+       u32 val;
+       int err;
+
+       pdata = devm_kzalloc(&pdev->dev,
+                       sizeof(struct gab_platform_data),
+                       GFP_KERNEL);
+       if (!pdata)
+               return ERR_PTR(-ENOMEM);
+
+       pdata->gpio_charge_finished  = of_get_gpio(np, 0);
+
+       /* parse and fill power_supply_info struct */
+       err = of_property_read_u32(np, "technology", &val);
+       if (err) {
+               dev_info(&pdev->dev, "Battery technology unknown\n");
+               val = 0;
+       }
+       pdata->battery_info.technology = val;
+
+       err = of_property_read_string(np, "battery-name", &name);
+       if (err) {
+               dev_info(&pdev->dev, "Battery name empty, setting default\n");
+       }
+       pdata->battery_info.name = name;
+
+       val = 0;
+       err = of_property_read_u32(np, "charge_empty_design", &val);
+       pdata->battery_info.charge_empty_design = val;
+
+       val = 0;
+       err = of_property_read_u32(np, "charge_full_design", &val);
+       pdata->battery_info.charge_full_design = val;
+
+       val = 0;
+       err = of_property_read_u32(np, "voltage_min_design", &val);
+       pdata->battery_info.voltage_min_design = val;
+
+       val = 0;
+       err = of_property_read_u32(np, "voltage_max-design", &val);
+       pdata->battery_info.voltage_max_design = val;
+
+       return pdata;
+}
+
+static const struct of_device_id of_gab_match[] = {
+       { .compatible = "linux,generic-adc-battery", },
+       {},
+};
+MODULE_DEVICE_TABLE(of, of_gab_match);
+
+#else
+static struct gab_platform_data gab_dt_probe(struct platform_device *pdev)
+{
+       ERR_PTR(-ENODEV);
+}
+#endif
+
 static int gab_probe(struct platform_device *pdev)
 {
        struct gab *adc_bat;
@@ -258,6 +322,9 @@ static int gab_probe(struct platform_device *pdev)
                return -ENOMEM;
        }
 
+       if (pdata == NULL)
+               pdata = gab_dt_probe(pdev);
+
        psy_cfg.drv_data = adc_bat;
        psy_desc = &adc_bat->psy_desc;
        psy_desc->name = "generic-adc-batt";//pdata->battery_info.name;
@@ -418,6 +485,7 @@ static struct platform_driver gab_driver = {
        .driver         = {
                .name   = "generic-adc-battery",
                .pm     = &gab_pm_ops,
+               .of_match_table = of_gab_match,
        },
        .probe          = gab_probe,
        .remove         = gab_remove,
-- 
2.7.4

Reply via email to