leds/tca6507: Add support for devicetree.

Support added only for leds (not for gpio's).

(cooloney@gmail.com: fix 2 building errors)

Signed-off-by: Marek Belisko <marek.belisko@open-nandra.com>
Signed-off-by: Bryan Wu <cooloney@gmail.com>

1 files changed, 72 insertions, 4 deletions

diff --git a/drivers/leds/leds-tca6507.c b/drivers/leds/leds-tca6507.c
index b26a63bae16b..220fc7fbf1f0 100644
--- a/drivers/leds/leds-tca6507.c
+++ b/drivers/leds/leds-tca6507.c
@@ -667,8 +667,72 @@ static void tca6507_remove_gpio(struct tca6507_chip *tca)
 }
 #endif /* CONFIG_GPIOLIB */
 
+#ifdef CONFIG_OF
+static struct tca6507_platform_data *
+tca6507_led_dt_init(struct i2c_client *client)
+{
+        struct device_node *np = client->dev.of_node, *child;
+        struct tca6507_platform_data *pdata;
+        struct led_info *tca_leds;
+        int count = 0;
+
+        for_each_child_of_node(np, child)
+                count++;
+        if (!count)
+                return ERR_PTR(-ENODEV);
+
+        if (count > NUM_LEDS)
+                return ERR_PTR(-ENODEV);
+
+        tca_leds = devm_kzalloc(&client->dev,
+                        sizeof(struct led_info) * count, GFP_KERNEL);
+        if (!tca_leds)
+                return ERR_PTR(-ENOMEM);
+
+        for_each_child_of_node(np, child) {
+                struct led_info led;
+                u32 reg;
+                int ret;
+
+                led.name =
+                        of_get_property(child, "label", NULL) ? : child->name;
+                led.default_trigger =
+                        of_get_property(child, "linux,default-trigger", NULL);
+
+                ret = of_property_read_u32(child, "reg", &reg);
+                if (ret != 0)
+                        continue;
+
+                tca_leds[reg] = led;
+        }
+        pdata = devm_kzalloc(&client->dev,
+                        sizeof(struct tca6507_platform_data), GFP_KERNEL);
+        if (!pdata)
+                return ERR_PTR(-ENOMEM);
+
+        pdata->leds.leds = tca_leds;
+        pdata->leds.num_leds = count;
+
+        return pdata;
+}
+
+static const struct of_device_id of_tca6507_leds_match[] = {
+        { .compatible = "ti,tca6507", },
+        {},
+};
+
+#else
+static struct tca6507_platform_data *
+tca6507_led_dt_init(struct i2c_client *client)
+{
+        return ERR_PTR(-ENODEV);
+}
+
+#define of_tca6507_leds_match NULL
+#endif
+
 static int tca6507_probe(struct i2c_client *client,
-                                   const struct i2c_device_id *id)
+                const struct i2c_device_id *id)
 {
         struct tca6507_chip *tca;
         struct i2c_adapter *adapter;
@@ -683,9 +747,12 @@ static int tca6507_probe(struct i2c_client *client,
                 return -EIO;
 
         if (!pdata || pdata->leds.num_leds != NUM_LEDS) {
-                dev_err(&client->dev, "Need %d entries in platform-data list\n",
-                        NUM_LEDS);
-                return -ENODEV;
+                pdata = tca6507_led_dt_init(client);
+                if (IS_ERR(pdata)) {
+                        dev_err(&client->dev, "Need %d entries in platform-data list\n",
+                                NUM_LEDS);
+                        return PTR_ERR(pdata);
+                }
         }
         tca = devm_kzalloc(&client->dev, sizeof(*tca), GFP_KERNEL);
         if (!tca)
@@ -750,6 +817,7 @@ static struct i2c_driver tca6507_driver = {
         .driver   = {
                 .name    = "leds-tca6507",
                 .owner   = THIS_MODULE,
+                .of_match_table = of_tca6507_leds_match,
         },
         .probe    = tca6507_probe,
         .remove   = tca6507_remove,