1e370d010SAndrew Lunn /* 2e370d010SAndrew Lunn * Copyright 2014 Belkin Inc. 3e370d010SAndrew Lunn * Copyright 2015 Andrew Lunn <andrew@lunn.ch> 4e370d010SAndrew Lunn * 5e370d010SAndrew Lunn * This program is free software; you can redistribute it and/or modify 6e370d010SAndrew Lunn * it under the terms of the GNU General Public License as published by 7e370d010SAndrew Lunn * the Free Software Foundation; version 2 of the License. 8e370d010SAndrew Lunn */ 9e370d010SAndrew Lunn 10e370d010SAndrew Lunn #include <linux/i2c.h> 11e370d010SAndrew Lunn #include <linux/leds.h> 12e370d010SAndrew Lunn #include <linux/module.h> 13e370d010SAndrew Lunn #include <linux/of.h> 14e370d010SAndrew Lunn #include <linux/of_device.h> 15e370d010SAndrew Lunn #include <linux/regmap.h> 16e370d010SAndrew Lunn #include <linux/slab.h> 17e370d010SAndrew Lunn 18e370d010SAndrew Lunn #define TLC591XX_MAX_LEDS 16 19e370d010SAndrew Lunn 20e370d010SAndrew Lunn #define TLC591XX_REG_MODE1 0x00 21e370d010SAndrew Lunn #define MODE1_RESPON_ADDR_MASK 0xF0 22e370d010SAndrew Lunn #define MODE1_NORMAL_MODE (0 << 4) 23e370d010SAndrew Lunn #define MODE1_SPEED_MODE (1 << 4) 24e370d010SAndrew Lunn 25e370d010SAndrew Lunn #define TLC591XX_REG_MODE2 0x01 26e370d010SAndrew Lunn #define MODE2_DIM (0 << 5) 27e370d010SAndrew Lunn #define MODE2_BLINK (1 << 5) 28e370d010SAndrew Lunn #define MODE2_OCH_STOP (0 << 3) 29e370d010SAndrew Lunn #define MODE2_OCH_ACK (1 << 3) 30e370d010SAndrew Lunn 31e370d010SAndrew Lunn #define TLC591XX_REG_PWM(x) (0x02 + (x)) 32e370d010SAndrew Lunn 33e370d010SAndrew Lunn #define TLC591XX_REG_GRPPWM 0x12 34e370d010SAndrew Lunn #define TLC591XX_REG_GRPFREQ 0x13 35e370d010SAndrew Lunn 36e370d010SAndrew Lunn /* LED Driver Output State, determine the source that drives LED outputs */ 37e370d010SAndrew Lunn #define LEDOUT_OFF 0x0 /* Output LOW */ 38e370d010SAndrew Lunn #define LEDOUT_ON 0x1 /* Output HI-Z */ 39e370d010SAndrew Lunn #define LEDOUT_DIM 0x2 /* Dimming */ 40e370d010SAndrew Lunn #define LEDOUT_BLINK 0x3 /* Blinking */ 41e370d010SAndrew Lunn #define LEDOUT_MASK 0x3 42e370d010SAndrew Lunn 43e370d010SAndrew Lunn #define ldev_to_led(c) container_of(c, struct tlc591xx_led, ldev) 44e370d010SAndrew Lunn 45e370d010SAndrew Lunn struct tlc591xx_led { 46e370d010SAndrew Lunn bool active; 47e370d010SAndrew Lunn unsigned int led_no; 48e370d010SAndrew Lunn struct led_classdev ldev; 49e370d010SAndrew Lunn struct tlc591xx_priv *priv; 50e370d010SAndrew Lunn }; 51e370d010SAndrew Lunn 52e370d010SAndrew Lunn struct tlc591xx_priv { 53e370d010SAndrew Lunn struct tlc591xx_led leds[TLC591XX_MAX_LEDS]; 54e370d010SAndrew Lunn struct regmap *regmap; 55e370d010SAndrew Lunn unsigned int reg_ledout_offset; 56e370d010SAndrew Lunn }; 57e370d010SAndrew Lunn 58e370d010SAndrew Lunn struct tlc591xx { 59e370d010SAndrew Lunn unsigned int max_leds; 60e370d010SAndrew Lunn unsigned int reg_ledout_offset; 61e370d010SAndrew Lunn }; 62e370d010SAndrew Lunn 63e370d010SAndrew Lunn static const struct tlc591xx tlc59116 = { 64e370d010SAndrew Lunn .max_leds = 16, 65e370d010SAndrew Lunn .reg_ledout_offset = 0x14, 66e370d010SAndrew Lunn }; 67e370d010SAndrew Lunn 68e370d010SAndrew Lunn static const struct tlc591xx tlc59108 = { 69e370d010SAndrew Lunn .max_leds = 8, 70e370d010SAndrew Lunn .reg_ledout_offset = 0x0c, 71e370d010SAndrew Lunn }; 72e370d010SAndrew Lunn 73e370d010SAndrew Lunn static int 74e370d010SAndrew Lunn tlc591xx_set_mode(struct regmap *regmap, u8 mode) 75e370d010SAndrew Lunn { 76e370d010SAndrew Lunn int err; 77e370d010SAndrew Lunn u8 val; 78e370d010SAndrew Lunn 79e370d010SAndrew Lunn err = regmap_write(regmap, TLC591XX_REG_MODE1, MODE1_NORMAL_MODE); 80e370d010SAndrew Lunn if (err) 81e370d010SAndrew Lunn return err; 82e370d010SAndrew Lunn 83e370d010SAndrew Lunn val = MODE2_OCH_STOP | mode; 84e370d010SAndrew Lunn 85e370d010SAndrew Lunn return regmap_write(regmap, TLC591XX_REG_MODE2, val); 86e370d010SAndrew Lunn } 87e370d010SAndrew Lunn 88e370d010SAndrew Lunn static int 89e370d010SAndrew Lunn tlc591xx_set_ledout(struct tlc591xx_priv *priv, struct tlc591xx_led *led, 90e370d010SAndrew Lunn u8 val) 91e370d010SAndrew Lunn { 92e370d010SAndrew Lunn unsigned int i = (led->led_no % 4) * 2; 93e370d010SAndrew Lunn unsigned int mask = LEDOUT_MASK << i; 94e370d010SAndrew Lunn unsigned int addr = priv->reg_ledout_offset + (led->led_no >> 2); 95e370d010SAndrew Lunn 96e370d010SAndrew Lunn val = val << i; 97e370d010SAndrew Lunn 98e370d010SAndrew Lunn return regmap_update_bits(priv->regmap, addr, mask, val); 99e370d010SAndrew Lunn } 100e370d010SAndrew Lunn 101e370d010SAndrew Lunn static int 102e370d010SAndrew Lunn tlc591xx_set_pwm(struct tlc591xx_priv *priv, struct tlc591xx_led *led, 103e370d010SAndrew Lunn u8 brightness) 104e370d010SAndrew Lunn { 105e370d010SAndrew Lunn u8 pwm = TLC591XX_REG_PWM(led->led_no); 106e370d010SAndrew Lunn 107e370d010SAndrew Lunn return regmap_write(priv->regmap, pwm, brightness); 108e370d010SAndrew Lunn } 109e370d010SAndrew Lunn 110d890389fSAndrew Lunn static int 111d890389fSAndrew Lunn tlc591xx_brightness_set(struct led_classdev *led_cdev, 112d890389fSAndrew Lunn enum led_brightness brightness) 113e370d010SAndrew Lunn { 114d890389fSAndrew Lunn struct tlc591xx_led *led = ldev_to_led(led_cdev); 115e370d010SAndrew Lunn struct tlc591xx_priv *priv = led->priv; 116e370d010SAndrew Lunn int err; 117e370d010SAndrew Lunn 118e370d010SAndrew Lunn switch (brightness) { 119e370d010SAndrew Lunn case 0: 120e370d010SAndrew Lunn err = tlc591xx_set_ledout(priv, led, LEDOUT_OFF); 121e370d010SAndrew Lunn break; 122e370d010SAndrew Lunn case LED_FULL: 123e370d010SAndrew Lunn err = tlc591xx_set_ledout(priv, led, LEDOUT_ON); 124e370d010SAndrew Lunn break; 125e370d010SAndrew Lunn default: 126e370d010SAndrew Lunn err = tlc591xx_set_ledout(priv, led, LEDOUT_DIM); 127e370d010SAndrew Lunn if (!err) 128e370d010SAndrew Lunn err = tlc591xx_set_pwm(priv, led, brightness); 129e370d010SAndrew Lunn } 130e370d010SAndrew Lunn 131d890389fSAndrew Lunn return err; 132e370d010SAndrew Lunn } 133e370d010SAndrew Lunn 134e370d010SAndrew Lunn static void 135e370d010SAndrew Lunn tlc591xx_destroy_devices(struct tlc591xx_priv *priv, unsigned int j) 136e370d010SAndrew Lunn { 137e370d010SAndrew Lunn int i = j; 138e370d010SAndrew Lunn 139e370d010SAndrew Lunn while (--i >= 0) { 140d890389fSAndrew Lunn if (priv->leds[i].active) 141e370d010SAndrew Lunn led_classdev_unregister(&priv->leds[i].ldev); 142e370d010SAndrew Lunn } 143e370d010SAndrew Lunn } 144e370d010SAndrew Lunn 145e370d010SAndrew Lunn static int 146e370d010SAndrew Lunn tlc591xx_configure(struct device *dev, 147e370d010SAndrew Lunn struct tlc591xx_priv *priv, 148e370d010SAndrew Lunn const struct tlc591xx *tlc591xx) 149e370d010SAndrew Lunn { 150e370d010SAndrew Lunn unsigned int i; 151e370d010SAndrew Lunn int err = 0; 152e370d010SAndrew Lunn 153e370d010SAndrew Lunn tlc591xx_set_mode(priv->regmap, MODE2_DIM); 154e370d010SAndrew Lunn for (i = 0; i < TLC591XX_MAX_LEDS; i++) { 155e370d010SAndrew Lunn struct tlc591xx_led *led = &priv->leds[i]; 156e370d010SAndrew Lunn 157e370d010SAndrew Lunn if (!led->active) 158e370d010SAndrew Lunn continue; 159e370d010SAndrew Lunn 160e370d010SAndrew Lunn led->priv = priv; 161e370d010SAndrew Lunn led->led_no = i; 162d890389fSAndrew Lunn led->ldev.brightness_set_blocking = tlc591xx_brightness_set; 163e370d010SAndrew Lunn led->ldev.max_brightness = LED_FULL; 164e370d010SAndrew Lunn err = led_classdev_register(dev, &led->ldev); 165e370d010SAndrew Lunn if (err < 0) { 166e370d010SAndrew Lunn dev_err(dev, "couldn't register LED %s\n", 167e370d010SAndrew Lunn led->ldev.name); 168e370d010SAndrew Lunn goto exit; 169e370d010SAndrew Lunn } 170e370d010SAndrew Lunn } 171e370d010SAndrew Lunn 172e370d010SAndrew Lunn return 0; 173e370d010SAndrew Lunn 174e370d010SAndrew Lunn exit: 175e370d010SAndrew Lunn tlc591xx_destroy_devices(priv, i); 176e370d010SAndrew Lunn return err; 177e370d010SAndrew Lunn } 178e370d010SAndrew Lunn 179e370d010SAndrew Lunn static const struct regmap_config tlc591xx_regmap = { 180e370d010SAndrew Lunn .reg_bits = 8, 181e370d010SAndrew Lunn .val_bits = 8, 182e370d010SAndrew Lunn .max_register = 0x1e, 183e370d010SAndrew Lunn }; 184e370d010SAndrew Lunn 185e370d010SAndrew Lunn static const struct of_device_id of_tlc591xx_leds_match[] = { 186e370d010SAndrew Lunn { .compatible = "ti,tlc59116", 187e370d010SAndrew Lunn .data = &tlc59116 }, 188e370d010SAndrew Lunn { .compatible = "ti,tlc59108", 189e370d010SAndrew Lunn .data = &tlc59108 }, 190e370d010SAndrew Lunn {}, 191e370d010SAndrew Lunn }; 192e370d010SAndrew Lunn MODULE_DEVICE_TABLE(of, of_tlc591xx_leds_match); 193e370d010SAndrew Lunn 194e370d010SAndrew Lunn static int 195e370d010SAndrew Lunn tlc591xx_probe(struct i2c_client *client, 196e370d010SAndrew Lunn const struct i2c_device_id *id) 197e370d010SAndrew Lunn { 198e370d010SAndrew Lunn struct device_node *np = client->dev.of_node, *child; 199e370d010SAndrew Lunn struct device *dev = &client->dev; 200e370d010SAndrew Lunn const struct of_device_id *match; 201e370d010SAndrew Lunn const struct tlc591xx *tlc591xx; 202e370d010SAndrew Lunn struct tlc591xx_priv *priv; 203e370d010SAndrew Lunn int err, count, reg; 204e370d010SAndrew Lunn 205e370d010SAndrew Lunn match = of_match_device(of_tlc591xx_leds_match, dev); 206e370d010SAndrew Lunn if (!match) 207e370d010SAndrew Lunn return -ENODEV; 208e370d010SAndrew Lunn 209e370d010SAndrew Lunn tlc591xx = match->data; 210e370d010SAndrew Lunn if (!np) 211e370d010SAndrew Lunn return -ENODEV; 212e370d010SAndrew Lunn 213e370d010SAndrew Lunn count = of_get_child_count(np); 214e370d010SAndrew Lunn if (!count || count > tlc591xx->max_leds) 215e370d010SAndrew Lunn return -EINVAL; 216e370d010SAndrew Lunn 217e370d010SAndrew Lunn priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 218e370d010SAndrew Lunn if (!priv) 219e370d010SAndrew Lunn return -ENOMEM; 220e370d010SAndrew Lunn 221e370d010SAndrew Lunn priv->regmap = devm_regmap_init_i2c(client, &tlc591xx_regmap); 222e370d010SAndrew Lunn if (IS_ERR(priv->regmap)) { 223e370d010SAndrew Lunn err = PTR_ERR(priv->regmap); 224e370d010SAndrew Lunn dev_err(dev, "Failed to allocate register map: %d\n", err); 225e370d010SAndrew Lunn return err; 226e370d010SAndrew Lunn } 227e370d010SAndrew Lunn priv->reg_ledout_offset = tlc591xx->reg_ledout_offset; 228e370d010SAndrew Lunn 229e370d010SAndrew Lunn i2c_set_clientdata(client, priv); 230e370d010SAndrew Lunn 231e370d010SAndrew Lunn for_each_child_of_node(np, child) { 232e370d010SAndrew Lunn err = of_property_read_u32(child, "reg", ®); 233e370d010SAndrew Lunn if (err) 234e370d010SAndrew Lunn return err; 235*1055790bSJulia Lawall if (reg < 0 || reg >= tlc591xx->max_leds || 236*1055790bSJulia Lawall priv->leds[reg].active) 237e370d010SAndrew Lunn return -EINVAL; 238e370d010SAndrew Lunn priv->leds[reg].active = true; 239e370d010SAndrew Lunn priv->leds[reg].ldev.name = 240e370d010SAndrew Lunn of_get_property(child, "label", NULL) ? : child->name; 241e370d010SAndrew Lunn priv->leds[reg].ldev.default_trigger = 242e370d010SAndrew Lunn of_get_property(child, "linux,default-trigger", NULL); 243e370d010SAndrew Lunn } 244e370d010SAndrew Lunn return tlc591xx_configure(dev, priv, tlc591xx); 245e370d010SAndrew Lunn } 246e370d010SAndrew Lunn 247e370d010SAndrew Lunn static int 248e370d010SAndrew Lunn tlc591xx_remove(struct i2c_client *client) 249e370d010SAndrew Lunn { 250e370d010SAndrew Lunn struct tlc591xx_priv *priv = i2c_get_clientdata(client); 251e370d010SAndrew Lunn 252e370d010SAndrew Lunn tlc591xx_destroy_devices(priv, TLC591XX_MAX_LEDS); 253e370d010SAndrew Lunn 254e370d010SAndrew Lunn return 0; 255e370d010SAndrew Lunn } 256e370d010SAndrew Lunn 257e370d010SAndrew Lunn static const struct i2c_device_id tlc591xx_id[] = { 258e370d010SAndrew Lunn { "tlc59116" }, 259e370d010SAndrew Lunn { "tlc59108" }, 260e370d010SAndrew Lunn {}, 261e370d010SAndrew Lunn }; 262e370d010SAndrew Lunn MODULE_DEVICE_TABLE(i2c, tlc591xx_id); 263e370d010SAndrew Lunn 264e370d010SAndrew Lunn static struct i2c_driver tlc591xx_driver = { 265e370d010SAndrew Lunn .driver = { 266e370d010SAndrew Lunn .name = "tlc591xx", 267e370d010SAndrew Lunn .of_match_table = of_match_ptr(of_tlc591xx_leds_match), 268e370d010SAndrew Lunn }, 269e370d010SAndrew Lunn .probe = tlc591xx_probe, 270e370d010SAndrew Lunn .remove = tlc591xx_remove, 271e370d010SAndrew Lunn .id_table = tlc591xx_id, 272e370d010SAndrew Lunn }; 273e370d010SAndrew Lunn 274e370d010SAndrew Lunn module_i2c_driver(tlc591xx_driver); 275e370d010SAndrew Lunn 276e370d010SAndrew Lunn MODULE_AUTHOR("Andrew Lunn <andrew@lunn.ch>"); 277e370d010SAndrew Lunn MODULE_LICENSE("GPL"); 278e370d010SAndrew Lunn MODULE_DESCRIPTION("TLC591XX LED driver"); 279