[linux-2.6-block.git] / drivers / leds / leds-tlc591xx.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright 2014 Belkin Inc.
 * Copyright 2015 Andrew Lunn <andrew@lunn.ch>
 */

#include <linux/i2c.h>
#include <linux/leds.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/regmap.h>
#include <linux/slab.h>

#define TLC591XX_MAX_LEDS	16
#define TLC591XX_MAX_BRIGHTNESS	256

#define TLC591XX_REG_MODE1	0x00
#define MODE1_RESPON_ADDR_MASK	0xF0
#define MODE1_NORMAL_MODE	(0 << 4)
#define MODE1_SPEED_MODE	(1 << 4)

#define TLC591XX_REG_MODE2	0x01
#define MODE2_DIM		(0 << 5)
#define MODE2_BLINK		(1 << 5)
#define MODE2_OCH_STOP		(0 << 3)
#define MODE2_OCH_ACK		(1 << 3)

#define TLC591XX_REG_PWM(x)	(0x02 + (x))

#define TLC591XX_REG_GRPPWM	0x12
#define TLC591XX_REG_GRPFREQ	0x13

/* LED Driver Output State, determine the source that drives LED outputs */
#define LEDOUT_OFF		0x0	/* Output LOW */
#define LEDOUT_ON		0x1	/* Output HI-Z */
#define LEDOUT_DIM		0x2	/* Dimming */
#define LEDOUT_BLINK		0x3	/* Blinking */
#define LEDOUT_MASK		0x3

#define ldev_to_led(c)		container_of(c, struct tlc591xx_led, ldev)

struct tlc591xx_led {
	bool active;
	unsigned int led_no;
	struct led_classdev ldev;
	struct tlc591xx_priv *priv;
};

struct tlc591xx_priv {
	struct tlc591xx_led leds[TLC591XX_MAX_LEDS];
	struct regmap *regmap;
	unsigned int reg_ledout_offset;
};

struct tlc591xx {
	unsigned int max_leds;
	unsigned int reg_ledout_offset;
};

static const struct tlc591xx tlc59116 = {
	.max_leds = 16,
	.reg_ledout_offset = 0x14,
};

static const struct tlc591xx tlc59108 = {
	.max_leds = 8,
	.reg_ledout_offset = 0x0c,
};

static int
tlc591xx_set_mode(struct regmap *regmap, u8 mode)
{
	int err;
	u8 val;

	err = regmap_write(regmap, TLC591XX_REG_MODE1, MODE1_NORMAL_MODE);
	if (err)
		return err;

	val = MODE2_OCH_STOP | mode;

	return regmap_write(regmap, TLC591XX_REG_MODE2, val);
}

static int
tlc591xx_set_ledout(struct tlc591xx_priv *priv, struct tlc591xx_led *led,
		    u8 val)
{
	unsigned int i = (led->led_no % 4) * 2;
	unsigned int mask = LEDOUT_MASK << i;
	unsigned int addr = priv->reg_ledout_offset + (led->led_no >> 2);

	val = val << i;

	return regmap_update_bits(priv->regmap, addr, mask, val);
}

static int
tlc591xx_set_pwm(struct tlc591xx_priv *priv, struct tlc591xx_led *led,
		 u8 brightness)
{
	u8 pwm = TLC591XX_REG_PWM(led->led_no);

	return regmap_write(priv->regmap, pwm, brightness);
}

static int
tlc591xx_brightness_set(struct led_classdev *led_cdev,
			enum led_brightness brightness)
{
	struct tlc591xx_led *led = ldev_to_led(led_cdev);
	struct tlc591xx_priv *priv = led->priv;
	int err;

	switch ((int)brightness) {
	case 0:
		err = tlc591xx_set_ledout(priv, led, LEDOUT_OFF);
		break;
	case TLC591XX_MAX_BRIGHTNESS:
		err = tlc591xx_set_ledout(priv, led, LEDOUT_ON);
		break;
	default:
		err = tlc591xx_set_ledout(priv, led, LEDOUT_DIM);
		if (!err)
			err = tlc591xx_set_pwm(priv, led, brightness);
	}

	return err;
}

static const struct regmap_config tlc591xx_regmap = {
	.reg_bits = 8,
	.val_bits = 8,
	.max_register = 0x1e,
};

