leds-lm3532.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747
  1. // SPDX-License-Identifier: GPL-2.0
  2. // TI LM3532 LED driver
  3. // Copyright (C) 2019 Texas Instruments Incorporated - https://www.ti.com/
  4. // https://www.ti.com/lit/ds/symlink/lm3532.pdf
  5. #include <linux/i2c.h>
  6. #include <linux/leds.h>
  7. #include <linux/slab.h>
  8. #include <linux/regmap.h>
  9. #include <linux/types.h>
  10. #include <linux/regulator/consumer.h>
  11. #include <linux/module.h>
  12. #include <uapi/linux/uleds.h>
  13. #include <linux/gpio/consumer.h>
  14. #define LM3532_NAME "lm3532-led"
  15. #define LM3532_BL_MODE_MANUAL 0x00
  16. #define LM3532_BL_MODE_ALS 0x01
  17. #define LM3532_REG_OUTPUT_CFG 0x10
  18. #define LM3532_REG_STARTSHUT_RAMP 0x11
  19. #define LM3532_REG_RT_RAMP 0x12
  20. #define LM3532_REG_PWM_A_CFG 0x13
  21. #define LM3532_REG_PWM_B_CFG 0x14
  22. #define LM3532_REG_PWM_C_CFG 0x15
  23. #define LM3532_REG_ZONE_CFG_A 0x16
  24. #define LM3532_REG_CTRL_A_FS_CURR 0x17
  25. #define LM3532_REG_ZONE_CFG_B 0x18
  26. #define LM3532_REG_CTRL_B_FS_CURR 0x19
  27. #define LM3532_REG_ZONE_CFG_C 0x1a
  28. #define LM3532_REG_CTRL_C_FS_CURR 0x1b
  29. #define LM3532_REG_ENABLE 0x1d
  30. #define LM3532_ALS_CONFIG 0x23
  31. #define LM3532_REG_ZN_0_HI 0x60
  32. #define LM3532_REG_ZN_0_LO 0x61
  33. #define LM3532_REG_ZN_1_HI 0x62
  34. #define LM3532_REG_ZN_1_LO 0x63
  35. #define LM3532_REG_ZN_2_HI 0x64
  36. #define LM3532_REG_ZN_2_LO 0x65
  37. #define LM3532_REG_ZN_3_HI 0x66
  38. #define LM3532_REG_ZN_3_LO 0x67
  39. #define LM3532_REG_ZONE_TRGT_A 0x70
  40. #define LM3532_REG_ZONE_TRGT_B 0x75
  41. #define LM3532_REG_ZONE_TRGT_C 0x7a
  42. #define LM3532_REG_MAX 0x7e
  43. /* Control Enable */
  44. #define LM3532_CTRL_A_ENABLE BIT(0)
  45. #define LM3532_CTRL_B_ENABLE BIT(1)
  46. #define LM3532_CTRL_C_ENABLE BIT(2)
  47. /* PWM Zone Control */
  48. #define LM3532_PWM_ZONE_MASK 0x7c
  49. #define LM3532_PWM_ZONE_0_EN BIT(2)
  50. #define LM3532_PWM_ZONE_1_EN BIT(3)
  51. #define LM3532_PWM_ZONE_2_EN BIT(4)
  52. #define LM3532_PWM_ZONE_3_EN BIT(5)
  53. #define LM3532_PWM_ZONE_4_EN BIT(6)
  54. /* Brightness Configuration */
  55. #define LM3532_I2C_CTRL BIT(0)
  56. #define LM3532_ALS_CTRL 0
  57. #define LM3532_LINEAR_MAP BIT(1)
  58. #define LM3532_ZONE_MASK (BIT(2) | BIT(3) | BIT(4))
  59. #define LM3532_ZONE_0 0
  60. #define LM3532_ZONE_1 BIT(2)
  61. #define LM3532_ZONE_2 BIT(3)
  62. #define LM3532_ZONE_3 (BIT(2) | BIT(3))
  63. #define LM3532_ZONE_4 BIT(4)
  64. #define LM3532_ENABLE_ALS BIT(3)
  65. #define LM3532_ALS_SEL_SHIFT 6
  66. /* Zone Boundary Register */
  67. #define LM3532_ALS_WINDOW_mV 2000
  68. #define LM3532_ALS_ZB_MAX 4
  69. #define LM3532_ALS_OFFSET_mV 2
  70. #define LM3532_CONTROL_A 0
  71. #define LM3532_CONTROL_B 1
  72. #define LM3532_CONTROL_C 2
  73. #define LM3532_MAX_CONTROL_BANKS 3
  74. #define LM3532_MAX_LED_STRINGS 3
  75. #define LM3532_OUTPUT_CFG_MASK 0x3
  76. #define LM3532_BRT_VAL_ADJUST 8
  77. #define LM3532_RAMP_DOWN_SHIFT 3
  78. #define LM3532_NUM_RAMP_VALS 8
  79. #define LM3532_NUM_AVG_VALS 8
  80. #define LM3532_NUM_IMP_VALS 32
  81. #define LM3532_FS_CURR_MIN 5000
  82. #define LM3532_FS_CURR_MAX 29800
  83. #define LM3532_FS_CURR_STEP 800
  84. /*
  85. * struct lm3532_als_data
  86. * @config: value of ALS configuration register
  87. * @als1_imp_sel: value of ALS1 resistor select register
  88. * @als2_imp_sel: value of ALS2 resistor select register
  89. * @als_avrg_time: ALS averaging time
  90. * @als_input_mode: ALS input mode for brightness control
  91. * @als_vmin: Minimum ALS voltage
  92. * @als_vmax: Maximum ALS voltage
  93. * @zone_lo: values of ALS lo ZB(Zone Boundary) registers
  94. * @zone_hi: values of ALS hi ZB(Zone Boundary) registers
  95. */
  96. struct lm3532_als_data {
  97. u8 config;
  98. u8 als1_imp_sel;
  99. u8 als2_imp_sel;
  100. u8 als_avrg_time;
  101. u8 als_input_mode;
  102. u32 als_vmin;
  103. u32 als_vmax;
  104. u8 zones_lo[LM3532_ALS_ZB_MAX];
  105. u8 zones_hi[LM3532_ALS_ZB_MAX];
  106. };
  107. /**
  108. * struct lm3532_led
  109. * @led_dev: led class device
  110. * @priv: Pointer the device data structure
  111. * @control_bank: Control bank the LED is associated to
  112. * @mode: Mode of the LED string
  113. * @ctrl_brt_pointer: Zone target register that controls the sink
  114. * @num_leds: Number of LED strings are supported in this array
  115. * @full_scale_current: The full-scale current setting for the current sink.
  116. * @led_strings: The LED strings supported in this array
  117. * @enabled: Enabled status
  118. */
  119. struct lm3532_led {
  120. struct led_classdev led_dev;
  121. struct lm3532_data *priv;
  122. int control_bank;
  123. int mode;
  124. int ctrl_brt_pointer;
  125. int num_leds;
  126. int full_scale_current;
  127. unsigned int enabled:1;
  128. u32 led_strings[LM3532_MAX_CONTROL_BANKS];
  129. };
  130. /**
  131. * struct lm3532_data
  132. * @enable_gpio: Hardware enable gpio
  133. * @regulator: regulator
  134. * @client: i2c client
  135. * @regmap: Devices register map
  136. * @dev: Pointer to the devices device struct
  137. * @lock: Lock for reading/writing the device
  138. * @als_data: Pointer to the als data struct
  139. * @runtime_ramp_up: Runtime ramp up setting
  140. * @runtime_ramp_down: Runtime ramp down setting
  141. * @leds: Array of LED strings
  142. */
  143. struct lm3532_data {
  144. struct gpio_desc *enable_gpio;
  145. struct regulator *regulator;
  146. struct i2c_client *client;
  147. struct regmap *regmap;
  148. struct device *dev;
  149. struct mutex lock;
  150. struct lm3532_als_data *als_data;
  151. u32 runtime_ramp_up;
  152. u32 runtime_ramp_down;
  153. struct lm3532_led leds[];
  154. };
  155. static const struct reg_default lm3532_reg_defs[] = {
  156. {LM3532_REG_OUTPUT_CFG, 0xe4},
  157. {LM3532_REG_STARTSHUT_RAMP, 0xc0},
  158. {LM3532_REG_RT_RAMP, 0xc0},
  159. {LM3532_REG_PWM_A_CFG, 0x82},
  160. {LM3532_REG_PWM_B_CFG, 0x82},
  161. {LM3532_REG_PWM_C_CFG, 0x82},
  162. {LM3532_REG_ZONE_CFG_A, 0xf1},
  163. {LM3532_REG_CTRL_A_FS_CURR, 0xf3},
  164. {LM3532_REG_ZONE_CFG_B, 0xf1},
  165. {LM3532_REG_CTRL_B_FS_CURR, 0xf3},
  166. {LM3532_REG_ZONE_CFG_C, 0xf1},
  167. {LM3532_REG_CTRL_C_FS_CURR, 0xf3},
  168. {LM3532_REG_ENABLE, 0xf8},
  169. {LM3532_ALS_CONFIG, 0x44},
  170. {LM3532_REG_ZN_0_HI, 0x35},
  171. {LM3532_REG_ZN_0_LO, 0x33},
  172. {LM3532_REG_ZN_1_HI, 0x6a},
  173. {LM3532_REG_ZN_1_LO, 0x66},
  174. {LM3532_REG_ZN_2_HI, 0xa1},
  175. {LM3532_REG_ZN_2_LO, 0x99},
  176. {LM3532_REG_ZN_3_HI, 0xdc},
  177. {LM3532_REG_ZN_3_LO, 0xcc},
  178. };
  179. static const struct regmap_config lm3532_regmap_config = {
  180. .reg_bits = 8,
  181. .val_bits = 8,
  182. .max_register = LM3532_REG_MAX,
  183. .reg_defaults = lm3532_reg_defs,
  184. .num_reg_defaults = ARRAY_SIZE(lm3532_reg_defs),
  185. .cache_type = REGCACHE_FLAT,
  186. };
  187. static const int als_imp_table[LM3532_NUM_IMP_VALS] = {37000, 18500, 12330,
  188. 92500, 7400, 6170, 5290,
  189. 4630, 4110, 3700, 3360,
  190. 3080, 2850, 2640, 2440,
  191. 2310, 2180, 2060, 1950,
  192. 1850, 1760, 1680, 1610,
  193. 1540, 1480, 1420, 1370,
  194. 1320, 1280, 1230, 1190};
  195. static int lm3532_get_als_imp_index(int als_imped)
  196. {
  197. int i;
  198. if (als_imped > als_imp_table[1])
  199. return 0;
  200. if (als_imped < als_imp_table[LM3532_NUM_IMP_VALS - 1])
  201. return LM3532_NUM_IMP_VALS - 1;
  202. for (i = 1; i < LM3532_NUM_IMP_VALS; i++) {
  203. if (als_imped == als_imp_table[i])
  204. return i;
  205. /* Find an approximate index by looking up the table */
  206. if (als_imped < als_imp_table[i - 1] &&
  207. als_imped > als_imp_table[i]) {
  208. if (als_imped - als_imp_table[i - 1] <
  209. als_imp_table[i] - als_imped)
  210. return i + 1;
  211. else
  212. return i;
  213. }
  214. }
  215. return -EINVAL;
  216. }
  217. static int lm3532_get_index(const int table[], int size, int value)
  218. {
  219. int i;
  220. for (i = 1; i < size; i++) {
  221. if (value == table[i])
  222. return i;
  223. /* Find an approximate index by looking up the table */
  224. if (value > table[i - 1] &&
  225. value < table[i]) {
  226. if (value - table[i - 1] < table[i] - value)
  227. return i - 1;
  228. else
  229. return i;
  230. }
  231. }
  232. return -EINVAL;
  233. }
  234. static const int als_avrg_table[LM3532_NUM_AVG_VALS] = {17920, 35840, 71680,
  235. 1433360, 286720, 573440,
  236. 1146880, 2293760};
  237. static int lm3532_get_als_avg_index(int avg_time)
  238. {
  239. if (avg_time <= als_avrg_table[0])
  240. return 0;
  241. if (avg_time > als_avrg_table[LM3532_NUM_AVG_VALS - 1])
  242. return LM3532_NUM_AVG_VALS - 1;
  243. return lm3532_get_index(&als_avrg_table[0], LM3532_NUM_AVG_VALS,
  244. avg_time);
  245. }
  246. static const int ramp_table[LM3532_NUM_RAMP_VALS] = { 8, 1024, 2048, 4096, 8192,
  247. 16384, 32768, 65536};
  248. static int lm3532_get_ramp_index(int ramp_time)
  249. {
  250. if (ramp_time <= ramp_table[0])
  251. return 0;
  252. if (ramp_time > ramp_table[LM3532_NUM_RAMP_VALS - 1])
  253. return LM3532_NUM_RAMP_VALS - 1;
  254. return lm3532_get_index(&ramp_table[0], LM3532_NUM_RAMP_VALS,
  255. ramp_time);
  256. }
  257. /* Caller must take care of locking */
  258. static int lm3532_led_enable(struct lm3532_led *led_data)
  259. {
  260. int ctrl_en_val = BIT(led_data->control_bank);
  261. int ret;
  262. if (led_data->enabled)
  263. return 0;
  264. ret = regmap_update_bits(led_data->priv->regmap, LM3532_REG_ENABLE,
  265. ctrl_en_val, ctrl_en_val);
  266. if (ret) {
  267. dev_err(led_data->priv->dev, "Failed to set ctrl:%d\n", ret);
  268. return ret;
  269. }
  270. ret = regulator_enable(led_data->priv->regulator);
  271. if (ret < 0)
  272. return ret;
  273. led_data->enabled = 1;
  274. return 0;
  275. }
  276. /* Caller must take care of locking */
  277. static int lm3532_led_disable(struct lm3532_led *led_data)
  278. {
  279. int ctrl_en_val = BIT(led_data->control_bank);
  280. int ret;
  281. if (!led_data->enabled)
  282. return 0;
  283. ret = regmap_update_bits(led_data->priv->regmap, LM3532_REG_ENABLE,
  284. ctrl_en_val, 0);
  285. if (ret) {
  286. dev_err(led_data->priv->dev, "Failed to set ctrl:%d\n", ret);
  287. return ret;
  288. }
  289. ret = regulator_disable(led_data->priv->regulator);
  290. if (ret < 0)
  291. return ret;
  292. led_data->enabled = 0;
  293. return 0;
  294. }
  295. static int lm3532_brightness_set(struct led_classdev *led_cdev,
  296. enum led_brightness brt_val)
  297. {
  298. struct lm3532_led *led =
  299. container_of(led_cdev, struct lm3532_led, led_dev);
  300. u8 brightness_reg;
  301. int ret;
  302. mutex_lock(&led->priv->lock);
  303. if (led->mode == LM3532_ALS_CTRL) {
  304. if (brt_val > LED_OFF)
  305. ret = lm3532_led_enable(led);
  306. else
  307. ret = lm3532_led_disable(led);
  308. goto unlock;
  309. }
  310. if (brt_val == LED_OFF) {
  311. ret = lm3532_led_disable(led);
  312. goto unlock;
  313. }
  314. ret = lm3532_led_enable(led);
  315. if (ret)
  316. goto unlock;
  317. brightness_reg = LM3532_REG_ZONE_TRGT_A + led->control_bank * 5 +
  318. (led->ctrl_brt_pointer >> 2);
  319. ret = regmap_write(led->priv->regmap, brightness_reg, brt_val);
  320. unlock:
  321. mutex_unlock(&led->priv->lock);
  322. return ret;
  323. }
  324. static int lm3532_init_registers(struct lm3532_led *led)
  325. {
  326. struct lm3532_data *drvdata = led->priv;
  327. unsigned int runtime_ramp_val;
  328. unsigned int output_cfg_val = 0;
  329. unsigned int output_cfg_shift = 0;
  330. unsigned int output_cfg_mask = 0;
  331. unsigned int brightness_config_reg;
  332. unsigned int brightness_config_val;
  333. int fs_current_reg;
  334. int fs_current_val;
  335. int ret, i;
  336. if (drvdata->enable_gpio)
  337. gpiod_direction_output(drvdata->enable_gpio, 1);
  338. brightness_config_reg = LM3532_REG_ZONE_CFG_A + led->control_bank * 2;
  339. /*
  340. * This could be hard coded to the default value but the control
  341. * brightness register may have changed during boot.
  342. */
  343. ret = regmap_read(drvdata->regmap, brightness_config_reg,
  344. &led->ctrl_brt_pointer);
  345. if (ret)
  346. return ret;
  347. led->ctrl_brt_pointer &= LM3532_ZONE_MASK;
  348. brightness_config_val = led->ctrl_brt_pointer | led->mode;
  349. ret = regmap_write(drvdata->regmap, brightness_config_reg,
  350. brightness_config_val);
  351. if (ret)
  352. return ret;
  353. if (led->full_scale_current) {
  354. fs_current_reg = LM3532_REG_CTRL_A_FS_CURR + led->control_bank * 2;
  355. fs_current_val = (led->full_scale_current - LM3532_FS_CURR_MIN) /
  356. LM3532_FS_CURR_STEP;
  357. ret = regmap_write(drvdata->regmap, fs_current_reg,
  358. fs_current_val);
  359. if (ret)
  360. return ret;
  361. }
  362. for (i = 0; i < led->num_leds; i++) {
  363. output_cfg_shift = led->led_strings[i] * 2;
  364. output_cfg_val |= (led->control_bank << output_cfg_shift);
  365. output_cfg_mask |= LM3532_OUTPUT_CFG_MASK << output_cfg_shift;
  366. }
  367. ret = regmap_update_bits(drvdata->regmap, LM3532_REG_OUTPUT_CFG,
  368. output_cfg_mask, output_cfg_val);
  369. if (ret)
  370. return ret;
  371. runtime_ramp_val = drvdata->runtime_ramp_up |
  372. (drvdata->runtime_ramp_down << LM3532_RAMP_DOWN_SHIFT);
  373. return regmap_write(drvdata->regmap, LM3532_REG_RT_RAMP,
  374. runtime_ramp_val);
  375. }
  376. static int lm3532_als_configure(struct lm3532_data *priv,
  377. struct lm3532_led *led)
  378. {
  379. struct lm3532_als_data *als = priv->als_data;
  380. u32 als_vmin, als_vmax, als_vstep;
  381. int zone_reg = LM3532_REG_ZN_0_HI;
  382. int ret;
  383. int i;
  384. als_vmin = als->als_vmin;
  385. als_vmax = als->als_vmax;
  386. als_vstep = (als_vmax - als_vmin) / ((LM3532_ALS_ZB_MAX + 1) * 2);
  387. for (i = 0; i < LM3532_ALS_ZB_MAX; i++) {
  388. als->zones_lo[i] = ((als_vmin + als_vstep + (i * als_vstep)) *
  389. LED_FULL) / 1000;
  390. als->zones_hi[i] = ((als_vmin + LM3532_ALS_OFFSET_mV +
  391. als_vstep + (i * als_vstep)) * LED_FULL) / 1000;
  392. zone_reg = LM3532_REG_ZN_0_HI + i * 2;
  393. ret = regmap_write(priv->regmap, zone_reg, als->zones_lo[i]);
  394. if (ret)
  395. return ret;
  396. zone_reg += 1;
  397. ret = regmap_write(priv->regmap, zone_reg, als->zones_hi[i]);
  398. if (ret)
  399. return ret;
  400. }
  401. als->config = (als->als_avrg_time | (LM3532_ENABLE_ALS) |
  402. (als->als_input_mode << LM3532_ALS_SEL_SHIFT));
  403. return regmap_write(priv->regmap, LM3532_ALS_CONFIG, als->config);
  404. }
  405. static int lm3532_parse_als(struct lm3532_data *priv)
  406. {
  407. struct lm3532_als_data *als;
  408. int als_avg_time;
  409. int als_impedance;
  410. int ret;
  411. als = devm_kzalloc(priv->dev, sizeof(*als), GFP_KERNEL);
  412. if (als == NULL)
  413. return -ENOMEM;
  414. ret = device_property_read_u32(&priv->client->dev, "ti,als-vmin",
  415. &als->als_vmin);
  416. if (ret)
  417. als->als_vmin = 0;
  418. ret = device_property_read_u32(&priv->client->dev, "ti,als-vmax",
  419. &als->als_vmax);
  420. if (ret)
  421. als->als_vmax = LM3532_ALS_WINDOW_mV;
  422. if (als->als_vmax > LM3532_ALS_WINDOW_mV) {
  423. ret = -EINVAL;
  424. return ret;
  425. }
  426. ret = device_property_read_u32(&priv->client->dev, "ti,als1-imp-sel",
  427. &als_impedance);
  428. if (ret)
  429. als->als1_imp_sel = 0;
  430. else
  431. als->als1_imp_sel = lm3532_get_als_imp_index(als_impedance);
  432. ret = device_property_read_u32(&priv->client->dev, "ti,als2-imp-sel",
  433. &als_impedance);
  434. if (ret)
  435. als->als2_imp_sel = 0;
  436. else
  437. als->als2_imp_sel = lm3532_get_als_imp_index(als_impedance);
  438. ret = device_property_read_u32(&priv->client->dev, "ti,als-avrg-time-us",
  439. &als_avg_time);
  440. if (ret)
  441. als->als_avrg_time = 0;
  442. else
  443. als->als_avrg_time = lm3532_get_als_avg_index(als_avg_time);
  444. ret = device_property_read_u8(&priv->client->dev, "ti,als-input-mode",
  445. &als->als_input_mode);
  446. if (ret)
  447. als->als_input_mode = 0;
  448. if (als->als_input_mode > LM3532_BL_MODE_ALS) {
  449. ret = -EINVAL;
  450. return ret;
  451. }
  452. priv->als_data = als;
  453. return ret;
  454. }
  455. static int lm3532_parse_node(struct lm3532_data *priv)
  456. {
  457. struct fwnode_handle *child = NULL;
  458. struct lm3532_led *led;
  459. int control_bank;
  460. u32 ramp_time;
  461. size_t i = 0;
  462. int ret;
  463. priv->enable_gpio = devm_gpiod_get_optional(&priv->client->dev,
  464. "enable", GPIOD_OUT_LOW);
  465. if (IS_ERR(priv->enable_gpio))
  466. priv->enable_gpio = NULL;
  467. priv->regulator = devm_regulator_get(&priv->client->dev, "vin");
  468. if (IS_ERR(priv->regulator))
  469. priv->regulator = NULL;
  470. ret = device_property_read_u32(&priv->client->dev, "ramp-up-us",
  471. &ramp_time);
  472. if (ret)
  473. dev_info(&priv->client->dev, "ramp-up-ms property missing\n");
  474. else
  475. priv->runtime_ramp_up = lm3532_get_ramp_index(ramp_time);
  476. ret = device_property_read_u32(&priv->client->dev, "ramp-down-us",
  477. &ramp_time);
  478. if (ret)
  479. dev_info(&priv->client->dev, "ramp-down-ms property missing\n");
  480. else
  481. priv->runtime_ramp_down = lm3532_get_ramp_index(ramp_time);
  482. device_for_each_child_node(priv->dev, child) {
  483. struct led_init_data idata = {
  484. .fwnode = child,
  485. .default_label = ":",
  486. .devicename = priv->client->name,
  487. };
  488. led = &priv->leds[i];
  489. ret = fwnode_property_read_u32(child, "reg", &control_bank);
  490. if (ret) {
  491. dev_err(&priv->client->dev, "reg property missing\n");
  492. fwnode_handle_put(child);
  493. goto child_out;
  494. }
  495. if (control_bank > LM3532_CONTROL_C) {
  496. dev_err(&priv->client->dev, "Control bank invalid\n");
  497. continue;
  498. }
  499. led->control_bank = control_bank;
  500. ret = fwnode_property_read_u32(child, "ti,led-mode",
  501. &led->mode);
  502. if (ret) {
  503. dev_err(&priv->client->dev, "ti,led-mode property missing\n");
  504. fwnode_handle_put(child);
  505. goto child_out;
  506. }
  507. if (fwnode_property_present(child, "led-max-microamp") &&
  508. fwnode_property_read_u32(child, "led-max-microamp",
  509. &led->full_scale_current))
  510. dev_err(&priv->client->dev,
  511. "Failed getting led-max-microamp\n");
  512. else
  513. led->full_scale_current = min(led->full_scale_current,
  514. LM3532_FS_CURR_MAX);
  515. if (led->mode == LM3532_BL_MODE_ALS) {
  516. led->mode = LM3532_ALS_CTRL;
  517. ret = lm3532_parse_als(priv);
  518. if (ret)
  519. dev_err(&priv->client->dev, "Failed to parse als\n");
  520. else
  521. lm3532_als_configure(priv, led);
  522. } else {
  523. led->mode = LM3532_I2C_CTRL;
  524. }
  525. led->num_leds = fwnode_property_count_u32(child, "led-sources");
  526. if (led->num_leds > LM3532_MAX_LED_STRINGS) {
  527. dev_err(&priv->client->dev, "Too many LED string defined\n");
  528. continue;
  529. }
  530. ret = fwnode_property_read_u32_array(child, "led-sources",
  531. led->led_strings,
  532. led->num_leds);
  533. if (ret) {
  534. dev_err(&priv->client->dev, "led-sources property missing\n");
  535. fwnode_handle_put(child);
  536. goto child_out;
  537. }
  538. led->priv = priv;
  539. led->led_dev.brightness_set_blocking = lm3532_brightness_set;
  540. ret = devm_led_classdev_register_ext(priv->dev, &led->led_dev, &idata);
  541. if (ret) {
  542. dev_err(&priv->client->dev, "led register err: %d\n",
  543. ret);
  544. fwnode_handle_put(child);
  545. goto child_out;
  546. }
  547. ret = lm3532_init_registers(led);
  548. if (ret) {
  549. dev_err(&priv->client->dev, "register init err: %d\n",
  550. ret);
  551. fwnode_handle_put(child);
  552. goto child_out;
  553. }
  554. i++;
  555. }
  556. child_out:
  557. return ret;
  558. }
  559. static int lm3532_probe(struct i2c_client *client,
  560. const struct i2c_device_id *id)
  561. {
  562. struct lm3532_data *drvdata;
  563. int ret = 0;
  564. int count;
  565. count = device_get_child_node_count(&client->dev);
  566. if (!count) {
  567. dev_err(&client->dev, "LEDs are not defined in device tree!");
  568. return -ENODEV;
  569. }
  570. drvdata = devm_kzalloc(&client->dev, struct_size(drvdata, leds, count),
  571. GFP_KERNEL);
  572. if (drvdata == NULL)
  573. return -ENOMEM;
  574. drvdata->client = client;
  575. drvdata->dev = &client->dev;
  576. drvdata->regmap = devm_regmap_init_i2c(client, &lm3532_regmap_config);
  577. if (IS_ERR(drvdata->regmap)) {
  578. ret = PTR_ERR(drvdata->regmap);
  579. dev_err(&client->dev, "Failed to allocate register map: %d\n",
  580. ret);
  581. return ret;
  582. }
  583. mutex_init(&drvdata->lock);
  584. i2c_set_clientdata(client, drvdata);
  585. ret = lm3532_parse_node(drvdata);
  586. if (ret) {
  587. dev_err(&client->dev, "Failed to parse node\n");
  588. return ret;
  589. }
  590. return ret;
  591. }
  592. static int lm3532_remove(struct i2c_client *client)
  593. {
  594. struct lm3532_data *drvdata = i2c_get_clientdata(client);
  595. mutex_destroy(&drvdata->lock);
  596. if (drvdata->enable_gpio)
  597. gpiod_direction_output(drvdata->enable_gpio, 0);
  598. return 0;
  599. }
  600. static const struct of_device_id of_lm3532_leds_match[] = {
  601. { .compatible = "ti,lm3532", },
  602. {},
  603. };
  604. MODULE_DEVICE_TABLE(of, of_lm3532_leds_match);
  605. static const struct i2c_device_id lm3532_id[] = {
  606. {LM3532_NAME, 0},
  607. {}
  608. };
  609. MODULE_DEVICE_TABLE(i2c, lm3532_id);
  610. static struct i2c_driver lm3532_i2c_driver = {
  611. .probe = lm3532_probe,
  612. .remove = lm3532_remove,
  613. .id_table = lm3532_id,
  614. .driver = {
  615. .name = LM3532_NAME,
  616. .of_match_table = of_lm3532_leds_match,
  617. },
  618. };
  619. module_i2c_driver(lm3532_i2c_driver);
  620. MODULE_DESCRIPTION("Back Light driver for LM3532");
  621. MODULE_LICENSE("GPL v2");
  622. MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com>");