leandrof/linux
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

leds/tca6507: Add support for devicetree.

Browse Source 
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>
This commit is contained in:
Marek Belisko 2012-11-30 14:00:49 -08:00 committed by Bryan Wu
parent 88b62b915b
commit 0c596a7ebb
1 changed files with 72 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

70
drivers/leds/leds-tca6507.c
View File

@ -667,6 +667,70 @@ static void tca6507_remove_gpio(struct tca6507_chip *tca)
} }
#endif /* CONFIG_GPIOLIB */ #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, static int tca6507_probe(struct i2c_client *client,
const struct i2c_device_id *id) const struct i2c_device_id *id)
{ {
@ -683,9 +747,12 @@ static int tca6507_probe(struct i2c_client *client,
return -EIO; return -EIO;
if (!pdata || pdata->leds.num_leds != NUM_LEDS) { if (!pdata || pdata->leds.num_leds != NUM_LEDS) {
pdata = tca6507_led_dt_init(client);
if (IS_ERR(pdata)) {
dev_err(&client->dev, "Need %d entries in platform-data list\n", dev_err(&client->dev, "Need %d entries in platform-data list\n",
NUM_LEDS); NUM_LEDS);
return -ENODEV; return PTR_ERR(pdata);
}
} }
tca = devm_kzalloc(&client->dev, sizeof(*tca), GFP_KERNEL); tca = devm_kzalloc(&client->dev, sizeof(*tca), GFP_KERNEL);
if (!tca) if (!tca)
@ -750,6 +817,7 @@ static struct i2c_driver tca6507_driver = {
.driver = { .driver = {
.name = "leds-tca6507", .name = "leds-tca6507",
.owner = THIS_MODULE, .owner = THIS_MODULE,
.of_match_table = of_tca6507_leds_match,
}, },
.probe = tca6507_probe, .probe = tca6507_probe,
.remove = tca6507_remove, .remove = tca6507_remove,