static const struct of_device_id of_tlc591xx_leds_match[] = {
	{ .compatible = "ti,tlc59116",
	  .data = &tlc59116 },
	{ .compatible = "ti,tlc59108",
	  .data = &tlc59108 },
	{},
};
MODULE_DEVICE_TABLE(of, of_tlc591xx_leds_match);

static int
tlc591xx_probe(struct i2c_client *client)
{
	struct device_node *np, *child;
	struct device *dev = &client->dev;
	const struct tlc591xx *tlc591xx;
	struct tlc591xx_priv *priv;
	int err, count, reg;

	np = dev_of_node(dev);
	if (!np)
		return -ENODEV;

	tlc591xx = device_get_match_data(dev);
	if (!tlc591xx)
		return -ENODEV;

	count = of_get_available_child_count(np);
	if (!count || count > tlc591xx->max_leds)
		return -EINVAL;

	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	priv->regmap = devm_regmap_init_i2c(client, &tlc591xx_regmap);
	if (IS_ERR(priv->regmap)) {
		err = PTR_ERR(priv->regmap);
		dev_err(dev, "Failed to allocate register map: %d\n", err);
		return err;
	}
	priv->reg_ledout_offset = tlc591xx->reg_ledout_offset;

	i2c_set_clientdata(client, priv);

	err = tlc591xx_set_mode(priv->regmap, MODE2_DIM);
	if (err < 0)
		return err;

	for_each_available_child_of_node(np, child) {
		struct tlc591xx_led *led;
		struct led_init_data init_data = {};

		init_data.fwnode = of_fwnode_handle(child);

		err = of_property_read_u32(child, "reg", &reg);
		if (err) {
			of_node_put(child);
			return err;
		}
		if (reg < 0 || reg >= tlc591xx->max_leds ||
		    priv->leds[reg].active) {
			of_node_put(child);
			return -EINVAL;
		}
		led = &priv->leds[reg];

		led->active = true;
		led->priv = priv;
		led->led_no = reg;
		led->ldev.brightness_set_blocking = tlc591xx_brightness_set;
		led->ldev.max_brightness = TLC591XX_MAX_BRIGHTNESS;
		err = devm_led_classdev_register_ext(dev, &led->ldev,
						     &init_data);
		if (err < 0) {
			of_node_put(child);
			return dev_err_probe(dev, err,
					     "couldn't register LED %s\n",
					     led->ldev.name);
		}
	}
	return 0;
}

static const struct i2c_device_id tlc591xx_id[] = {
	{ "tlc59116" },
	{ "tlc59108" },
	{},
};
MODULE_DEVICE_TABLE(i2c, tlc591xx_id);

static struct i2c_driver tlc591xx_driver = {
	.driver = {
		.name = "tlc591xx",
		.of_match_table = of_match_ptr(of_tlc591xx_leds_match),
	},
	.probe_new = tlc591xx_probe,
	.id_table = tlc591xx_id,
};

module_i2c_driver(tlc591xx_driver);

MODULE_AUTHOR("Andrew Lunn <andrew@lunn.ch>");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("TLC591XX LED driver");
Commit	Line	Data
b886d83c	1	// SPDX-License-Identifier: GPL-2.0-only
e370d010 AL	2	/*
	3	* Copyright 2014 Belkin Inc.
	4	* Copyright 2015 Andrew Lunn <andrew@lunn.ch>
e370d010 AL	5	*/
	6
	7	#include <linux/i2c.h>
	8	#include <linux/leds.h>
	9	#include <linux/module.h>
	10	#include <linux/of.h>
	11	#include <linux/of_device.h>
	12	#include <linux/regmap.h>
	13	#include <linux/slab.h>
e370d010 AL	14
e370d010 AL	15	#define TLC591XX_MAX_LEDS 16
a2cafdfd	16	#define TLC591XX_MAX_BRIGHTNESS 256
e370d010 AL	17
	18	#define TLC591XX_REG_MODE1 0x00
	19	#define MODE1_RESPON_ADDR_MASK 0xF0
	20	#define MODE1_NORMAL_MODE (0 << 4)
	21	#define MODE1_SPEED_MODE (1 << 4)
	22
	23	#define TLC591XX_REG_MODE2 0x01
	24	#define MODE2_DIM (0 << 5)
	25	#define MODE2_BLINK (1 << 5)
	26	#define MODE2_OCH_STOP (0 << 3)
	27	#define MODE2_OCH_ACK (1 << 3)
	28
	29	#define TLC591XX_REG_PWM(x) (0x02 + (x))
	30
	31	#define TLC591XX_REG_GRPPWM 0x12
	32	#define TLC591XX_REG_GRPFREQ 0x13
	33
	34	/* LED Driver Output State, determine the source that drives LED outputs */
	35	#define LEDOUT_OFF 0x0 /* Output LOW */
	36	#define LEDOUT_ON 0x1 /* Output HI-Z */
	37	#define LEDOUT_DIM 0x2 /* Dimming */
	38	#define LEDOUT_BLINK 0x3 /* Blinking */
	39	#define LEDOUT_MASK 0x3
	40
	41	#define ldev_to_led(c) container_of(c, struct tlc591xx_led, ldev)
