leds-lp3952.c 6.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * LED driver for TI lp3952 controller
  4. *
  5. * Copyright (C) 2016, DAQRI, LLC.
  6. * Author: Tony Makkiel <tony.makkiel@daqri.com>
  7. */
  8. #include <linux/delay.h>
  9. #include <linux/gpio/consumer.h>
  10. #include <linux/i2c.h>
  11. #include <linux/io.h>
  12. #include <linux/kernel.h>
  13. #include <linux/leds.h>
  14. #include <linux/leds-lp3952.h>
  15. #include <linux/module.h>
  16. #include <linux/notifier.h>
  17. #include <linux/platform_device.h>
  18. #include <linux/pm.h>
  19. #include <linux/reboot.h>
  20. #include <linux/regmap.h>
  21. static int lp3952_register_write(struct i2c_client *client, u8 reg, u8 val)
  22. {
  23. int ret;
  24. struct lp3952_led_array *priv = i2c_get_clientdata(client);
  25. ret = regmap_write(priv->regmap, reg, val);
  26. if (ret)
  27. dev_err(&client->dev, "%s: reg 0x%x, val 0x%x, err %d\n",
  28. __func__, reg, val, ret);
  29. return ret;
  30. }
  31. static void lp3952_on_off(struct lp3952_led_array *priv,
  32. enum lp3952_leds led_id, bool on)
  33. {
  34. int ret, val;
  35. dev_dbg(&priv->client->dev, "%s LED %d to %d\n", __func__, led_id, on);
  36. val = 1 << led_id;
  37. if (led_id == LP3952_LED_ALL)
  38. val = LP3952_LED_MASK_ALL;
  39. ret = regmap_update_bits(priv->regmap, LP3952_REG_LED_CTRL, val,
  40. on ? val : 0);
  41. if (ret)
  42. dev_err(&priv->client->dev, "%s, Error %d\n", __func__, ret);
  43. }
  44. /*
  45. * Using Imax to control brightness. There are 4 possible
  46. * setting 25, 50, 75 and 100 % of Imax. Possible values are
  47. * values 0-4. 0 meaning turn off.
  48. */
  49. static int lp3952_set_brightness(struct led_classdev *cdev,
  50. enum led_brightness value)
  51. {
  52. unsigned int reg, shift_val;
  53. struct lp3952_ctrl_hdl *led = container_of(cdev,
  54. struct lp3952_ctrl_hdl,
  55. cdev);
  56. struct lp3952_led_array *priv = (struct lp3952_led_array *)led->priv;
  57. dev_dbg(cdev->dev, "Brightness request: %d on %d\n", value,
  58. led->channel);
  59. if (value == LED_OFF) {
  60. lp3952_on_off(priv, led->channel, false);
  61. return 0;
  62. }
  63. if (led->channel > LP3952_RED_1) {
  64. dev_err(cdev->dev, " %s Invalid LED requested", __func__);
  65. return -EINVAL;
  66. }
  67. if (led->channel >= LP3952_BLUE_1) {
  68. reg = LP3952_REG_RGB1_MAX_I_CTRL;
  69. shift_val = (led->channel - LP3952_BLUE_1) * 2;
  70. } else {
  71. reg = LP3952_REG_RGB2_MAX_I_CTRL;
  72. shift_val = led->channel * 2;
  73. }
  74. /* Enable the LED in case it is not enabled already */
  75. lp3952_on_off(priv, led->channel, true);
  76. return regmap_update_bits(priv->regmap, reg, 3 << shift_val,
  77. --value << shift_val);
  78. }
  79. static int lp3952_get_label(struct device *dev, const char *label, char *dest)
  80. {
  81. int ret;
  82. const char *str;
  83. ret = device_property_read_string(dev, label, &str);
  84. if (ret)
  85. return ret;
  86. strncpy(dest, str, LP3952_LABEL_MAX_LEN);
  87. return 0;
  88. }
  89. static int lp3952_register_led_classdev(struct lp3952_led_array *priv)
  90. {
  91. int i, acpi_ret, ret = -ENODEV;
  92. static const char *led_name_hdl[LP3952_LED_ALL] = {
  93. "blue2",
  94. "green2",
  95. "red2",
  96. "blue1",
  97. "green1",
  98. "red1"
  99. };
  100. for (i = 0; i < LP3952_LED_ALL; i++) {
  101. acpi_ret = lp3952_get_label(&priv->client->dev, led_name_hdl[i],
  102. priv->leds[i].name);
  103. if (acpi_ret)
  104. continue;
  105. priv->leds[i].cdev.name = priv->leds[i].name;
  106. priv->leds[i].cdev.brightness = LED_OFF;
  107. priv->leds[i].cdev.max_brightness = LP3952_BRIGHT_MAX;
  108. priv->leds[i].cdev.brightness_set_blocking =
  109. lp3952_set_brightness;
  110. priv->leds[i].channel = i;
  111. priv->leds[i].priv = priv;
  112. ret = devm_led_classdev_register(&priv->client->dev,
  113. &priv->leds[i].cdev);
  114. if (ret < 0) {
  115. dev_err(&priv->client->dev,
  116. "couldn't register LED %s\n",
  117. priv->leds[i].cdev.name);
  118. break;
  119. }
  120. }
  121. return ret;
  122. }
  123. static int lp3952_set_pattern_gen_cmd(struct lp3952_led_array *priv,
  124. u8 cmd_index, u8 r, u8 g, u8 b,
  125. enum lp3952_tt tt, enum lp3952_cet cet)
  126. {
  127. int ret;
  128. struct ptrn_gen_cmd line = {
  129. {
  130. {
  131. .r = r,
  132. .g = g,
  133. .b = b,
  134. .cet = cet,
  135. .tt = tt
  136. }
  137. }
  138. };
  139. if (cmd_index >= LP3952_CMD_REG_COUNT)
  140. return -EINVAL;
  141. ret = lp3952_register_write(priv->client,
  142. LP3952_REG_CMD_0 + cmd_index * 2,
  143. line.bytes.msb);
  144. if (ret)
  145. return ret;
  146. return lp3952_register_write(priv->client,
  147. LP3952_REG_CMD_0 + cmd_index * 2 + 1,
  148. line.bytes.lsb);
  149. }
  150. static int lp3952_configure(struct lp3952_led_array *priv)
  151. {
  152. int ret;
  153. /* Disable any LEDs on from any previous conf. */
  154. ret = lp3952_register_write(priv->client, LP3952_REG_LED_CTRL, 0);
  155. if (ret)
  156. return ret;
  157. /* enable rgb patter, loop */
  158. ret = lp3952_register_write(priv->client, LP3952_REG_PAT_GEN_CTRL,
  159. LP3952_PATRN_LOOP | LP3952_PATRN_GEN_EN);
  160. if (ret)
  161. return ret;
  162. /* Update Bit 6 (Active mode), Select both Led sets, Bit [1:0] */
  163. ret = lp3952_register_write(priv->client, LP3952_REG_ENABLES,
  164. LP3952_ACTIVE_MODE | LP3952_INT_B00ST_LDR);
  165. if (ret)
  166. return ret;
  167. /* Set Cmd1 for RGB intensity,cmd and transition time */
  168. return lp3952_set_pattern_gen_cmd(priv, 0, I46, I71, I100, TT0,
  169. CET197);
  170. }
  171. static const struct regmap_config lp3952_regmap = {
  172. .reg_bits = 8,
  173. .val_bits = 8,
  174. .max_register = REG_MAX,
  175. .cache_type = REGCACHE_RBTREE,
  176. };
  177. static int lp3952_probe(struct i2c_client *client,
  178. const struct i2c_device_id *id)
  179. {
  180. int status;
  181. struct lp3952_led_array *priv;
  182. priv = devm_kzalloc(&client->dev, sizeof(*priv), GFP_KERNEL);
  183. if (!priv)
  184. return -ENOMEM;
  185. priv->client = client;
  186. priv->enable_gpio = devm_gpiod_get(&client->dev, "nrst",
  187. GPIOD_OUT_HIGH);
  188. if (IS_ERR(priv->enable_gpio)) {
  189. status = PTR_ERR(priv->enable_gpio);
  190. dev_err(&client->dev, "Failed to enable gpio: %d\n", status);
  191. return status;
  192. }
  193. priv->regmap = devm_regmap_init_i2c(client, &lp3952_regmap);
  194. if (IS_ERR(priv->regmap)) {
  195. int err = PTR_ERR(priv->regmap);
  196. dev_err(&client->dev, "Failed to allocate register map: %d\n",
  197. err);
  198. return err;
  199. }
  200. i2c_set_clientdata(client, priv);
  201. status = lp3952_configure(priv);
  202. if (status) {
  203. dev_err(&client->dev, "Probe failed. Device not found (%d)\n",
  204. status);
  205. return status;
  206. }
  207. status = lp3952_register_led_classdev(priv);
  208. if (status) {
  209. dev_err(&client->dev, "Unable to register led_classdev: %d\n",
  210. status);
  211. return status;
  212. }
  213. return 0;
  214. }
  215. static int lp3952_remove(struct i2c_client *client)
  216. {
  217. struct lp3952_led_array *priv;
  218. priv = i2c_get_clientdata(client);
  219. lp3952_on_off(priv, LP3952_LED_ALL, false);
  220. gpiod_set_value(priv->enable_gpio, 0);
  221. return 0;
  222. }
  223. static const struct i2c_device_id lp3952_id[] = {
  224. {LP3952_NAME, 0},
  225. {}
  226. };
  227. MODULE_DEVICE_TABLE(i2c, lp3952_id);
  228. static struct i2c_driver lp3952_i2c_driver = {
  229. .driver = {
  230. .name = LP3952_NAME,
  231. },
  232. .probe = lp3952_probe,
  233. .remove = lp3952_remove,
  234. .id_table = lp3952_id,
  235. };
  236. module_i2c_driver(lp3952_i2c_driver);
  237. MODULE_AUTHOR("Tony Makkiel <tony.makkiel@daqri.com>");
  238. MODULE_DESCRIPTION("lp3952 I2C LED controller driver");
  239. MODULE_LICENSE("GPL v2");