Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ed1f4b96 authored by Cédric Le Goater's avatar Cédric Le Goater Committed by Jacek Anaszewski
Browse files

leds: pca955x: add device tree support 



It will be used in a following patch to define different operation
modes for each pin.

Signed-off-by: default avatarCédric Le Goater <clg@kaod.org>
Acked-by: default avatarPavel Machek <pavel@ucw.cz>
Signed-off-by: default avatarJacek Anaszewski <jacek.anaszewski@gmail.com>
parent 0571753e

drivers/leds/leds-pca955x.c

+89 −12
Original line number Diff line number Diff line
@@ -41,14 +41,17 @@ 
 */



#include <linux/acpi.h>

#include <linux/module.h>

#include <linux/delay.h>

#include <linux/string.h>

#include <linux/ctype.h>

#include <linux/leds.h>

#include <linux/delay.h>

#include <linux/err.h>

#include <linux/gpio.h>

#include <linux/i2c.h>

#include <linux/leds.h>

#include <linux/module.h>

#include <linux/of_device.h>

#include <linux/of.h>

#include <linux/slab.h>

#include <linux/string.h>



/* LED select registers determine the source that drives LED outputs */

#define PCA955X_LS_LED_ON	0x0	/* Output LOW */
@@ -122,6 +125,12 @@ struct pca955x_led { 
	struct led_classdev	led_cdev;

	int			led_num;	/* 0 .. 15 potentially */

	char			name[32];

	const char		*default_trigger;

};



struct pca955x_platform_data {

	struct pca955x_led	*leds;

	int			num_leds;

};



/* 8 bits per input register */
@@ -250,6 +259,70 @@ static int pca955x_led_set(struct led_classdev *led_cdev, 
	return 0;

}



#if IS_ENABLED(CONFIG_OF)

static struct pca955x_platform_data *

pca955x_pdata_of_init(struct i2c_client *client, struct pca955x_chipdef *chip)

{

	struct device_node *np = client->dev.of_node;

	struct device_node *child;

	struct pca955x_platform_data *pdata;

	int count;



	count = of_get_child_count(np);

	if (!count || count > chip->bits)

		return ERR_PTR(-ENODEV);



	pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);

	if (!pdata)

		return ERR_PTR(-ENOMEM);



	pdata->leds = devm_kzalloc(&client->dev,

				   sizeof(struct pca955x_led) * chip->bits,

				   GFP_KERNEL);

	if (!pdata->leds)

		return ERR_PTR(-ENOMEM);



	for_each_child_of_node(np, child) {

		const char *name;

		u32 reg;

		int res;



		res = of_property_read_u32(child, "reg", &reg);

		if ((res != 0) || (reg >= chip->bits))

			continue;



		if (of_property_read_string(child, "label", &name))

			name = child->name;



		snprintf(pdata->leds[reg].name, sizeof(pdata->leds[reg].name),

			 "%s", name);



		of_property_read_string(child, "linux,default-trigger",

					&pdata->leds[reg].default_trigger);

	}



	pdata->num_leds = chip->bits;



	return pdata;

}



static const struct of_device_id of_pca955x_match[] = {

	{ .compatible = "nxp,pca9550", .data = (void *)pca9550 },

	{ .compatible = "nxp,pca9551", .data = (void *)pca9551 },

	{ .compatible = "nxp,pca9552", .data = (void *)pca9552 },

	{ .compatible = "nxp,pca9553", .data = (void *)pca9553 },

	{},

};



MODULE_DEVICE_TABLE(of, of_pca955x_match);

#else

static struct pca955x_platform_data *

pca955x_pdata_of_init(struct i2c_client *client, struct pca955x_chipdef *chip)

{

	return ERR_PTR(-ENODEV);

}

#endif



static int pca955x_probe(struct i2c_client *client,

					const struct i2c_device_id *id)

{
@@ -257,8 +330,8 @@ static int pca955x_probe(struct i2c_client *client, 
	struct pca955x_led *pca955x_led;

	struct pca955x_chipdef *chip;

	struct i2c_adapter *adapter;

	struct led_platform_data *pdata;

	int i, err;

	struct pca955x_platform_data *pdata;



	if (id) {

		chip = &pca955x_chipdefs[id->driver_data];
@@ -272,6 +345,11 @@ static int pca955x_probe(struct i2c_client *client, 
	}

	adapter = to_i2c_adapter(client->dev.parent);

	pdata = dev_get_platdata(&client->dev);

	if (!pdata) {

		pdata =	pca955x_pdata_of_init(client, chip);

		if (IS_ERR(pdata))

			return PTR_ERR(pdata);

	}



	/* Make sure the slave address / chip type combo given is possible */

	if ((client->addr & ~((1 << chip->slv_addr_shift) - 1)) !=
@@ -288,14 +366,12 @@ static int pca955x_probe(struct i2c_client *client, 
	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))

		return -EIO;



	if (pdata) {

	if (pdata->num_leds != chip->bits) {

			dev_err(&client->dev, "board info claims %d LEDs"

					" on a %d-bit chip\n",

		dev_err(&client->dev,

			"board info claims %d LEDs on a %d-bit chip\n",

			pdata->num_leds, chip->bits);

		return -ENODEV;

	}

	}



	pca955x = devm_kzalloc(&client->dev, sizeof(*pca955x), GFP_KERNEL);

	if (!pca955x)
@@ -378,6 +454,7 @@ static struct i2c_driver pca955x_driver = { 
	.driver = {

		.name	= "leds-pca955x",

		.acpi_match_table = ACPI_PTR(pca955x_acpi_ids),

		.of_match_table = of_match_ptr(of_pca955x_match),

	},

	.probe	= pca955x_probe,

	.remove	= pca955x_remove,