e370d010 AL	42
	43	struct tlc591xx_led {
	44	bool active;
	45	unsigned int led_no;
	46	struct led_classdev ldev;
e370d010 AL	47	struct tlc591xx_priv *priv;
	48	};
	49
	50	struct tlc591xx_priv {
	51	struct tlc591xx_led leds[TLC591XX_MAX_LEDS];
	52	struct regmap *regmap;
	53	unsigned int reg_ledout_offset;
	54	};
	55
	56	struct tlc591xx {
	57	unsigned int max_leds;
	58	unsigned int reg_ledout_offset;
	59	};
	60
	61	static const struct tlc591xx tlc59116 = {
	62	.max_leds = 16,
	63	.reg_ledout_offset = 0x14,
	64	};
	65
	66	static const struct tlc591xx tlc59108 = {
	67	.max_leds = 8,
	68	.reg_ledout_offset = 0x0c,
	69	};
	70
	71	static int
	72	tlc591xx_set_mode(struct regmap *regmap, u8 mode)
	73	{
	74	int err;
	75	u8 val;
	76
	77	err = regmap_write(regmap, TLC591XX_REG_MODE1, MODE1_NORMAL_MODE);
	78	if (err)
	79	return err;
	80
	81	val = MODE2_OCH_STOP \| mode;
	82
	83	return regmap_write(regmap, TLC591XX_REG_MODE2, val);
	84	}
	85
	86	static int
	87	tlc591xx_set_ledout(struct tlc591xx_priv priv, struct tlc591xx_led led,
	88	u8 val)
	89	{
	90	unsigned int i = (led->led_no % 4) * 2;
	91	unsigned int mask = LEDOUT_MASK << i;
	92	unsigned int addr = priv->reg_ledout_offset + (led->led_no >> 2);
	93
	94	val = val << i;
	95
	96	return regmap_update_bits(priv->regmap, addr, mask, val);
	97	}
	98
	99	static int
	100	tlc591xx_set_pwm(struct tlc591xx_priv priv, struct tlc591xx_led led,
	101	u8 brightness)
	102	{
	103	u8 pwm = TLC591XX_REG_PWM(led->led_no);
	104
	105	return regmap_write(priv->regmap, pwm, brightness);
	106	}
	107
d890389f AL	108	static int
	109	tlc591xx_brightness_set(struct led_classdev *led_cdev,
	110	enum led_brightness brightness)
e370d010	111	{
d890389f	112	struct tlc591xx_led *led = ldev_to_led(led_cdev);
e370d010	113	struct tlc591xx_priv *priv = led->priv;
e370d010 AL	114	int err;
e370d010 AL	115
a2cafdfd	116	switch ((int)brightness) {
e370d010 AL	117	case 0:
	118	err = tlc591xx_set_ledout(priv, led, LEDOUT_OFF);
	119	break;
a2cafdfd	120	case TLC591XX_MAX_BRIGHTNESS:
e370d010 AL	121	err = tlc591xx_set_ledout(priv, led, LEDOUT_ON);
	122	break;
	123	default:
	124	err = tlc591xx_set_ledout(priv, led, LEDOUT_DIM);
	125	if (!err)
	126	err = tlc591xx_set_pwm(priv, led, brightness);
	127	}
	128
d890389f	129	return err;
e370d010 AL	130	}
e370d010 AL	131
e370d010 AL	132	static const struct regmap_config tlc591xx_regmap = {
	133	.reg_bits = 8,
	134	.val_bits = 8,
	135	.max_register = 0x1e,
	136	};
	137
	138	static const struct of_device_id of_tlc591xx_leds_match[] = {
	139	{ .compatible = "ti,tlc59116",
	140	.data = &tlc59116 },
	141	{ .compatible = "ti,tlc59108",
	142	.data = &tlc59108 },
	143	{},
	144	};
	145	MODULE_DEVICE_TABLE(of, of_tlc591xx_leds_match);
	146
	147	static int
