leds-lp50xx.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637
  1. // SPDX-License-Identifier: GPL-2.0
  2. // TI LP50XX LED chip family driver
  3. // Copyright (C) 2018-20 Texas Instruments Incorporated - https://www.ti.com/
  4. #include <linux/gpio/consumer.h>
  5. #include <linux/i2c.h>
  6. #include <linux/init.h>
  7. #include <linux/leds.h>
  8. #include <linux/mod_devicetable.h>
  9. #include <linux/module.h>
  10. #include <linux/mutex.h>
  11. #include <linux/regmap.h>
  12. #include <linux/regulator/consumer.h>
  13. #include <linux/slab.h>
  14. #include <uapi/linux/uleds.h>
  15. #include <linux/led-class-multicolor.h>
  16. #define LP50XX_DEV_CFG0 0x00
  17. #define LP50XX_DEV_CFG1 0x01
  18. #define LP50XX_LED_CFG0 0x02
  19. /* LP5009 and LP5012 registers */
  20. #define LP5012_BNK_BRT 0x03
  21. #define LP5012_BNKA_CLR 0x04
  22. #define LP5012_BNKB_CLR 0x05
  23. #define LP5012_BNKC_CLR 0x06
  24. #define LP5012_LED0_BRT 0x07
  25. #define LP5012_OUT0_CLR 0x0b
  26. #define LP5012_RESET 0x17
  27. /* LP5018 and LP5024 registers */
  28. #define LP5024_BNK_BRT 0x03
  29. #define LP5024_BNKA_CLR 0x04
  30. #define LP5024_BNKB_CLR 0x05
  31. #define LP5024_BNKC_CLR 0x06
  32. #define LP5024_LED0_BRT 0x07
  33. #define LP5024_OUT0_CLR 0x0f
  34. #define LP5024_RESET 0x27
  35. /* LP5030 and LP5036 registers */
  36. #define LP5036_LED_CFG1 0x03
  37. #define LP5036_BNK_BRT 0x04
  38. #define LP5036_BNKA_CLR 0x05
  39. #define LP5036_BNKB_CLR 0x06
  40. #define LP5036_BNKC_CLR 0x07
  41. #define LP5036_LED0_BRT 0x08
  42. #define LP5036_OUT0_CLR 0x14
  43. #define LP5036_RESET 0x38
  44. #define LP50XX_SW_RESET 0xff
  45. #define LP50XX_CHIP_EN BIT(6)
  46. #define LP50XX_CHIP_DISABLE 0x00
  47. #define LP50XX_START_TIME_US 500
  48. #define LP50XX_RESET_TIME_US 3
  49. #define LP50XX_EN_GPIO_LOW 0
  50. #define LP50XX_EN_GPIO_HIGH 1
  51. /* There are 3 LED outputs per bank */
  52. #define LP50XX_LEDS_PER_MODULE 3
  53. #define LP5009_MAX_LED_MODULES 3
  54. #define LP5012_MAX_LED_MODULES 4
  55. #define LP5018_MAX_LED_MODULES 6
  56. #define LP5024_MAX_LED_MODULES 8
  57. #define LP5030_MAX_LED_MODULES 10
  58. #define LP5036_MAX_LED_MODULES 12
  59. static const struct reg_default lp5012_reg_defs[] = {
  60. {LP50XX_DEV_CFG0, 0x0},
  61. {LP50XX_DEV_CFG1, 0x3c},
  62. {LP50XX_LED_CFG0, 0x0},
  63. {LP5012_BNK_BRT, 0xff},
  64. {LP5012_BNKA_CLR, 0x0f},
  65. {LP5012_BNKB_CLR, 0x0f},
  66. {LP5012_BNKC_CLR, 0x0f},
  67. {LP5012_LED0_BRT, 0x0f},
  68. /* LEDX_BRT registers are all 0xff for defaults */
  69. {0x08, 0xff}, {0x09, 0xff}, {0x0a, 0xff},
  70. {LP5012_OUT0_CLR, 0x0f},
  71. /* OUTX_CLR registers are all 0x0 for defaults */
  72. {0x0c, 0x00}, {0x0d, 0x00}, {0x0e, 0x00}, {0x0f, 0x00}, {0x10, 0x00},
  73. {0x11, 0x00}, {0x12, 0x00}, {0x13, 0x00}, {0x14, 0x00}, {0x15, 0x00},
  74. {0x16, 0x00},
  75. {LP5012_RESET, 0x00}
  76. };
  77. static const struct reg_default lp5024_reg_defs[] = {
  78. {LP50XX_DEV_CFG0, 0x0},
  79. {LP50XX_DEV_CFG1, 0x3c},
  80. {LP50XX_LED_CFG0, 0x0},
  81. {LP5024_BNK_BRT, 0xff},
  82. {LP5024_BNKA_CLR, 0x0f},
  83. {LP5024_BNKB_CLR, 0x0f},
  84. {LP5024_BNKC_CLR, 0x0f},
  85. {LP5024_LED0_BRT, 0x0f},
  86. /* LEDX_BRT registers are all 0xff for defaults */
  87. {0x08, 0xff}, {0x09, 0xff}, {0x0a, 0xff}, {0x0b, 0xff}, {0x0c, 0xff},
  88. {0x0d, 0xff}, {0x0e, 0xff},
  89. {LP5024_OUT0_CLR, 0x0f},
  90. /* OUTX_CLR registers are all 0x0 for defaults */
  91. {0x10, 0x00}, {0x11, 0x00}, {0x12, 0x00}, {0x13, 0x00}, {0x14, 0x00},
  92. {0x15, 0x00}, {0x16, 0x00}, {0x17, 0x00}, {0x18, 0x00}, {0x19, 0x00},
  93. {0x1a, 0x00}, {0x1b, 0x00}, {0x1c, 0x00}, {0x1d, 0x00}, {0x1e, 0x00},
  94. {0x1f, 0x00}, {0x20, 0x00}, {0x21, 0x00}, {0x22, 0x00}, {0x23, 0x00},
  95. {0x24, 0x00}, {0x25, 0x00}, {0x26, 0x00},
  96. {LP5024_RESET, 0x00}
  97. };
  98. static const struct reg_default lp5036_reg_defs[] = {
  99. {LP50XX_DEV_CFG0, 0x0},
  100. {LP50XX_DEV_CFG1, 0x3c},
  101. {LP50XX_LED_CFG0, 0x0},
  102. {LP5036_LED_CFG1, 0x0},
  103. {LP5036_BNK_BRT, 0xff},
  104. {LP5036_BNKA_CLR, 0x0f},
  105. {LP5036_BNKB_CLR, 0x0f},
  106. {LP5036_BNKC_CLR, 0x0f},
  107. {LP5036_LED0_BRT, 0x0f},
  108. /* LEDX_BRT registers are all 0xff for defaults */
  109. {0x08, 0xff}, {0x09, 0xff}, {0x0a, 0xff}, {0x0b, 0xff}, {0x0c, 0xff},
  110. {0x0d, 0xff}, {0x0e, 0xff}, {0x0f, 0xff}, {0x10, 0xff}, {0x11, 0xff},
  111. {0x12, 0xff}, {0x13, 0xff},
  112. {LP5036_OUT0_CLR, 0x0f},
  113. /* OUTX_CLR registers are all 0x0 for defaults */
  114. {0x15, 0x00}, {0x16, 0x00}, {0x17, 0x00}, {0x18, 0x00}, {0x19, 0x00},
  115. {0x1a, 0x00}, {0x1b, 0x00}, {0x1c, 0x00}, {0x1d, 0x00}, {0x1e, 0x00},
  116. {0x1f, 0x00}, {0x20, 0x00}, {0x21, 0x00}, {0x22, 0x00}, {0x23, 0x00},
  117. {0x24, 0x00}, {0x25, 0x00}, {0x26, 0x00}, {0x27, 0x00}, {0x28, 0x00},
  118. {0x29, 0x00}, {0x2a, 0x00}, {0x2b, 0x00}, {0x2c, 0x00}, {0x2d, 0x00},
  119. {0x2e, 0x00}, {0x2f, 0x00}, {0x30, 0x00}, {0x31, 0x00}, {0x32, 0x00},
  120. {0x33, 0x00}, {0x34, 0x00}, {0x35, 0x00}, {0x36, 0x00}, {0x37, 0x00},
  121. {LP5036_RESET, 0x00}
  122. };
  123. static const struct regmap_config lp5012_regmap_config = {
  124. .reg_bits = 8,
  125. .val_bits = 8,
  126. .max_register = LP5012_RESET,
  127. .reg_defaults = lp5012_reg_defs,
  128. .num_reg_defaults = ARRAY_SIZE(lp5012_reg_defs),
  129. .cache_type = REGCACHE_FLAT,
  130. };
  131. static const struct regmap_config lp5024_regmap_config = {
  132. .reg_bits = 8,
  133. .val_bits = 8,
  134. .max_register = LP5024_RESET,
  135. .reg_defaults = lp5024_reg_defs,
  136. .num_reg_defaults = ARRAY_SIZE(lp5024_reg_defs),
  137. .cache_type = REGCACHE_FLAT,
  138. };
  139. static const struct regmap_config lp5036_regmap_config = {
  140. .reg_bits = 8,
  141. .val_bits = 8,
  142. .max_register = LP5036_RESET,
  143. .reg_defaults = lp5036_reg_defs,
  144. .num_reg_defaults = ARRAY_SIZE(lp5036_reg_defs),
  145. .cache_type = REGCACHE_FLAT,
  146. };
  147. enum lp50xx_model {
  148. LP5009,
  149. LP5012,
  150. LP5018,
  151. LP5024,
  152. LP5030,
  153. LP5036,
  154. };
  155. /**
  156. * struct lp50xx_chip_info -
  157. * @lp50xx_regmap_config: regmap register configuration
  158. * @model_id: LED device model
  159. * @max_modules: total number of supported LED modules
  160. * @num_leds: number of LED outputs available on the device
  161. * @led_brightness0_reg: first brightness register of the device
  162. * @mix_out0_reg: first color mix register of the device
  163. * @bank_brt_reg: bank brightness register
  164. * @bank_mix_reg: color mix register
  165. * @reset_reg: device reset register
  166. */
  167. struct lp50xx_chip_info {
  168. const struct regmap_config *lp50xx_regmap_config;
  169. int model_id;
  170. u8 max_modules;
  171. u8 num_leds;
  172. u8 led_brightness0_reg;
  173. u8 mix_out0_reg;
  174. u8 bank_brt_reg;
  175. u8 bank_mix_reg;
  176. u8 reset_reg;
  177. };
  178. static const struct lp50xx_chip_info lp50xx_chip_info_tbl[] = {
  179. [LP5009] = {
  180. .model_id = LP5009,
  181. .max_modules = LP5009_MAX_LED_MODULES,
  182. .num_leds = LP5009_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  183. .led_brightness0_reg = LP5012_LED0_BRT,
  184. .mix_out0_reg = LP5012_OUT0_CLR,
  185. .bank_brt_reg = LP5012_BNK_BRT,
  186. .bank_mix_reg = LP5012_BNKA_CLR,
  187. .reset_reg = LP5012_RESET,
  188. .lp50xx_regmap_config = &lp5012_regmap_config,
  189. },
  190. [LP5012] = {
  191. .model_id = LP5012,
  192. .max_modules = LP5012_MAX_LED_MODULES,
  193. .num_leds = LP5012_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  194. .led_brightness0_reg = LP5012_LED0_BRT,
  195. .mix_out0_reg = LP5012_OUT0_CLR,
  196. .bank_brt_reg = LP5012_BNK_BRT,
  197. .bank_mix_reg = LP5012_BNKA_CLR,
  198. .reset_reg = LP5012_RESET,
  199. .lp50xx_regmap_config = &lp5012_regmap_config,
  200. },
  201. [LP5018] = {
  202. .model_id = LP5018,
  203. .max_modules = LP5018_MAX_LED_MODULES,
  204. .num_leds = LP5018_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  205. .led_brightness0_reg = LP5024_LED0_BRT,
  206. .mix_out0_reg = LP5024_OUT0_CLR,
  207. .bank_brt_reg = LP5024_BNK_BRT,
  208. .bank_mix_reg = LP5024_BNKA_CLR,
  209. .reset_reg = LP5024_RESET,
  210. .lp50xx_regmap_config = &lp5024_regmap_config,
  211. },
  212. [LP5024] = {
  213. .model_id = LP5024,
  214. .max_modules = LP5024_MAX_LED_MODULES,
  215. .num_leds = LP5024_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  216. .led_brightness0_reg = LP5024_LED0_BRT,
  217. .mix_out0_reg = LP5024_OUT0_CLR,
  218. .bank_brt_reg = LP5024_BNK_BRT,
  219. .bank_mix_reg = LP5024_BNKA_CLR,
  220. .reset_reg = LP5024_RESET,
  221. .lp50xx_regmap_config = &lp5024_regmap_config,
  222. },
  223. [LP5030] = {
  224. .model_id = LP5030,
  225. .max_modules = LP5030_MAX_LED_MODULES,
  226. .num_leds = LP5030_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  227. .led_brightness0_reg = LP5036_LED0_BRT,
  228. .mix_out0_reg = LP5036_OUT0_CLR,
  229. .bank_brt_reg = LP5036_BNK_BRT,
  230. .bank_mix_reg = LP5036_BNKA_CLR,
  231. .reset_reg = LP5036_RESET,
  232. .lp50xx_regmap_config = &lp5036_regmap_config,
  233. },
  234. [LP5036] = {
  235. .model_id = LP5036,
  236. .max_modules = LP5036_MAX_LED_MODULES,
  237. .num_leds = LP5036_MAX_LED_MODULES * LP50XX_LEDS_PER_MODULE,
  238. .led_brightness0_reg = LP5036_LED0_BRT,
  239. .mix_out0_reg = LP5036_OUT0_CLR,
  240. .bank_brt_reg = LP5036_BNK_BRT,
  241. .bank_mix_reg = LP5036_BNKA_CLR,
  242. .reset_reg = LP5036_RESET,
  243. .lp50xx_regmap_config = &lp5036_regmap_config,
  244. },
  245. };
  246. struct lp50xx_led {
  247. struct led_classdev_mc mc_cdev;
  248. struct lp50xx *priv;
  249. u8 ctrl_bank_enabled;
  250. int led_number;
  251. };
  252. /**
  253. * struct lp50xx -
  254. * @enable_gpio: hardware enable gpio
  255. * @regulator: LED supply regulator pointer
  256. * @client: pointer to the I2C client
  257. * @regmap: device register map
  258. * @dev: pointer to the devices device struct
  259. * @lock: lock for reading/writing the device
  260. * @chip_info: chip specific information (ie num_leds)
  261. * @leds: array of LED strings
  262. */
  263. struct lp50xx {
  264. struct gpio_desc *enable_gpio;
  265. struct regulator *regulator;
  266. struct i2c_client *client;
  267. struct regmap *regmap;
  268. struct device *dev;
  269. struct mutex lock;
  270. const struct lp50xx_chip_info *chip_info;
  271. /* This needs to be at the end of the struct */
  272. struct lp50xx_led leds[];
  273. };
  274. static struct lp50xx_led *mcled_cdev_to_led(struct led_classdev_mc *mc_cdev)
  275. {
  276. return container_of(mc_cdev, struct lp50xx_led, mc_cdev);
  277. }
  278. static int lp50xx_brightness_set(struct led_classdev *cdev,
  279. enum led_brightness brightness)
  280. {
  281. struct led_classdev_mc *mc_dev = lcdev_to_mccdev(cdev);
  282. struct lp50xx_led *led = mcled_cdev_to_led(mc_dev);
  283. const struct lp50xx_chip_info *led_chip = led->priv->chip_info;
  284. u8 led_offset, reg_val;
  285. int ret = 0;
  286. int i;
  287. mutex_lock(&led->priv->lock);
  288. if (led->ctrl_bank_enabled)
  289. reg_val = led_chip->bank_brt_reg;
  290. else
  291. reg_val = led_chip->led_brightness0_reg +
  292. led->led_number;
  293. ret = regmap_write(led->priv->regmap, reg_val, brightness);
  294. if (ret) {
  295. dev_err(led->priv->dev,
  296. "Cannot write brightness value %d\n", ret);
  297. goto out;
  298. }
  299. for (i = 0; i < led->mc_cdev.num_colors; i++) {
  300. if (led->ctrl_bank_enabled) {
  301. reg_val = led_chip->bank_mix_reg + i;
  302. } else {
  303. led_offset = (led->led_number * 3) + i;
  304. reg_val = led_chip->mix_out0_reg + led_offset;
  305. }
  306. ret = regmap_write(led->priv->regmap, reg_val,
  307. mc_dev->subled_info[i].intensity);
  308. if (ret) {
  309. dev_err(led->priv->dev,
  310. "Cannot write intensity value %d\n", ret);
  311. goto out;
  312. }
  313. }
  314. out:
  315. mutex_unlock(&led->priv->lock);
  316. return ret;
  317. }
  318. static int lp50xx_set_banks(struct lp50xx *priv, u32 led_banks[], int num_leds)
  319. {
  320. u8 led_config_lo, led_config_hi;
  321. u32 bank_enable_mask = 0;
  322. int ret;
  323. int i;
  324. for (i = 0; i < num_leds; i++)
  325. bank_enable_mask |= (1 << led_banks[i]);
  326. led_config_lo = bank_enable_mask;
  327. led_config_hi = bank_enable_mask >> 8;
  328. ret = regmap_write(priv->regmap, LP50XX_LED_CFG0, led_config_lo);
  329. if (ret)
  330. return ret;
  331. if (priv->chip_info->model_id >= LP5030)
  332. ret = regmap_write(priv->regmap, LP5036_LED_CFG1, led_config_hi);
  333. return ret;
  334. }
  335. static int lp50xx_reset(struct lp50xx *priv)
  336. {
  337. return regmap_write(priv->regmap, priv->chip_info->reset_reg, LP50XX_SW_RESET);
  338. }
  339. static int lp50xx_enable(struct lp50xx *priv)
  340. {
  341. int ret;
  342. if (priv->enable_gpio) {
  343. ret = gpiod_direction_output(priv->enable_gpio, LP50XX_EN_GPIO_HIGH);
  344. if (ret)
  345. return ret;
  346. udelay(LP50XX_START_TIME_US);
  347. }
  348. ret = lp50xx_reset(priv);
  349. if (ret)
  350. return ret;
  351. return regmap_write(priv->regmap, LP50XX_DEV_CFG0, LP50XX_CHIP_EN);
  352. }
  353. static int lp50xx_disable(struct lp50xx *priv)
  354. {
  355. int ret;
  356. ret = regmap_write(priv->regmap, LP50XX_DEV_CFG0, LP50XX_CHIP_DISABLE);
  357. if (ret)
  358. return ret;
  359. if (priv->enable_gpio) {
  360. ret = gpiod_direction_output(priv->enable_gpio, LP50XX_EN_GPIO_LOW);
  361. if (ret)
  362. return ret;
  363. udelay(LP50XX_RESET_TIME_US);
  364. }
  365. return 0;
  366. }
  367. static int lp50xx_probe_leds(struct fwnode_handle *child, struct lp50xx *priv,
  368. struct lp50xx_led *led, int num_leds)
  369. {
  370. u32 led_banks[LP5036_MAX_LED_MODULES] = {0};
  371. int led_number;
  372. int ret;
  373. if (num_leds > 1) {
  374. if (num_leds > priv->chip_info->max_modules) {
  375. dev_err(priv->dev, "reg property is invalid\n");
  376. return -EINVAL;
  377. }
  378. ret = fwnode_property_read_u32_array(child, "reg", led_banks, num_leds);
  379. if (ret) {
  380. dev_err(priv->dev, "reg property is missing\n");
  381. return ret;
  382. }
  383. ret = lp50xx_set_banks(priv, led_banks, num_leds);
  384. if (ret) {
  385. dev_err(priv->dev, "Cannot setup banked LEDs\n");
  386. return ret;
  387. }
  388. led->ctrl_bank_enabled = 1;
  389. } else {
  390. ret = fwnode_property_read_u32(child, "reg", &led_number);
  391. if (ret) {
  392. dev_err(priv->dev, "led reg property missing\n");
  393. return ret;
  394. }
  395. if (led_number > priv->chip_info->num_leds) {
  396. dev_err(priv->dev, "led-sources property is invalid\n");
  397. return -EINVAL;
  398. }
  399. led->led_number = led_number;
  400. }
  401. return 0;
  402. }
  403. static int lp50xx_probe_dt(struct lp50xx *priv)
  404. {
  405. struct fwnode_handle *led_node = NULL;
  406. struct led_init_data init_data = {};
  407. struct led_classdev *led_cdev;
  408. struct mc_subled *mc_led_info;
  409. struct lp50xx_led *led;
  410. int ret = -EINVAL;
  411. int num_colors;
  412. u32 color_id;
  413. int i = 0;
  414. priv->enable_gpio = devm_gpiod_get_optional(priv->dev, "enable", GPIOD_OUT_LOW);
  415. if (IS_ERR(priv->enable_gpio))
  416. return dev_err_probe(priv->dev, PTR_ERR(priv->enable_gpio),
  417. "Failed to get enable GPIO\n");
  418. ret = lp50xx_enable(priv);
  419. if (ret)
  420. return ret;
  421. priv->regulator = devm_regulator_get(priv->dev, "vled");
  422. if (IS_ERR(priv->regulator))
  423. priv->regulator = NULL;
  424. device_for_each_child_node_scoped(priv->dev, child) {
  425. led = &priv->leds[i];
  426. ret = fwnode_property_count_u32(child, "reg");
  427. if (ret < 0) {
  428. dev_err(priv->dev, "reg property is invalid\n");
  429. return ret;
  430. }
  431. ret = lp50xx_probe_leds(child, priv, led, ret);
  432. if (ret)
  433. return ret;
  434. init_data.fwnode = child;
  435. num_colors = 0;
  436. /*
  437. * There are only 3 LEDs per module otherwise they should be
  438. * banked which also is presented as 3 LEDs.
  439. */
  440. mc_led_info = devm_kcalloc(priv->dev, LP50XX_LEDS_PER_MODULE,
  441. sizeof(*mc_led_info), GFP_KERNEL);
  442. if (!mc_led_info)
  443. return -ENOMEM;
  444. fwnode_for_each_child_node(child, led_node) {
  445. int multi_index;
  446. ret = fwnode_property_read_u32(led_node, "color",
  447. &color_id);
  448. if (ret) {
  449. fwnode_handle_put(led_node);
  450. dev_err(priv->dev, "Cannot read color\n");
  451. return ret;
  452. }
  453. ret = fwnode_property_read_u32(led_node, "reg", &multi_index);
  454. if (ret != 0) {
  455. dev_err(priv->dev, "reg must be set\n");
  456. return -EINVAL;
  457. } else if (multi_index >= LP50XX_LEDS_PER_MODULE) {
  458. dev_err(priv->dev, "reg %i out of range\n", multi_index);
  459. return -EINVAL;
  460. }
  461. mc_led_info[multi_index].color_index = color_id;
  462. num_colors++;
  463. }
  464. led->priv = priv;
  465. led->mc_cdev.num_colors = num_colors;
  466. led->mc_cdev.subled_info = mc_led_info;
  467. led_cdev = &led->mc_cdev.led_cdev;
  468. led_cdev->brightness_set_blocking = lp50xx_brightness_set;
  469. ret = devm_led_classdev_multicolor_register_ext(priv->dev,
  470. &led->mc_cdev,
  471. &init_data);
  472. if (ret) {
  473. dev_err(priv->dev, "led register err: %d\n", ret);
  474. return ret;
  475. }
  476. i++;
  477. }
  478. return 0;
  479. }
  480. static int lp50xx_probe(struct i2c_client *client)
  481. {
  482. struct lp50xx *led;
  483. int count;
  484. int ret;
  485. count = device_get_child_node_count(&client->dev);
  486. if (!count) {
  487. dev_err(&client->dev, "LEDs are not defined in device tree!");
  488. return -ENODEV;
  489. }
  490. led = devm_kzalloc(&client->dev, struct_size(led, leds, count),
  491. GFP_KERNEL);
  492. if (!led)
  493. return -ENOMEM;
  494. mutex_init(&led->lock);
  495. led->client = client;
  496. led->dev = &client->dev;
  497. led->chip_info = device_get_match_data(&client->dev);
  498. i2c_set_clientdata(client, led);
  499. led->regmap = devm_regmap_init_i2c(client,
  500. led->chip_info->lp50xx_regmap_config);
  501. if (IS_ERR(led->regmap)) {
  502. ret = PTR_ERR(led->regmap);
  503. dev_err(&client->dev, "Failed to allocate register map: %d\n",
  504. ret);
  505. return ret;
  506. }
  507. return lp50xx_probe_dt(led);
  508. }
  509. static void lp50xx_remove(struct i2c_client *client)
  510. {
  511. struct lp50xx *led = i2c_get_clientdata(client);
  512. int ret;
  513. ret = lp50xx_disable(led);
  514. if (ret)
  515. dev_err(led->dev, "Failed to disable chip\n");
  516. if (led->regulator) {
  517. ret = regulator_disable(led->regulator);
  518. if (ret)
  519. dev_err(led->dev, "Failed to disable regulator\n");
  520. }
  521. mutex_destroy(&led->lock);
  522. }
  523. static const struct i2c_device_id lp50xx_id[] = {
  524. { "lp5009", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5009] },
  525. { "lp5012", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5012] },
  526. { "lp5018", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5018] },
  527. { "lp5024", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5024] },
  528. { "lp5030", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5030] },
  529. { "lp5036", (kernel_ulong_t)&lp50xx_chip_info_tbl[LP5036] },
  530. { }
  531. };
  532. MODULE_DEVICE_TABLE(i2c, lp50xx_id);
  533. static const struct of_device_id of_lp50xx_leds_match[] = {
  534. { .compatible = "ti,lp5009", .data = &lp50xx_chip_info_tbl[LP5009] },
  535. { .compatible = "ti,lp5012", .data = &lp50xx_chip_info_tbl[LP5012] },
  536. { .compatible = "ti,lp5018", .data = &lp50xx_chip_info_tbl[LP5018] },
  537. { .compatible = "ti,lp5024", .data = &lp50xx_chip_info_tbl[LP5024] },
  538. { .compatible = "ti,lp5030", .data = &lp50xx_chip_info_tbl[LP5030] },
  539. { .compatible = "ti,lp5036", .data = &lp50xx_chip_info_tbl[LP5036] },
  540. {}
  541. };
  542. MODULE_DEVICE_TABLE(of, of_lp50xx_leds_match);
  543. static struct i2c_driver lp50xx_driver = {
  544. .driver = {
  545. .name = "lp50xx",
  546. .of_match_table = of_lp50xx_leds_match,
  547. },
  548. .probe = lp50xx_probe,
  549. .remove = lp50xx_remove,
  550. .id_table = lp50xx_id,
  551. };
  552. module_i2c_driver(lp50xx_driver);
  553. MODULE_DESCRIPTION("Texas Instruments LP50XX LED driver");
  554. MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com>");
  555. MODULE_LICENSE("GPL v2");