Commit 0c596a7e authored by Marek Belisko's avatar Marek Belisko Committed by Bryan Wu
Browse files

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: default avatarMarek Belisko <marek.belisko@open-nandra.com>
Signed-off-by: default avatarBryan Wu <cooloney@gmail.com>
parent 88b62b91

drivers/leds/leds-tca6507.c

+72 −4
Original line number Diff line number Diff line
@@ -667,6 +667,70 @@ 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)

{
@@ -683,9 +747,12 @@ static int tca6507_probe(struct i2c_client *client, 
		return -EIO;



	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",

				NUM_LEDS);

		return -ENODEV;

			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,