cef9efd5	148	tlc591xx_probe(struct i2c_client *client)
e370d010	149	{
ee522bcf	150	struct device_node np, child;
e370d010	151	struct device *dev = &client->dev;
e370d010 AL	152	const struct tlc591xx *tlc591xx;
	153	struct tlc591xx_priv *priv;
	154	int err, count, reg;
	155
ee522bcf	156	np = dev_of_node(dev);
e370d010 AL	157	if (!np)
	158	return -ENODEV;
	159
ee522bcf YY	160	tlc591xx = device_get_match_data(dev);
	161	if (!tlc591xx)
	162	return -ENODEV;
	163
99a013c8	164	count = of_get_available_child_count(np);
e370d010 AL	165	if (!count \|\| count > tlc591xx->max_leds)
	166	return -EINVAL;
	167
e370d010 AL	168	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	169	if (!priv)
	170	return -ENOMEM;
	171
	172	priv->regmap = devm_regmap_init_i2c(client, &tlc591xx_regmap);
	173	if (IS_ERR(priv->regmap)) {
	174	err = PTR_ERR(priv->regmap);
	175	dev_err(dev, "Failed to allocate register map: %d\n", err);
	176	return err;
	177	}
	178	priv->reg_ledout_offset = tlc591xx->reg_ledout_offset;
	179
	180	i2c_set_clientdata(client, priv);
	181
1ab4531a JJH	182	err = tlc591xx_set_mode(priv->regmap, MODE2_DIM);
	183	if (err < 0)
	184	return err;
	185
99a013c8	186	for_each_available_child_of_node(np, child) {
1ab4531a	187	struct tlc591xx_led *led;
5b4b723c JJH	188	struct led_init_data init_data = {};
	189
	190	init_data.fwnode = of_fwnode_handle(child);
1ab4531a	191
e370d010	192	err = of_property_read_u32(child, "reg", &reg);
c6872911 JL	193	if (err) {
c6872911 JL	194	of_node_put(child);
e370d010	195	return err;
c6872911	196	}
1055790b	197	if (reg < 0 \|\| reg >= tlc591xx->max_leds \|\|
c6872911 JL	198	priv->leds[reg].active) {
c6872911 JL	199	of_node_put(child);
e370d010	200	return -EINVAL;
c6872911	201	}
1ab4531a JJH	202	led = &priv->leds[reg];
	203
	204	led->active = true;
1ab4531a JJH	205	led->priv = priv;
	206	led->led_no = reg;
	207	led->ldev.brightness_set_blocking = tlc591xx_brightness_set;
a2cafdfd	208	led->ldev.max_brightness = TLC591XX_MAX_BRIGHTNESS;
5b4b723c JJH	209	err = devm_led_classdev_register_ext(dev, &led->ldev,
5b4b723c JJH	210	&init_data);
108f4664 TJ	211	if (err < 0) {
108f4664 TJ	212	of_node_put(child);
03eb2ca4 KK	213	return dev_err_probe(dev, err,
	214	"couldn't register LED %s\n",
	215	led->ldev.name);
108f4664	216	}
1ab4531a	217	}
e370d010 AL	218	return 0;
	219	}
	220
	221	static const struct i2c_device_id tlc591xx_id[] = {
	222	{ "tlc59116" },
	223	{ "tlc59108" },
	224	{},
	225	};
	226	MODULE_DEVICE_TABLE(i2c, tlc591xx_id);
	227
	228	static struct i2c_driver tlc591xx_driver = {
	229	.driver = {
	230	.name = "tlc591xx",
	231	.of_match_table = of_match_ptr(of_tlc591xx_leds_match),
	232	},
cef9efd5	233	.probe_new = tlc591xx_probe,
e370d010 AL	234	.id_table = tlc591xx_id,
	235	};
	236
	237	module_i2c_driver(tlc591xx_driver);
	238
	239	MODULE_AUTHOR("Andrew Lunn <andrew@lunn.ch>");
	240	MODULE_LICENSE("GPL");
	241	MODULE_DESCRIPTION("TLC591XX LED driver");