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