1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2017-2022 Linaro Ltd
4 * Copyright (c) 2010-2012, The Linux Foundation. All rights reserved.
5 * Copyright (c) Qualcomm Technologies, Inc. and/or its subsidiaries.
6 */
7 #include <linux/bits.h>
8 #include <linux/bitfield.h>
9 #include <linux/led-class-multicolor.h>
10 #include <linux/module.h>
11 #include <linux/nvmem-consumer.h>
12 #include <linux/of.h>
13 #include <linux/platform_device.h>
14 #include <linux/pwm.h>
15 #include <linux/regmap.h>
16 #include <linux/slab.h>
17 #include <linux/soc/qcom/qcom-pbs.h>
18
19 #define LPG_SUBTYPE_REG 0x05
20 #define LPG_SUBTYPE_LPG 0x2
21 #define LPG_SUBTYPE_PWM 0xb
22 #define LPG_SUBTYPE_HI_RES_PWM 0xc
23 #define LPG_SUBTYPE_LPG_LITE 0x11
24 #define LPG_PATTERN_CONFIG_REG 0x40
25 #define LPG_SIZE_CLK_REG 0x41
26 #define PWM_CLK_SELECT_MASK GENMASK(1, 0)
27 #define PWM_SIZE_SELECT_MASK BIT(2)
28 #define PWM_CLK_SELECT_HI_RES_MASK GENMASK(2, 0)
29 #define PWM_SIZE_HI_RES_MASK GENMASK(6, 4)
30 #define LPG_PREDIV_CLK_REG 0x42
31 #define PWM_FREQ_PRE_DIV_MASK GENMASK(6, 5)
32 #define PWM_FREQ_EXP_MASK GENMASK(2, 0)
33 #define PWM_TYPE_CONFIG_REG 0x43
34 #define PWM_VALUE_REG 0x44
35 #define PWM_ENABLE_CONTROL_REG 0x46
36 #define PWM_SYNC_REG 0x47
37 #define LPG_RAMP_DURATION_REG 0x50
38 #define LPG_HI_PAUSE_REG 0x52
39 #define LPG_LO_PAUSE_REG 0x54
40 #define LPG_HI_IDX_REG 0x56
41 #define LPG_LO_IDX_REG 0x57
42 #define PWM_SEC_ACCESS_REG 0xd0
43 #define PWM_DTEST_REG(x) (0xe2 + (x) - 1)
44
45 #define SDAM_REG_PBS_SEQ_EN 0x42
46 #define SDAM_PBS_TRIG_SET 0xe5
47 #define SDAM_PBS_TRIG_CLR 0xe6
48
49 #define TRI_LED_SRC_SEL 0x45
50 #define TRI_LED_EN_CTL 0x46
51 #define TRI_LED_ATC_CTL 0x47
52
53 #define LPG_LUT_REG(x) (0x40 + (x) * 2)
54 #define RAMP_CONTROL_REG 0xc8
55
56 #define LPG_RESOLUTION_9BIT BIT(9)
57 #define LPG_RESOLUTION_15BIT BIT(15)
58 #define PPG_MAX_LED_BRIGHTNESS 255
59
60 #define LPG_MAX_M 7
61 #define LPG_MAX_PREDIV 6
62
63 #define DEFAULT_TICK_DURATION_US 7800
64 #define RAMP_STEP_DURATION(x) (((x) * 1000 / DEFAULT_TICK_DURATION_US) & 0xff)
65
66 #define SDAM_MAX_DEVICES 2
67 /* LPG common config settings for PPG */
68 #define SDAM_START_BASE 0x40
69 #define SDAM_REG_RAMP_STEP_DURATION 0x47
70
71 #define SDAM_LUT_SDAM_LUT_PATTERN_OFFSET 0x45
72 #define SDAM_LPG_SDAM_LUT_PATTERN_OFFSET 0x80
73
74 /* LPG per channel config settings for PPG */
75 #define SDAM_LUT_EN_OFFSET 0x0
76 #define SDAM_PATTERN_CONFIG_OFFSET 0x1
77 #define SDAM_END_INDEX_OFFSET 0x3
78 #define SDAM_START_INDEX_OFFSET 0x4
79 #define SDAM_PBS_SCRATCH_LUT_COUNTER_OFFSET 0x6
80 #define SDAM_PAUSE_HI_MULTIPLIER_OFFSET 0x8
81 #define SDAM_PAUSE_LO_MULTIPLIER_OFFSET 0x9
82
83 struct lpg_channel;
84 struct lpg_data;
85
86 /**
87 * struct lpg - LPG device context
88 * @dev: pointer to LPG device
89 * @map: regmap for register access
90 * @lock: used to synchronize LED and pwm callback requests
91 * @pwm: PWM-chip object, if operating in PWM mode
92 * @data: reference to version specific data
93 * @lut_base: base address of the LUT block (optional)
94 * @lut_size: number of entries in the LUT block
95 * @lut_bitmap: allocation bitmap for LUT entries
96 * @pbs_dev: PBS device
97 * @lpg_chan_sdam: LPG SDAM peripheral device
98 * @lut_sdam: LUT SDAM peripheral device
99 * @pbs_en_bitmap: bitmap for tracking PBS triggers
100 * @triled_base: base address of the TRILED block (optional)
101 * @triled_src: power-source for the TRILED
102 * @triled_has_atc_ctl: true if there is TRI_LED_ATC_CTL register
103 * @triled_has_src_sel: true if there is TRI_LED_SRC_SEL register
104 * @channels: list of PWM channels
105 * @num_channels: number of @channels
106 */
107 struct lpg {
108 struct device *dev;
109 struct regmap *map;
110
111 struct mutex lock;
112
113 struct pwm_chip *pwm;
114
115 const struct lpg_data *data;
116
117 u32 lut_base;
118 u32 lut_size;
119 unsigned long *lut_bitmap;
120
121 struct pbs_dev *pbs_dev;
122 struct nvmem_device *lpg_chan_sdam;
123 struct nvmem_device *lut_sdam;
124 unsigned long pbs_en_bitmap;
125
126 u32 triled_base;
127 u32 triled_src;
128 bool triled_has_atc_ctl;
129 bool triled_has_src_sel;
130
131 struct lpg_channel *channels;
132 unsigned int num_channels;
133 };
134
135 /**
136 * struct lpg_channel - per channel data
137 * @lpg: reference to parent lpg
138 * @base: base address of the PWM channel
139 * @triled_mask: mask in TRILED to enable this channel
140 * @lut_mask: mask in LUT to start pattern generator for this channel
141 * @subtype: PMIC hardware block subtype
142 * @sdam_offset: channel offset in LPG SDAM
143 * @in_use: channel is exposed to LED framework
144 * @color: color of the LED attached to this channel
145 * @dtest_line: DTEST line for output, or 0 if disabled
146 * @dtest_value: DTEST line configuration
147 * @pwm_value: duty (in microseconds) of the generated pulses, overridden by LUT
148 * @enabled: output enabled?
149 * @period: period (in nanoseconds) of the generated pulses
150 * @clk_sel: reference clock frequency selector
151 * @pre_div_sel: divider selector of the reference clock
152 * @pre_div_exp: exponential divider of the reference clock
153 * @pwm_resolution_sel: pwm resolution selector
154 * @ramp_enabled: duty cycle is driven by iterating over lookup table
155 * @ramp_ping_pong: reverse through pattern, rather than wrapping to start
156 * @ramp_oneshot: perform only a single pass over the pattern
157 * @ramp_reverse: iterate over pattern backwards
158 * @ramp_tick_ms: length (in milliseconds) of one step in the pattern
159 * @ramp_lo_pause_ms: pause (in milliseconds) before iterating over pattern
160 * @ramp_hi_pause_ms: pause (in milliseconds) after iterating over pattern
161 * @pattern_lo_idx: start index of associated pattern
162 * @pattern_hi_idx: last index of associated pattern
163 */
164 struct lpg_channel {
165 struct lpg *lpg;
166
167 u32 base;
168 unsigned int triled_mask;
169 unsigned int lut_mask;
170 unsigned int subtype;
171 u32 sdam_offset;
172
173 bool in_use;
174
175 int color;
176
177 u32 dtest_line;
178 u32 dtest_value;
179
180 u16 pwm_value;
181 bool enabled;
182
183 u64 period;
184 unsigned int clk_sel;
185 unsigned int pre_div_sel;
186 unsigned int pre_div_exp;
187 unsigned int pwm_resolution_sel;
188
189 bool ramp_enabled;
190 bool ramp_ping_pong;
191 bool ramp_oneshot;
192 bool ramp_reverse;
193 unsigned short ramp_tick_ms;
194 unsigned long ramp_lo_pause_ms;
195 unsigned long ramp_hi_pause_ms;
196
197 unsigned int pattern_lo_idx;
198 unsigned int pattern_hi_idx;
199 };
200
201 /**
202 * struct lpg_led - logical LED object
203 * @lpg: lpg context reference
204 * @cdev: LED class device
205 * @mcdev: Multicolor LED class device
206 * @num_channels: number of @channels
207 * @channels: list of channels associated with the LED
208 */
209 struct lpg_led {
210 struct lpg *lpg;
211
212 struct led_classdev cdev;
213 struct led_classdev_mc mcdev;
214
215 unsigned int num_channels;
216 struct lpg_channel *channels[] __counted_by(num_channels);
217 };
218
219 /**
220 * struct lpg_channel_data - per channel initialization data
221 * @sdam_offset: Channel offset in LPG SDAM
222 * @base: base address for PWM channel registers
223 * @triled_mask: bitmask for controlling this channel in TRILED
224 */
225 struct lpg_channel_data {
226 unsigned int sdam_offset;
227 unsigned int base;
228 u8 triled_mask;
229 };
230
231 /**
232 * struct lpg_data - initialization data
233 * @lut_base: base address of LUT block
234 * @lut_size: number of entries in LUT
235 * @triled_base: base address of TRILED
236 * @triled_has_atc_ctl: true if there is TRI_LED_ATC_CTL register
237 * @triled_has_src_sel: true if there is TRI_LED_SRC_SEL register
238 * @num_channels: number of channels in LPG
239 * @channels: list of channel initialization data
240 */
241 struct lpg_data {
242 unsigned int lut_base;
243 unsigned int lut_size;
244 unsigned int triled_base;
245 bool triled_has_atc_ctl;
246 bool triled_has_src_sel;
247 int num_channels;
248 const struct lpg_channel_data *channels;
249 };
250
251 #define PBS_SW_TRIG_BIT BIT(0)
252
lpg_clear_pbs_trigger(struct lpg * lpg,unsigned int lut_mask)253 static int lpg_clear_pbs_trigger(struct lpg *lpg, unsigned int lut_mask)
254 {
255 u8 val = 0;
256 int rc;
257
258 if (!lpg->lpg_chan_sdam)
259 return 0;
260
261 lpg->pbs_en_bitmap &= (~lut_mask);
262 if (!lpg->pbs_en_bitmap) {
263 rc = nvmem_device_write(lpg->lpg_chan_sdam, SDAM_REG_PBS_SEQ_EN, 1, &val);
264 if (rc < 0)
265 return rc;
266
267 if (lpg->lut_sdam) {
268 val = PBS_SW_TRIG_BIT;
269 rc = nvmem_device_write(lpg->lpg_chan_sdam, SDAM_PBS_TRIG_CLR, 1, &val);
270 if (rc < 0)
271 return rc;
272 }
273 }
274
275 return 0;
276 }
277
lpg_set_pbs_trigger(struct lpg * lpg,unsigned int lut_mask)278 static int lpg_set_pbs_trigger(struct lpg *lpg, unsigned int lut_mask)
279 {
280 u8 val = PBS_SW_TRIG_BIT;
281 int rc;
282
283 if (!lpg->lpg_chan_sdam)
284 return 0;
285
286 if (!lpg->pbs_en_bitmap) {
287 rc = nvmem_device_write(lpg->lpg_chan_sdam, SDAM_REG_PBS_SEQ_EN, 1, &val);
288 if (rc < 0)
289 return rc;
290
291 if (lpg->lut_sdam) {
292 rc = nvmem_device_write(lpg->lpg_chan_sdam, SDAM_PBS_TRIG_SET, 1, &val);
293 if (rc < 0)
294 return rc;
295 } else {
296 rc = qcom_pbs_trigger_event(lpg->pbs_dev, val);
297 if (rc < 0)
298 return rc;
299 }
300 }
301 lpg->pbs_en_bitmap |= lut_mask;
302
303 return 0;
304 }
305
lpg_sdam_configure_triggers(struct lpg_channel * chan,u8 set_trig)306 static int lpg_sdam_configure_triggers(struct lpg_channel *chan, u8 set_trig)
307 {
308 u32 addr = SDAM_LUT_EN_OFFSET + chan->sdam_offset;
309
310 if (!chan->lpg->lpg_chan_sdam)
311 return 0;
312
313 return nvmem_device_write(chan->lpg->lpg_chan_sdam, addr, 1, &set_trig);
314 }
315
triled_set(struct lpg * lpg,unsigned int mask,unsigned int enable)316 static int triled_set(struct lpg *lpg, unsigned int mask, unsigned int enable)
317 {
318 /* Skip if we don't have a triled block */
319 if (!lpg->triled_base)
320 return 0;
321
322 return regmap_update_bits(lpg->map, lpg->triled_base + TRI_LED_EN_CTL,
323 mask, enable);
324 }
325
lpg_lut_store_sdam(struct lpg * lpg,struct led_pattern * pattern,size_t len,unsigned int * lo_idx,unsigned int * hi_idx)326 static int lpg_lut_store_sdam(struct lpg *lpg, struct led_pattern *pattern,
327 size_t len, unsigned int *lo_idx, unsigned int *hi_idx)
328 {
329 unsigned int idx;
330 u8 brightness;
331 int i, rc;
332 u16 addr;
333
334 if (len > lpg->lut_size) {
335 dev_err(lpg->dev, "Pattern length (%zu) exceeds maximum pattern length (%d)\n",
336 len, lpg->lut_size);
337 return -EINVAL;
338 }
339
340 idx = bitmap_find_next_zero_area(lpg->lut_bitmap, lpg->lut_size, 0, len, 0);
341 if (idx >= lpg->lut_size)
342 return -ENOSPC;
343
344 for (i = 0; i < len; i++) {
345 brightness = pattern[i].brightness;
346
347 if (lpg->lut_sdam) {
348 addr = SDAM_LUT_SDAM_LUT_PATTERN_OFFSET + i + idx;
349 rc = nvmem_device_write(lpg->lut_sdam, addr, 1, &brightness);
350 } else {
351 addr = SDAM_LPG_SDAM_LUT_PATTERN_OFFSET + i + idx;
352 rc = nvmem_device_write(lpg->lpg_chan_sdam, addr, 1, &brightness);
353 }
354
355 if (rc < 0)
356 return rc;
357 }
358
359 bitmap_set(lpg->lut_bitmap, idx, len);
360
361 *lo_idx = idx;
362 *hi_idx = idx + len - 1;
363
364 return 0;
365 }
366
lpg_lut_store(struct lpg * lpg,struct led_pattern * pattern,size_t len,unsigned int * lo_idx,unsigned int * hi_idx)367 static int lpg_lut_store(struct lpg *lpg, struct led_pattern *pattern,
368 size_t len, unsigned int *lo_idx, unsigned int *hi_idx)
369 {
370 unsigned int idx;
371 u16 val;
372 int i, ret;
373
374 idx = bitmap_find_next_zero_area(lpg->lut_bitmap, lpg->lut_size,
375 0, len, 0);
376 if (idx >= lpg->lut_size)
377 return -ENOMEM;
378
379 for (i = 0; i < len; i++) {
380 val = pattern[i].brightness;
381
382 ret = regmap_bulk_write(lpg->map, lpg->lut_base + LPG_LUT_REG(idx + i),
383 &val, sizeof(val));
384 if (ret)
385 return ret;
386 }
387
388 bitmap_set(lpg->lut_bitmap, idx, len);
389
390 *lo_idx = idx;
391 *hi_idx = idx + len - 1;
392
393 return 0;
394 }
395
lpg_lut_free(struct lpg * lpg,unsigned int lo_idx,unsigned int hi_idx)396 static void lpg_lut_free(struct lpg *lpg, unsigned int lo_idx, unsigned int hi_idx)
397 {
398 int len;
399
400 len = hi_idx - lo_idx + 1;
401 if (len == 1)
402 return;
403
404 bitmap_clear(lpg->lut_bitmap, lo_idx, len);
405 }
406
lpg_lut_sync(struct lpg * lpg,unsigned int mask)407 static int lpg_lut_sync(struct lpg *lpg, unsigned int mask)
408 {
409 if (!lpg->lut_base)
410 return 0;
411
412 return regmap_write(lpg->map, lpg->lut_base + RAMP_CONTROL_REG, mask);
413 }
414
415 static const unsigned int lpg_clk_rates[] = {0, 1024, 32768, 19200000};
416 static const unsigned int lpg_clk_rates_hi_res[] = {0, 1024, 32768, 19200000, 76800000};
417 static const unsigned int lpg_pre_divs[] = {1, 3, 5, 6};
418 static const unsigned int lpg_pwm_resolution[] = {6, 9};
419 static const unsigned int lpg_pwm_resolution_hi_res[] = {8, 9, 10, 11, 12, 13, 14, 15};
420
lpg_calc_freq(struct lpg_channel * chan,uint64_t period)421 static int lpg_calc_freq(struct lpg_channel *chan, uint64_t period)
422 {
423 unsigned int i, pwm_resolution_count, best_pwm_resolution_sel = 0;
424 const unsigned int *clk_rate_arr, *pwm_resolution_arr;
425 unsigned int clk_sel, clk_len, best_clk = 0;
426 unsigned int div, best_div = 0;
427 unsigned int m, best_m = 0;
428 unsigned int resolution;
429 unsigned int error;
430 unsigned int best_err = UINT_MAX;
431 u64 max_period, min_period;
432 u64 best_period = 0;
433 u64 max_res;
434
435 /*
436 * The PWM period is determined by:
437 *
438 * resolution * pre_div * 2^M
439 * period = --------------------------
440 * refclk
441 *
442 * Resolution = 2^{6 or 9} bits for PWM or
443 * 2^{8, 9, 10, 11, 12, 13, 14, 15} bits for high resolution PWM
444 * pre_div = {1, 3, 5, 6} and
445 * M = [0..7].
446 *
447 * This allows for periods between 3uS and 384s for PWM channels and periods between
448 * 3uS and 24576s for high resolution PWMs.
449 * The PWM framework wants a period of equal or lower length than requested,
450 * reject anything below minimum period.
451 */
452
453 if (chan->subtype == LPG_SUBTYPE_HI_RES_PWM) {
454 clk_rate_arr = lpg_clk_rates_hi_res;
455 clk_len = ARRAY_SIZE(lpg_clk_rates_hi_res);
456 pwm_resolution_arr = lpg_pwm_resolution_hi_res;
457 pwm_resolution_count = ARRAY_SIZE(lpg_pwm_resolution_hi_res);
458 max_res = LPG_RESOLUTION_15BIT;
459 } else {
460 clk_rate_arr = lpg_clk_rates;
461 clk_len = ARRAY_SIZE(lpg_clk_rates);
462 pwm_resolution_arr = lpg_pwm_resolution;
463 pwm_resolution_count = ARRAY_SIZE(lpg_pwm_resolution);
464 max_res = LPG_RESOLUTION_9BIT;
465 }
466
467 min_period = div64_u64((u64)NSEC_PER_SEC * ((1 << pwm_resolution_arr[0]) - 1),
468 clk_rate_arr[clk_len - 1]);
469 if (period <= min_period)
470 return -EINVAL;
471
472 /* Limit period to largest possible value, to avoid overflows */
473 max_period = div64_u64((u64)NSEC_PER_SEC * max_res * LPG_MAX_PREDIV * (1 << LPG_MAX_M),
474 1024);
475 if (period > max_period)
476 period = max_period;
477
478 /*
479 * Search for the pre_div, refclk, resolution and M by solving the rewritten formula
480 * for each refclk, resolution and pre_div value:
481 *
482 * period * refclk
483 * M = log2 -------------------------------------
484 * NSEC_PER_SEC * pre_div * resolution
485 */
486
487 for (i = 0; i < pwm_resolution_count; i++) {
488 resolution = (1 << pwm_resolution_arr[i]) - 1;
489 for (clk_sel = 1; clk_sel < clk_len; clk_sel++) {
490 u64 numerator = period * clk_rate_arr[clk_sel];
491
492 for (div = 0; div < ARRAY_SIZE(lpg_pre_divs); div++) {
493 u64 denominator = (u64)NSEC_PER_SEC * lpg_pre_divs[div] *
494 resolution;
495 u64 actual;
496 u64 ratio;
497
498 if (numerator < denominator)
499 continue;
500
501 ratio = div64_u64(numerator, denominator);
502 m = ilog2(ratio);
503 if (m > LPG_MAX_M)
504 m = LPG_MAX_M;
505
506 actual = DIV_ROUND_UP_ULL(denominator * (1 << m),
507 clk_rate_arr[clk_sel]);
508 error = period - actual;
509 if (error < best_err) {
510 best_err = error;
511 best_div = div;
512 best_m = m;
513 best_clk = clk_sel;
514 best_period = actual;
515 best_pwm_resolution_sel = i;
516 }
517 }
518 }
519 }
520 chan->clk_sel = best_clk;
521 chan->pre_div_sel = best_div;
522 chan->pre_div_exp = best_m;
523 chan->period = best_period;
524 chan->pwm_resolution_sel = best_pwm_resolution_sel;
525 return 0;
526 }
527
lpg_calc_duty(struct lpg_channel * chan,uint64_t duty)528 static void lpg_calc_duty(struct lpg_channel *chan, uint64_t duty)
529 {
530 unsigned int max;
531 unsigned int val;
532 unsigned int clk_rate;
533
534 if (chan->subtype == LPG_SUBTYPE_HI_RES_PWM) {
535 max = BIT(lpg_pwm_resolution_hi_res[chan->pwm_resolution_sel]) - 1;
536 clk_rate = lpg_clk_rates_hi_res[chan->clk_sel];
537 } else {
538 max = BIT(lpg_pwm_resolution[chan->pwm_resolution_sel]) - 1;
539 clk_rate = lpg_clk_rates[chan->clk_sel];
540 }
541
542 val = div64_u64(duty * clk_rate,
543 (u64)NSEC_PER_SEC * lpg_pre_divs[chan->pre_div_sel] * (1 << chan->pre_div_exp));
544
545 chan->pwm_value = min(val, max);
546 }
547
lpg_apply_freq(struct lpg_channel * chan)548 static void lpg_apply_freq(struct lpg_channel *chan)
549 {
550 unsigned long val;
551 struct lpg *lpg = chan->lpg;
552
553 if (!chan->enabled)
554 return;
555
556 val = chan->clk_sel;
557
558 /* Specify resolution, based on the subtype of the channel */
559 switch (chan->subtype) {
560 case LPG_SUBTYPE_LPG:
561 val |= GENMASK(5, 4);
562 break;
563 case LPG_SUBTYPE_PWM:
564 val |= FIELD_PREP(PWM_SIZE_SELECT_MASK, chan->pwm_resolution_sel);
565 break;
566 case LPG_SUBTYPE_HI_RES_PWM:
567 val |= FIELD_PREP(PWM_SIZE_HI_RES_MASK, chan->pwm_resolution_sel);
568 break;
569 case LPG_SUBTYPE_LPG_LITE:
570 default:
571 val |= BIT(4);
572 break;
573 }
574
575 regmap_write(lpg->map, chan->base + LPG_SIZE_CLK_REG, val);
576
577 val = FIELD_PREP(PWM_FREQ_PRE_DIV_MASK, chan->pre_div_sel) |
578 FIELD_PREP(PWM_FREQ_EXP_MASK, chan->pre_div_exp);
579 regmap_write(lpg->map, chan->base + LPG_PREDIV_CLK_REG, val);
580 }
581
582 #define LPG_ENABLE_GLITCH_REMOVAL BIT(5)
583
lpg_enable_glitch(struct lpg_channel * chan)584 static void lpg_enable_glitch(struct lpg_channel *chan)
585 {
586 struct lpg *lpg = chan->lpg;
587
588 regmap_update_bits(lpg->map, chan->base + PWM_TYPE_CONFIG_REG,
589 LPG_ENABLE_GLITCH_REMOVAL, 0);
590 }
591
lpg_disable_glitch(struct lpg_channel * chan)592 static void lpg_disable_glitch(struct lpg_channel *chan)
593 {
594 struct lpg *lpg = chan->lpg;
595
596 regmap_update_bits(lpg->map, chan->base + PWM_TYPE_CONFIG_REG,
597 LPG_ENABLE_GLITCH_REMOVAL,
598 LPG_ENABLE_GLITCH_REMOVAL);
599 }
600
lpg_apply_pwm_value(struct lpg_channel * chan)601 static void lpg_apply_pwm_value(struct lpg_channel *chan)
602 {
603 struct lpg *lpg = chan->lpg;
604 u16 val = chan->pwm_value;
605
606 if (!chan->enabled)
607 return;
608
609 regmap_bulk_write(lpg->map, chan->base + PWM_VALUE_REG, &val, sizeof(val));
610 }
611
612 #define LPG_PATTERN_CONFIG_LO_TO_HI BIT(4)
613 #define LPG_PATTERN_CONFIG_REPEAT BIT(3)
614 #define LPG_PATTERN_CONFIG_TOGGLE BIT(2)
615 #define LPG_PATTERN_CONFIG_PAUSE_HI BIT(1)
616 #define LPG_PATTERN_CONFIG_PAUSE_LO BIT(0)
617
lpg_sdam_apply_lut_control(struct lpg_channel * chan)618 static void lpg_sdam_apply_lut_control(struct lpg_channel *chan)
619 {
620 struct nvmem_device *lpg_chan_sdam = chan->lpg->lpg_chan_sdam;
621 unsigned int lo_idx = chan->pattern_lo_idx;
622 unsigned int hi_idx = chan->pattern_hi_idx;
623 u8 val = 0, conf = 0, lut_offset = 0;
624 unsigned int hi_pause, lo_pause;
625 struct lpg *lpg = chan->lpg;
626
627 if (!chan->ramp_enabled || chan->pattern_lo_idx == chan->pattern_hi_idx)
628 return;
629
630 hi_pause = DIV_ROUND_UP(chan->ramp_hi_pause_ms, chan->ramp_tick_ms);
631 lo_pause = DIV_ROUND_UP(chan->ramp_lo_pause_ms, chan->ramp_tick_ms);
632
633 if (!chan->ramp_oneshot)
634 conf |= LPG_PATTERN_CONFIG_REPEAT;
635 if (chan->ramp_hi_pause_ms && lpg->lut_sdam)
636 conf |= LPG_PATTERN_CONFIG_PAUSE_HI;
637 if (chan->ramp_lo_pause_ms && lpg->lut_sdam)
638 conf |= LPG_PATTERN_CONFIG_PAUSE_LO;
639
640 if (lpg->lut_sdam) {
641 lut_offset = SDAM_LUT_SDAM_LUT_PATTERN_OFFSET - SDAM_START_BASE;
642 hi_idx += lut_offset;
643 lo_idx += lut_offset;
644 }
645
646 nvmem_device_write(lpg_chan_sdam, SDAM_PBS_SCRATCH_LUT_COUNTER_OFFSET + chan->sdam_offset, 1, &val);
647 nvmem_device_write(lpg_chan_sdam, SDAM_PATTERN_CONFIG_OFFSET + chan->sdam_offset, 1, &conf);
648 nvmem_device_write(lpg_chan_sdam, SDAM_END_INDEX_OFFSET + chan->sdam_offset, 1, &hi_idx);
649 nvmem_device_write(lpg_chan_sdam, SDAM_START_INDEX_OFFSET + chan->sdam_offset, 1, &lo_idx);
650
651 val = RAMP_STEP_DURATION(chan->ramp_tick_ms);
652 nvmem_device_write(lpg_chan_sdam, SDAM_REG_RAMP_STEP_DURATION, 1, &val);
653
654 if (lpg->lut_sdam) {
655 nvmem_device_write(lpg_chan_sdam, SDAM_PAUSE_HI_MULTIPLIER_OFFSET + chan->sdam_offset, 1, &hi_pause);
656 nvmem_device_write(lpg_chan_sdam, SDAM_PAUSE_LO_MULTIPLIER_OFFSET + chan->sdam_offset, 1, &lo_pause);
657 }
658
659 }
660
lpg_apply_lut_control(struct lpg_channel * chan)661 static void lpg_apply_lut_control(struct lpg_channel *chan)
662 {
663 struct lpg *lpg = chan->lpg;
664 unsigned int hi_pause;
665 unsigned int lo_pause;
666 unsigned int conf = 0;
667 unsigned int lo_idx = chan->pattern_lo_idx;
668 unsigned int hi_idx = chan->pattern_hi_idx;
669 u16 step = chan->ramp_tick_ms;
670
671 if (!chan->ramp_enabled || chan->pattern_lo_idx == chan->pattern_hi_idx)
672 return;
673
674 hi_pause = DIV_ROUND_UP(chan->ramp_hi_pause_ms, step);
675 lo_pause = DIV_ROUND_UP(chan->ramp_lo_pause_ms, step);
676
677 if (!chan->ramp_reverse)
678 conf |= LPG_PATTERN_CONFIG_LO_TO_HI;
679 if (!chan->ramp_oneshot)
680 conf |= LPG_PATTERN_CONFIG_REPEAT;
681 if (chan->ramp_ping_pong)
682 conf |= LPG_PATTERN_CONFIG_TOGGLE;
683 if (chan->ramp_hi_pause_ms)
684 conf |= LPG_PATTERN_CONFIG_PAUSE_HI;
685 if (chan->ramp_lo_pause_ms)
686 conf |= LPG_PATTERN_CONFIG_PAUSE_LO;
687
688 regmap_write(lpg->map, chan->base + LPG_PATTERN_CONFIG_REG, conf);
689 regmap_write(lpg->map, chan->base + LPG_HI_IDX_REG, hi_idx);
690 regmap_write(lpg->map, chan->base + LPG_LO_IDX_REG, lo_idx);
691
692 regmap_bulk_write(lpg->map, chan->base + LPG_RAMP_DURATION_REG, &step, sizeof(step));
693 regmap_write(lpg->map, chan->base + LPG_HI_PAUSE_REG, hi_pause);
694 regmap_write(lpg->map, chan->base + LPG_LO_PAUSE_REG, lo_pause);
695 }
696
697 #define LPG_ENABLE_CONTROL_OUTPUT BIT(7)
698 #define LPG_ENABLE_CONTROL_BUFFER_TRISTATE BIT(5)
699 #define LPG_ENABLE_CONTROL_SRC_PWM BIT(2)
700 #define LPG_ENABLE_CONTROL_RAMP_GEN BIT(1)
701
lpg_apply_control(struct lpg_channel * chan)702 static void lpg_apply_control(struct lpg_channel *chan)
703 {
704 unsigned int ctrl;
705 struct lpg *lpg = chan->lpg;
706
707 ctrl = LPG_ENABLE_CONTROL_BUFFER_TRISTATE;
708
709 if (chan->enabled)
710 ctrl |= LPG_ENABLE_CONTROL_OUTPUT;
711
712 if (chan->pattern_lo_idx != chan->pattern_hi_idx)
713 ctrl |= LPG_ENABLE_CONTROL_RAMP_GEN;
714 else
715 ctrl |= LPG_ENABLE_CONTROL_SRC_PWM;
716
717 regmap_write(lpg->map, chan->base + PWM_ENABLE_CONTROL_REG, ctrl);
718
719 /*
720 * Due to LPG hardware bug, in the PWM mode, having enabled PWM,
721 * We have to write PWM values one more time.
722 */
723 if (chan->enabled)
724 lpg_apply_pwm_value(chan);
725 }
726
727 #define LPG_SYNC_PWM BIT(0)
728
lpg_apply_sync(struct lpg_channel * chan)729 static void lpg_apply_sync(struct lpg_channel *chan)
730 {
731 struct lpg *lpg = chan->lpg;
732
733 regmap_write(lpg->map, chan->base + PWM_SYNC_REG, LPG_SYNC_PWM);
734 }
735
lpg_parse_dtest(struct lpg * lpg)736 static int lpg_parse_dtest(struct lpg *lpg)
737 {
738 struct lpg_channel *chan;
739 struct device_node *np = lpg->dev->of_node;
740 int count;
741 int ret;
742 int i;
743
744 count = of_property_count_u32_elems(np, "qcom,dtest");
745 if (count == -EINVAL) {
746 return 0;
747 } else if (count < 0) {
748 ret = count;
749 goto err_malformed;
750 } else if (count != lpg->data->num_channels * 2) {
751 return dev_err_probe(lpg->dev, -EINVAL,
752 "qcom,dtest needs to be %d items\n",
753 lpg->data->num_channels * 2);
754 }
755
756 for (i = 0; i < lpg->data->num_channels; i++) {
757 chan = &lpg->channels[i];
758
759 ret = of_property_read_u32_index(np, "qcom,dtest", i * 2,
760 &chan->dtest_line);
761 if (ret)
762 goto err_malformed;
763
764 ret = of_property_read_u32_index(np, "qcom,dtest", i * 2 + 1,
765 &chan->dtest_value);
766 if (ret)
767 goto err_malformed;
768 }
769
770 return 0;
771
772 err_malformed:
773 return dev_err_probe(lpg->dev, ret, "malformed qcom,dtest\n");
774 }
775
lpg_apply_dtest(struct lpg_channel * chan)776 static void lpg_apply_dtest(struct lpg_channel *chan)
777 {
778 struct lpg *lpg = chan->lpg;
779
780 if (!chan->dtest_line)
781 return;
782
783 regmap_write(lpg->map, chan->base + PWM_SEC_ACCESS_REG, 0xa5);
784 regmap_write(lpg->map, chan->base + PWM_DTEST_REG(chan->dtest_line),
785 chan->dtest_value);
786 }
787
lpg_apply(struct lpg_channel * chan)788 static void lpg_apply(struct lpg_channel *chan)
789 {
790 lpg_disable_glitch(chan);
791 lpg_apply_freq(chan);
792 lpg_apply_pwm_value(chan);
793 lpg_apply_control(chan);
794 lpg_apply_sync(chan);
795 if (chan->lpg->lpg_chan_sdam)
796 lpg_sdam_apply_lut_control(chan);
797 else
798 lpg_apply_lut_control(chan);
799 lpg_enable_glitch(chan);
800 }
801
lpg_brightness_set(struct lpg_led * led,struct led_classdev * cdev,struct mc_subled * subleds)802 static void lpg_brightness_set(struct lpg_led *led, struct led_classdev *cdev,
803 struct mc_subled *subleds)
804 {
805 enum led_brightness brightness;
806 struct lpg_channel *chan;
807 unsigned int triled_enabled = 0;
808 unsigned int triled_mask = 0;
809 unsigned int lut_mask = 0;
810 unsigned int duty;
811 struct lpg *lpg = led->lpg;
812 int i;
813
814 for (i = 0; i < led->num_channels; i++) {
815 chan = led->channels[i];
816 brightness = subleds[i].brightness;
817
818 if (brightness == LED_OFF) {
819 chan->enabled = false;
820 chan->ramp_enabled = false;
821 } else if (chan->pattern_lo_idx != chan->pattern_hi_idx) {
822 lpg_calc_freq(chan, NSEC_PER_MSEC);
823 lpg_sdam_configure_triggers(chan, 1);
824
825 chan->enabled = true;
826 chan->ramp_enabled = true;
827
828 lut_mask |= chan->lut_mask;
829 triled_enabled |= chan->triled_mask;
830 } else {
831 lpg_calc_freq(chan, NSEC_PER_MSEC);
832
833 duty = div_u64(brightness * chan->period, cdev->max_brightness);
834 lpg_calc_duty(chan, duty);
835 chan->enabled = true;
836 chan->ramp_enabled = false;
837
838 triled_enabled |= chan->triled_mask;
839 }
840
841 triled_mask |= chan->triled_mask;
842
843 lpg_apply(chan);
844 }
845
846 /* Toggle triled lines */
847 if (triled_mask)
848 triled_set(lpg, triled_mask, triled_enabled);
849
850 /* Trigger start of ramp generator(s) */
851 if (lut_mask) {
852 lpg_lut_sync(lpg, lut_mask);
853 lpg_set_pbs_trigger(lpg, lut_mask);
854 }
855 }
856
lpg_brightness_single_set(struct led_classdev * cdev,enum led_brightness value)857 static int lpg_brightness_single_set(struct led_classdev *cdev,
858 enum led_brightness value)
859 {
860 struct lpg_led *led = container_of(cdev, struct lpg_led, cdev);
861 struct mc_subled info;
862
863 mutex_lock(&led->lpg->lock);
864
865 info.brightness = value;
866 lpg_brightness_set(led, cdev, &info);
867
868 mutex_unlock(&led->lpg->lock);
869
870 return 0;
871 }
872
lpg_brightness_mc_set(struct led_classdev * cdev,enum led_brightness value)873 static int lpg_brightness_mc_set(struct led_classdev *cdev,
874 enum led_brightness value)
875 {
876 struct led_classdev_mc *mc = lcdev_to_mccdev(cdev);
877 struct lpg_led *led = container_of(mc, struct lpg_led, mcdev);
878
879 mutex_lock(&led->lpg->lock);
880
881 led_mc_calc_color_components(mc, value);
882 lpg_brightness_set(led, cdev, mc->subled_info);
883
884 mutex_unlock(&led->lpg->lock);
885
886 return 0;
887 }
888
lpg_blink_set(struct lpg_led * led,unsigned long * delay_on,unsigned long * delay_off)889 static int lpg_blink_set(struct lpg_led *led,
890 unsigned long *delay_on, unsigned long *delay_off)
891 {
892 struct lpg_channel *chan;
893 unsigned int period;
894 unsigned int triled_mask = 0;
895 struct lpg *lpg = led->lpg;
896 u64 duty;
897 int i;
898
899 if (!*delay_on && !*delay_off) {
900 *delay_on = 500;
901 *delay_off = 500;
902 }
903
904 duty = *delay_on * NSEC_PER_MSEC;
905 period = (*delay_on + *delay_off) * NSEC_PER_MSEC;
906
907 for (i = 0; i < led->num_channels; i++) {
908 chan = led->channels[i];
909
910 lpg_calc_freq(chan, period);
911 lpg_calc_duty(chan, duty);
912
913 chan->enabled = true;
914 chan->ramp_enabled = false;
915
916 triled_mask |= chan->triled_mask;
917
918 lpg_apply(chan);
919 }
920
921 /* Enable triled lines */
922 triled_set(lpg, triled_mask, triled_mask);
923
924 chan = led->channels[0];
925 duty = div_u64(chan->pwm_value * chan->period, LPG_RESOLUTION_9BIT);
926 *delay_on = div_u64(duty, NSEC_PER_MSEC);
927 *delay_off = div_u64(chan->period - duty, NSEC_PER_MSEC);
928
929 return 0;
930 }
931
lpg_blink_single_set(struct led_classdev * cdev,unsigned long * delay_on,unsigned long * delay_off)932 static int lpg_blink_single_set(struct led_classdev *cdev,
933 unsigned long *delay_on, unsigned long *delay_off)
934 {
935 struct lpg_led *led = container_of(cdev, struct lpg_led, cdev);
936 int ret;
937
938 mutex_lock(&led->lpg->lock);
939
940 ret = lpg_blink_set(led, delay_on, delay_off);
941
942 mutex_unlock(&led->lpg->lock);
943
944 return ret;
945 }
946
lpg_blink_mc_set(struct led_classdev * cdev,unsigned long * delay_on,unsigned long * delay_off)947 static int lpg_blink_mc_set(struct led_classdev *cdev,
948 unsigned long *delay_on, unsigned long *delay_off)
949 {
950 struct led_classdev_mc *mc = lcdev_to_mccdev(cdev);
951 struct lpg_led *led = container_of(mc, struct lpg_led, mcdev);
952 int ret;
953
954 mutex_lock(&led->lpg->lock);
955
956 ret = lpg_blink_set(led, delay_on, delay_off);
957
958 mutex_unlock(&led->lpg->lock);
959
960 return ret;
961 }
962
lpg_pattern_set(struct lpg_led * led,struct led_pattern * led_pattern,u32 len,int repeat)963 static int lpg_pattern_set(struct lpg_led *led, struct led_pattern *led_pattern,
964 u32 len, int repeat)
965 {
966 struct lpg_channel *chan;
967 struct lpg *lpg = led->lpg;
968 struct led_pattern *pattern;
969 unsigned int brightness_a;
970 unsigned int brightness_b;
971 unsigned int hi_pause = 0;
972 unsigned int lo_pause = 0;
973 unsigned int actual_len;
974 unsigned int delta_t;
975 unsigned int lo_idx;
976 unsigned int hi_idx;
977 unsigned int i;
978 bool ping_pong = true;
979 int ret = -EINVAL;
980
981 /* Hardware only support oneshot or indefinite loops */
982 if (repeat != -1 && repeat != 1)
983 return -EINVAL;
984
985 /*
986 * The standardized leds-trigger-pattern format defines that the
987 * brightness of the LED follows a linear transition from one entry
988 * in the pattern to the next, over the given delta_t time. It
989 * describes that the way to perform instant transitions a zero-length
990 * entry should be added following a pattern entry.
991 *
992 * The LPG hardware is only able to perform the latter (no linear
993 * transitions), so require each entry in the pattern to be followed by
994 * a zero-length transition.
995 */
996 if (len % 2)
997 return -EINVAL;
998
999 pattern = kzalloc_objs(*pattern, len / 2);
1000 if (!pattern)
1001 return -ENOMEM;
1002
1003 for (i = 0; i < len; i += 2) {
1004 if (led_pattern[i].brightness != led_pattern[i + 1].brightness)
1005 goto out_free_pattern;
1006 if (led_pattern[i + 1].delta_t != 0)
1007 goto out_free_pattern;
1008
1009 pattern[i / 2].brightness = led_pattern[i].brightness;
1010 pattern[i / 2].delta_t = led_pattern[i].delta_t;
1011 }
1012
1013 len /= 2;
1014
1015 /*
1016 * Specifying a pattern of length 1 causes the hardware to iterate
1017 * through the entire LUT, so prohibit this.
1018 */
1019 if (len < 2)
1020 goto out_free_pattern;
1021
1022 /*
1023 * The LPG plays patterns with at a fixed pace, a "low pause" can be
1024 * used to stretch the first delay of the pattern and a "high pause"
1025 * the last one.
1026 *
1027 * In order to save space the pattern can be played in "ping pong"
1028 * mode, in which the pattern is first played forward, then "high
1029 * pause" is applied, then the pattern is played backwards and finally
1030 * the "low pause" is applied.
1031 *
1032 * The middle elements of the pattern are used to determine delta_t and
1033 * the "low pause" and "high pause" multipliers are derrived from this.
1034 *
1035 * The first element in the pattern is used to determine "low pause".
1036 *
1037 * If the specified pattern is a palindrome the ping pong mode is
1038 * enabled. In this scenario the delta_t of the middle entry (i.e. the
1039 * last in the programmed pattern) determines the "high pause".
1040 *
1041 * SDAM-based devices do not support "ping pong", and only supports
1042 * "low pause" and "high pause" with a dedicated SDAM LUT.
1043 */
1044
1045 /* Detect palindromes and use "ping pong" to reduce LUT usage */
1046 if (lpg->lut_base) {
1047 for (i = 0; i < len / 2; i++) {
1048 brightness_a = pattern[i].brightness;
1049 brightness_b = pattern[len - i - 1].brightness;
1050
1051 if (brightness_a != brightness_b) {
1052 ping_pong = false;
1053 break;
1054 }
1055 }
1056 } else
1057 ping_pong = false;
1058
1059 /* The pattern length to be written to the LUT */
1060 if (ping_pong)
1061 actual_len = (len + 1) / 2;
1062 else
1063 actual_len = len;
1064
1065 /*
1066 * Validate that all delta_t in the pattern are the same, with the
1067 * exception of the middle element in case of ping_pong.
1068 */
1069 delta_t = pattern[1].delta_t;
1070 for (i = 2; i < len; i++) {
1071 if (pattern[i].delta_t != delta_t) {
1072 /*
1073 * Allow last entry in the full or shortened pattern to
1074 * specify hi pause. Reject other variations.
1075 */
1076 if (i != actual_len - 1)
1077 goto out_free_pattern;
1078 }
1079 }
1080
1081 /* LPG_RAMP_DURATION_REG is a 9bit */
1082 if (delta_t >= BIT(9))
1083 goto out_free_pattern;
1084
1085 /*
1086 * Find "low pause" and "high pause" in the pattern in the LUT case.
1087 * SDAM-based devices without dedicated LUT SDAM require equal
1088 * duration of all steps.
1089 */
1090 if (lpg->lut_base || lpg->lut_sdam) {
1091 lo_pause = pattern[0].delta_t;
1092 hi_pause = pattern[actual_len - 1].delta_t;
1093 } else {
1094 if (delta_t != pattern[0].delta_t || delta_t != pattern[actual_len - 1].delta_t)
1095 goto out_free_pattern;
1096 }
1097
1098
1099 mutex_lock(&lpg->lock);
1100
1101 if (lpg->lut_base)
1102 ret = lpg_lut_store(lpg, pattern, actual_len, &lo_idx, &hi_idx);
1103 else
1104 ret = lpg_lut_store_sdam(lpg, pattern, actual_len, &lo_idx, &hi_idx);
1105
1106 if (ret < 0)
1107 goto out_unlock;
1108
1109 for (i = 0; i < led->num_channels; i++) {
1110 chan = led->channels[i];
1111
1112 chan->ramp_tick_ms = delta_t;
1113 chan->ramp_ping_pong = ping_pong;
1114 chan->ramp_oneshot = repeat != -1;
1115
1116 chan->ramp_lo_pause_ms = lo_pause;
1117 chan->ramp_hi_pause_ms = hi_pause;
1118
1119 chan->pattern_lo_idx = lo_idx;
1120 chan->pattern_hi_idx = hi_idx;
1121 }
1122
1123 out_unlock:
1124 mutex_unlock(&lpg->lock);
1125 out_free_pattern:
1126 kfree(pattern);
1127
1128 return ret;
1129 }
1130
lpg_pattern_single_set(struct led_classdev * cdev,struct led_pattern * pattern,u32 len,int repeat)1131 static int lpg_pattern_single_set(struct led_classdev *cdev,
1132 struct led_pattern *pattern, u32 len,
1133 int repeat)
1134 {
1135 struct lpg_led *led = container_of(cdev, struct lpg_led, cdev);
1136 int ret;
1137
1138 ret = lpg_pattern_set(led, pattern, len, repeat);
1139 if (ret < 0)
1140 return ret;
1141
1142 lpg_brightness_single_set(cdev, LED_FULL);
1143
1144 return 0;
1145 }
1146
lpg_pattern_mc_set(struct led_classdev * cdev,struct led_pattern * pattern,u32 len,int repeat)1147 static int lpg_pattern_mc_set(struct led_classdev *cdev,
1148 struct led_pattern *pattern, u32 len,
1149 int repeat)
1150 {
1151 struct led_classdev_mc *mc = lcdev_to_mccdev(cdev);
1152 struct lpg_led *led = container_of(mc, struct lpg_led, mcdev);
1153 unsigned int triled_mask = 0;
1154 int ret, i;
1155
1156 for (i = 0; i < led->num_channels; i++)
1157 triled_mask |= led->channels[i]->triled_mask;
1158 triled_set(led->lpg, triled_mask, 0);
1159
1160 ret = lpg_pattern_set(led, pattern, len, repeat);
1161 if (ret < 0)
1162 return ret;
1163
1164 led_mc_calc_color_components(mc, LED_FULL);
1165 lpg_brightness_set(led, cdev, mc->subled_info);
1166
1167 return 0;
1168 }
1169
lpg_pattern_clear(struct lpg_led * led)1170 static int lpg_pattern_clear(struct lpg_led *led)
1171 {
1172 struct lpg_channel *chan;
1173 struct lpg *lpg = led->lpg;
1174 int i;
1175
1176 mutex_lock(&lpg->lock);
1177
1178 chan = led->channels[0];
1179 lpg_lut_free(lpg, chan->pattern_lo_idx, chan->pattern_hi_idx);
1180
1181 for (i = 0; i < led->num_channels; i++) {
1182 chan = led->channels[i];
1183 lpg_sdam_configure_triggers(chan, 0);
1184 lpg_clear_pbs_trigger(chan->lpg, chan->lut_mask);
1185 chan->pattern_lo_idx = 0;
1186 chan->pattern_hi_idx = 0;
1187 }
1188
1189 mutex_unlock(&lpg->lock);
1190
1191 return 0;
1192 }
1193
lpg_pattern_single_clear(struct led_classdev * cdev)1194 static int lpg_pattern_single_clear(struct led_classdev *cdev)
1195 {
1196 struct lpg_led *led = container_of(cdev, struct lpg_led, cdev);
1197
1198 return lpg_pattern_clear(led);
1199 }
1200
lpg_pattern_mc_clear(struct led_classdev * cdev)1201 static int lpg_pattern_mc_clear(struct led_classdev *cdev)
1202 {
1203 struct led_classdev_mc *mc = lcdev_to_mccdev(cdev);
1204 struct lpg_led *led = container_of(mc, struct lpg_led, mcdev);
1205
1206 return lpg_pattern_clear(led);
1207 }
1208
lpg_pwm_from_chip(struct pwm_chip * chip)1209 static inline struct lpg *lpg_pwm_from_chip(struct pwm_chip *chip)
1210 {
1211 return pwmchip_get_drvdata(chip);
1212 }
1213
lpg_pwm_request(struct pwm_chip * chip,struct pwm_device * pwm)1214 static int lpg_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm)
1215 {
1216 struct lpg *lpg = lpg_pwm_from_chip(chip);
1217 struct lpg_channel *chan = &lpg->channels[pwm->hwpwm];
1218
1219 return chan->in_use ? -EBUSY : 0;
1220 }
1221
1222 /*
1223 * Limitations:
1224 * - Updating both duty and period is not done atomically, so the output signal
1225 * will momentarily be a mix of the settings.
1226 * - Changed parameters takes effect immediately.
1227 * - A disabled channel outputs a logical 0.
1228 */
lpg_pwm_apply(struct pwm_chip * chip,struct pwm_device * pwm,const struct pwm_state * state)1229 static int lpg_pwm_apply(struct pwm_chip *chip, struct pwm_device *pwm,
1230 const struct pwm_state *state)
1231 {
1232 struct lpg *lpg = lpg_pwm_from_chip(chip);
1233 struct lpg_channel *chan = &lpg->channels[pwm->hwpwm];
1234 int ret = 0;
1235
1236 if (state->polarity != PWM_POLARITY_NORMAL)
1237 return -EINVAL;
1238
1239 mutex_lock(&lpg->lock);
1240
1241 if (state->enabled) {
1242 ret = lpg_calc_freq(chan, state->period);
1243 if (ret < 0)
1244 goto out_unlock;
1245
1246 lpg_calc_duty(chan, state->duty_cycle);
1247 }
1248 chan->enabled = state->enabled;
1249
1250 lpg_apply(chan);
1251
1252 out_unlock:
1253 mutex_unlock(&lpg->lock);
1254
1255 return ret;
1256 }
1257
lpg_pwm_get_state(struct pwm_chip * chip,struct pwm_device * pwm,struct pwm_state * state)1258 static int lpg_pwm_get_state(struct pwm_chip *chip, struct pwm_device *pwm,
1259 struct pwm_state *state)
1260 {
1261 struct lpg *lpg = lpg_pwm_from_chip(chip);
1262 struct lpg_channel *chan = &lpg->channels[pwm->hwpwm];
1263 unsigned int resolution;
1264 unsigned int pre_div;
1265 unsigned int refclk;
1266 unsigned int val;
1267 unsigned int m;
1268 u16 pwm_value;
1269 int ret;
1270
1271 ret = regmap_read(lpg->map, chan->base + LPG_SIZE_CLK_REG, &val);
1272 if (ret)
1273 return ret;
1274
1275 if (chan->subtype == LPG_SUBTYPE_HI_RES_PWM) {
1276 refclk = lpg_clk_rates_hi_res[FIELD_GET(PWM_CLK_SELECT_HI_RES_MASK, val)];
1277 resolution = lpg_pwm_resolution_hi_res[FIELD_GET(PWM_SIZE_HI_RES_MASK, val)];
1278 } else {
1279 refclk = lpg_clk_rates[FIELD_GET(PWM_CLK_SELECT_MASK, val)];
1280 resolution = lpg_pwm_resolution[FIELD_GET(PWM_SIZE_SELECT_MASK, val)];
1281 }
1282
1283 if (refclk) {
1284 ret = regmap_read(lpg->map, chan->base + LPG_PREDIV_CLK_REG, &val);
1285 if (ret)
1286 return ret;
1287
1288 pre_div = lpg_pre_divs[FIELD_GET(PWM_FREQ_PRE_DIV_MASK, val)];
1289 m = FIELD_GET(PWM_FREQ_EXP_MASK, val);
1290
1291 ret = regmap_bulk_read(lpg->map, chan->base + PWM_VALUE_REG, &pwm_value, sizeof(pwm_value));
1292 if (ret)
1293 return ret;
1294
1295 state->period = DIV_ROUND_UP_ULL((u64)NSEC_PER_SEC * ((1 << resolution) - 1) *
1296 pre_div * (1 << m), refclk);
1297 state->duty_cycle = DIV_ROUND_UP_ULL((u64)NSEC_PER_SEC * pwm_value * pre_div * (1 << m), refclk);
1298 } else {
1299 state->period = 0;
1300 state->duty_cycle = 0;
1301 }
1302
1303 ret = regmap_read(lpg->map, chan->base + PWM_ENABLE_CONTROL_REG, &val);
1304 if (ret)
1305 return ret;
1306
1307 state->enabled = FIELD_GET(LPG_ENABLE_CONTROL_OUTPUT, val);
1308 state->polarity = PWM_POLARITY_NORMAL;
1309
1310 if (state->duty_cycle > state->period)
1311 state->duty_cycle = state->period;
1312
1313 return 0;
1314 }
1315
1316 static const struct pwm_ops lpg_pwm_ops = {
1317 .request = lpg_pwm_request,
1318 .apply = lpg_pwm_apply,
1319 .get_state = lpg_pwm_get_state,
1320 };
1321
lpg_add_pwm(struct lpg * lpg)1322 static int lpg_add_pwm(struct lpg *lpg)
1323 {
1324 struct pwm_chip *chip;
1325 int ret;
1326
1327 lpg->pwm = chip = devm_pwmchip_alloc(lpg->dev, lpg->num_channels, 0);
1328 if (IS_ERR(chip))
1329 return PTR_ERR(chip);
1330
1331 chip->ops = &lpg_pwm_ops;
1332 pwmchip_set_drvdata(chip, lpg);
1333
1334 ret = devm_pwmchip_add(lpg->dev, chip);
1335 if (ret)
1336 dev_err_probe(lpg->dev, ret, "failed to add PWM chip\n");
1337
1338 return ret;
1339 }
1340
lpg_parse_channel(struct lpg * lpg,struct device_node * np,struct lpg_channel ** channel)1341 static int lpg_parse_channel(struct lpg *lpg, struct device_node *np,
1342 struct lpg_channel **channel)
1343 {
1344 struct lpg_channel *chan;
1345 u32 color = LED_COLOR_ID_GREEN;
1346 u32 reg;
1347 int ret;
1348
1349 ret = of_property_read_u32(np, "reg", ®);
1350 if (ret || !reg || reg > lpg->num_channels)
1351 return dev_err_probe(lpg->dev, -EINVAL, "invalid \"reg\" of %pOFn\n", np);
1352
1353 chan = &lpg->channels[reg - 1];
1354 chan->in_use = true;
1355
1356 ret = of_property_read_u32(np, "color", &color);
1357 if (ret < 0 && ret != -EINVAL)
1358 return dev_err_probe(lpg->dev, ret,
1359 "failed to parse \"color\" of %pOF\n", np);
1360
1361 chan->color = color;
1362
1363 *channel = chan;
1364
1365 return 0;
1366 }
1367
lpg_add_led(struct lpg * lpg,struct device_node * np)1368 static int lpg_add_led(struct lpg *lpg, struct device_node *np)
1369 {
1370 struct led_init_data init_data = {};
1371 struct led_classdev *cdev;
1372 struct mc_subled *info;
1373 struct lpg_led *led;
1374 const char *state;
1375 int num_channels;
1376 u32 color = 0;
1377 int ret;
1378 int i;
1379
1380 ret = of_property_read_u32(np, "color", &color);
1381 if (ret < 0 && ret != -EINVAL)
1382 return dev_err_probe(lpg->dev, ret,
1383 "failed to parse \"color\" of %pOF\n", np);
1384
1385 if (color == LED_COLOR_ID_RGB || color == LED_COLOR_ID_MULTI)
1386 num_channels = of_get_available_child_count(np);
1387 else
1388 num_channels = 1;
1389
1390 led = devm_kzalloc(lpg->dev, struct_size(led, channels, num_channels), GFP_KERNEL);
1391 if (!led)
1392 return -ENOMEM;
1393
1394 led->lpg = lpg;
1395 led->num_channels = num_channels;
1396
1397 if (color == LED_COLOR_ID_RGB || color == LED_COLOR_ID_MULTI) {
1398 info = devm_kcalloc(lpg->dev, num_channels, sizeof(*info), GFP_KERNEL);
1399 if (!info)
1400 return -ENOMEM;
1401 i = 0;
1402 for_each_available_child_of_node_scoped(np, child) {
1403 ret = lpg_parse_channel(lpg, child, &led->channels[i]);
1404 if (ret < 0)
1405 return ret;
1406
1407 info[i].color_index = led->channels[i]->color;
1408 info[i].intensity = 0;
1409 i++;
1410 }
1411
1412 led->mcdev.subled_info = info;
1413 led->mcdev.num_colors = num_channels;
1414
1415 cdev = &led->mcdev.led_cdev;
1416 cdev->brightness_set_blocking = lpg_brightness_mc_set;
1417 cdev->blink_set = lpg_blink_mc_set;
1418
1419 /* Register pattern accessors if we have a LUT block or when using PPG */
1420 if (lpg->lut_base || lpg->lpg_chan_sdam) {
1421 cdev->pattern_set = lpg_pattern_mc_set;
1422 cdev->pattern_clear = lpg_pattern_mc_clear;
1423 }
1424 } else {
1425 ret = lpg_parse_channel(lpg, np, &led->channels[0]);
1426 if (ret < 0)
1427 return ret;
1428
1429 cdev = &led->cdev;
1430 cdev->brightness_set_blocking = lpg_brightness_single_set;
1431 cdev->blink_set = lpg_blink_single_set;
1432
1433 /* Register pattern accessors if we have a LUT block or when using PPG */
1434 if (lpg->lut_base || lpg->lpg_chan_sdam) {
1435 cdev->pattern_set = lpg_pattern_single_set;
1436 cdev->pattern_clear = lpg_pattern_single_clear;
1437 }
1438 }
1439
1440 cdev->default_trigger = of_get_property(np, "linux,default-trigger", NULL);
1441
1442 if (lpg->lpg_chan_sdam)
1443 cdev->max_brightness = PPG_MAX_LED_BRIGHTNESS;
1444 else
1445 cdev->max_brightness = LPG_RESOLUTION_9BIT - 1;
1446
1447 if (!of_property_read_string(np, "default-state", &state) &&
1448 !strcmp(state, "on"))
1449 cdev->brightness = cdev->max_brightness;
1450 else
1451 cdev->brightness = LED_OFF;
1452
1453 cdev->brightness_set_blocking(cdev, cdev->brightness);
1454
1455 init_data.fwnode = of_fwnode_handle(np);
1456
1457 if (color == LED_COLOR_ID_RGB || color == LED_COLOR_ID_MULTI)
1458 ret = devm_led_classdev_multicolor_register_ext(lpg->dev, &led->mcdev, &init_data);
1459 else
1460 ret = devm_led_classdev_register_ext(lpg->dev, &led->cdev, &init_data);
1461 if (ret)
1462 dev_err_probe(lpg->dev, ret, "unable to register %s\n", cdev->name);
1463
1464 return ret;
1465 }
1466
lpg_init_channels(struct lpg * lpg)1467 static int lpg_init_channels(struct lpg *lpg)
1468 {
1469 const struct lpg_data *data = lpg->data;
1470 struct lpg_channel *chan;
1471 int i;
1472
1473 lpg->num_channels = data->num_channels;
1474 lpg->channels = devm_kcalloc(lpg->dev, data->num_channels,
1475 sizeof(struct lpg_channel), GFP_KERNEL);
1476 if (!lpg->channels)
1477 return -ENOMEM;
1478
1479 for (i = 0; i < data->num_channels; i++) {
1480 chan = &lpg->channels[i];
1481
1482 chan->lpg = lpg;
1483 chan->base = data->channels[i].base;
1484 chan->triled_mask = data->channels[i].triled_mask;
1485 chan->lut_mask = BIT(i);
1486 chan->sdam_offset = data->channels[i].sdam_offset;
1487
1488 regmap_read(lpg->map, chan->base + LPG_SUBTYPE_REG, &chan->subtype);
1489 }
1490
1491 return 0;
1492 }
1493
lpg_init_triled(struct lpg * lpg)1494 static int lpg_init_triled(struct lpg *lpg)
1495 {
1496 struct device_node *np = lpg->dev->of_node;
1497 int ret;
1498
1499 /* Skip initialization if we don't have a triled block */
1500 if (!lpg->data->triled_base)
1501 return 0;
1502
1503 lpg->triled_base = lpg->data->triled_base;
1504 lpg->triled_has_atc_ctl = lpg->data->triled_has_atc_ctl;
1505 lpg->triled_has_src_sel = lpg->data->triled_has_src_sel;
1506
1507 if (lpg->triled_has_src_sel) {
1508 ret = of_property_read_u32(np, "qcom,power-source", &lpg->triled_src);
1509 if (ret || lpg->triled_src == 2 || lpg->triled_src > 3)
1510 return dev_err_probe(lpg->dev, -EINVAL,
1511 "invalid power source\n");
1512 }
1513
1514 /* Disable automatic trickle charge LED */
1515 if (lpg->triled_has_atc_ctl)
1516 regmap_write(lpg->map, lpg->triled_base + TRI_LED_ATC_CTL, 0);
1517
1518 /* Configure power source */
1519 if (lpg->triled_has_src_sel)
1520 regmap_write(lpg->map, lpg->triled_base + TRI_LED_SRC_SEL, lpg->triled_src);
1521
1522 /* Default all outputs to off */
1523 regmap_write(lpg->map, lpg->triled_base + TRI_LED_EN_CTL, 0);
1524
1525 return 0;
1526 }
1527
lpg_init_lut(struct lpg * lpg)1528 static int lpg_init_lut(struct lpg *lpg)
1529 {
1530 const struct lpg_data *data = lpg->data;
1531
1532 if (!data->lut_size)
1533 return 0;
1534
1535 lpg->lut_size = data->lut_size;
1536 if (data->lut_base)
1537 lpg->lut_base = data->lut_base;
1538
1539 lpg->lut_bitmap = devm_bitmap_zalloc(lpg->dev, lpg->lut_size, GFP_KERNEL);
1540 if (!lpg->lut_bitmap)
1541 return -ENOMEM;
1542
1543 return 0;
1544 }
1545
lpg_init_sdam(struct lpg * lpg)1546 static int lpg_init_sdam(struct lpg *lpg)
1547 {
1548 int i, sdam_count, rc;
1549 u8 val = 0;
1550
1551 sdam_count = of_property_count_strings(lpg->dev->of_node, "nvmem-names");
1552 if (sdam_count <= 0)
1553 return 0;
1554 if (sdam_count > SDAM_MAX_DEVICES)
1555 return -EINVAL;
1556
1557 /* Get the 1st SDAM device for LPG/LUT config */
1558 lpg->lpg_chan_sdam = devm_nvmem_device_get(lpg->dev, "lpg_chan_sdam");
1559 if (IS_ERR(lpg->lpg_chan_sdam))
1560 return dev_err_probe(lpg->dev, PTR_ERR(lpg->lpg_chan_sdam),
1561 "Failed to get LPG chan SDAM device\n");
1562
1563 if (sdam_count == 1) {
1564 /* Get PBS device node if single SDAM device */
1565 lpg->pbs_dev = get_pbs_client_device(lpg->dev);
1566 if (IS_ERR(lpg->pbs_dev))
1567 return dev_err_probe(lpg->dev, PTR_ERR(lpg->pbs_dev),
1568 "Failed to get PBS client device\n");
1569 } else if (sdam_count == 2) {
1570 /* Get the 2nd SDAM device for LUT pattern */
1571 lpg->lut_sdam = devm_nvmem_device_get(lpg->dev, "lut_sdam");
1572 if (IS_ERR(lpg->lut_sdam))
1573 return dev_err_probe(lpg->dev, PTR_ERR(lpg->lut_sdam),
1574 "Failed to get LPG LUT SDAM device\n");
1575 }
1576
1577 for (i = 0; i < lpg->num_channels; i++) {
1578 struct lpg_channel *chan = &lpg->channels[i];
1579
1580 if (chan->sdam_offset) {
1581 rc = nvmem_device_write(lpg->lpg_chan_sdam,
1582 SDAM_PBS_SCRATCH_LUT_COUNTER_OFFSET + chan->sdam_offset, 1, &val);
1583 if (rc < 0)
1584 return rc;
1585
1586 rc = lpg_sdam_configure_triggers(chan, 0);
1587 if (rc < 0)
1588 return rc;
1589
1590 rc = lpg_clear_pbs_trigger(chan->lpg, chan->lut_mask);
1591 if (rc < 0)
1592 return rc;
1593 }
1594 }
1595
1596 return 0;
1597 }
1598
lpg_probe(struct platform_device * pdev)1599 static int lpg_probe(struct platform_device *pdev)
1600 {
1601 struct lpg *lpg;
1602 int ret;
1603 int i;
1604
1605 lpg = devm_kzalloc(&pdev->dev, sizeof(*lpg), GFP_KERNEL);
1606 if (!lpg)
1607 return -ENOMEM;
1608
1609 lpg->data = of_device_get_match_data(&pdev->dev);
1610 if (!lpg->data)
1611 return -EINVAL;
1612
1613 lpg->dev = &pdev->dev;
1614 mutex_init(&lpg->lock);
1615
1616 lpg->map = dev_get_regmap(pdev->dev.parent, NULL);
1617 if (!lpg->map)
1618 return dev_err_probe(&pdev->dev, -ENXIO, "parent regmap unavailable\n");
1619
1620 ret = lpg_init_channels(lpg);
1621 if (ret < 0)
1622 return ret;
1623
1624 ret = lpg_parse_dtest(lpg);
1625 if (ret < 0)
1626 return ret;
1627
1628 ret = lpg_init_triled(lpg);
1629 if (ret < 0)
1630 return ret;
1631
1632 ret = lpg_init_sdam(lpg);
1633 if (ret < 0)
1634 return ret;
1635
1636 ret = lpg_init_lut(lpg);
1637 if (ret < 0)
1638 return ret;
1639
1640 for_each_available_child_of_node_scoped(pdev->dev.of_node, np) {
1641 ret = lpg_add_led(lpg, np);
1642 if (ret)
1643 return ret;
1644 }
1645
1646 for (i = 0; i < lpg->num_channels; i++)
1647 lpg_apply_dtest(&lpg->channels[i]);
1648
1649 return lpg_add_pwm(lpg);
1650 }
1651
1652 static const struct lpg_data pm660l_lpg_data = {
1653 .lut_base = 0xb000,
1654 .lut_size = 49,
1655
1656 .triled_base = 0xd000,
1657 .triled_has_atc_ctl = true,
1658 .triled_has_src_sel = true,
1659
1660 .num_channels = 4,
1661 .channels = (const struct lpg_channel_data[]) {
1662 { .base = 0xb100, .triled_mask = BIT(5) },
1663 { .base = 0xb200, .triled_mask = BIT(6) },
1664 { .base = 0xb300, .triled_mask = BIT(7) },
1665 { .base = 0xb400 },
1666 },
1667 };
1668
1669 static const struct lpg_data pm8916_pwm_data = {
1670 .num_channels = 1,
1671 .channels = (const struct lpg_channel_data[]) {
1672 { .base = 0xbc00 },
1673 },
1674 };
1675
1676 static const struct lpg_data pm8941_lpg_data = {
1677 .lut_base = 0xb000,
1678 .lut_size = 64,
1679
1680 .triled_base = 0xd000,
1681 .triled_has_atc_ctl = true,
1682 .triled_has_src_sel = true,
1683
1684 .num_channels = 8,
1685 .channels = (const struct lpg_channel_data[]) {
1686 { .base = 0xb100 },
1687 { .base = 0xb200 },
1688 { .base = 0xb300 },
1689 { .base = 0xb400 },
1690 { .base = 0xb500, .triled_mask = BIT(5) },
1691 { .base = 0xb600, .triled_mask = BIT(6) },
1692 { .base = 0xb700, .triled_mask = BIT(7) },
1693 { .base = 0xb800 },
1694 },
1695 };
1696
1697 static const struct lpg_data pmi8950_pwm_data = {
1698 .num_channels = 1,
1699 .channels = (const struct lpg_channel_data[]) {
1700 { .base = 0xb000 },
1701 },
1702 };
1703
1704 static const struct lpg_data pm8994_lpg_data = {
1705 .lut_base = 0xb000,
1706 .lut_size = 64,
1707
1708 .num_channels = 6,
1709 .channels = (const struct lpg_channel_data[]) {
1710 { .base = 0xb100 },
1711 { .base = 0xb200 },
1712 { .base = 0xb300 },
1713 { .base = 0xb400 },
1714 { .base = 0xb500 },
1715 { .base = 0xb600 },
1716 },
1717 };
1718
1719 /* PMI632 uses SDAM instead of LUT for pattern */
1720 static const struct lpg_data pmi632_lpg_data = {
1721 .triled_base = 0xd000,
1722
1723 .lut_size = 64,
1724
1725 .num_channels = 5,
1726 .channels = (const struct lpg_channel_data[]) {
1727 { .base = 0xb300, .triled_mask = BIT(7), .sdam_offset = 0x48 },
1728 { .base = 0xb400, .triled_mask = BIT(6), .sdam_offset = 0x56 },
1729 { .base = 0xb500, .triled_mask = BIT(5), .sdam_offset = 0x64 },
1730 { .base = 0xb600 },
1731 { .base = 0xb700 },
1732 },
1733 };
1734
1735 static const struct lpg_data pmi8994_lpg_data = {
1736 .lut_base = 0xb000,
1737 .lut_size = 24,
1738
1739 .triled_base = 0xd000,
1740 .triled_has_atc_ctl = true,
1741 .triled_has_src_sel = true,
1742
1743 .num_channels = 4,
1744 .channels = (const struct lpg_channel_data[]) {
1745 { .base = 0xb100, .triled_mask = BIT(5) },
1746 { .base = 0xb200, .triled_mask = BIT(6) },
1747 { .base = 0xb300, .triled_mask = BIT(7) },
1748 { .base = 0xb400 },
1749 },
1750 };
1751
1752 static const struct lpg_data pmi8998_lpg_data = {
1753 .lut_base = 0xb000,
1754 .lut_size = 49,
1755
1756 .triled_base = 0xd000,
1757
1758 .num_channels = 6,
1759 .channels = (const struct lpg_channel_data[]) {
1760 { .base = 0xb100 },
1761 { .base = 0xb200 },
1762 { .base = 0xb300, .triled_mask = BIT(5) },
1763 { .base = 0xb400, .triled_mask = BIT(6) },
1764 { .base = 0xb500, .triled_mask = BIT(7) },
1765 { .base = 0xb600 },
1766 },
1767 };
1768
1769 static const struct lpg_data pm8150b_lpg_data = {
1770 .lut_base = 0xb000,
1771 .lut_size = 24,
1772
1773 .triled_base = 0xd000,
1774
1775 .num_channels = 2,
1776 .channels = (const struct lpg_channel_data[]) {
1777 { .base = 0xb100, .triled_mask = BIT(7) },
1778 { .base = 0xb200, .triled_mask = BIT(6) },
1779 },
1780 };
1781
1782 static const struct lpg_data pm8150l_lpg_data = {
1783 .lut_base = 0xb000,
1784 .lut_size = 48,
1785
1786 .triled_base = 0xd000,
1787
1788 .num_channels = 5,
1789 .channels = (const struct lpg_channel_data[]) {
1790 { .base = 0xb100, .triled_mask = BIT(7) },
1791 { .base = 0xb200, .triled_mask = BIT(6) },
1792 { .base = 0xb300, .triled_mask = BIT(5) },
1793 { .base = 0xbc00 },
1794 { .base = 0xbd00 },
1795
1796 },
1797 };
1798
1799 static const struct lpg_data pm8350c_pwm_data = {
1800 .triled_base = 0xef00,
1801
1802 .lut_size = 122,
1803
1804 .num_channels = 4,
1805 .channels = (const struct lpg_channel_data[]) {
1806 { .base = 0xe800, .triled_mask = BIT(7), .sdam_offset = 0x48 },
1807 { .base = 0xe900, .triled_mask = BIT(6), .sdam_offset = 0x56 },
1808 { .base = 0xea00, .triled_mask = BIT(5), .sdam_offset = 0x64 },
1809 { .base = 0xeb00 },
1810 },
1811 };
1812
1813 static const struct lpg_data pmk8550_pwm_data = {
1814 .num_channels = 2,
1815 .channels = (const struct lpg_channel_data[]) {
1816 { .base = 0xe800 },
1817 { .base = 0xe900 },
1818 },
1819 };
1820
1821 static const struct of_device_id lpg_of_table[] = {
1822 { .compatible = "qcom,pm660l-lpg", .data = &pm660l_lpg_data },
1823 { .compatible = "qcom,pm8150b-lpg", .data = &pm8150b_lpg_data },
1824 { .compatible = "qcom,pm8150l-lpg", .data = &pm8150l_lpg_data },
1825 { .compatible = "qcom,pm8350c-pwm", .data = &pm8350c_pwm_data },
1826 { .compatible = "qcom,pm8916-pwm", .data = &pm8916_pwm_data },
1827 { .compatible = "qcom,pm8941-lpg", .data = &pm8941_lpg_data },
1828 { .compatible = "qcom,pm8994-lpg", .data = &pm8994_lpg_data },
1829 { .compatible = "qcom,pmi632-lpg", .data = &pmi632_lpg_data },
1830 { .compatible = "qcom,pmi8950-pwm", .data = &pmi8950_pwm_data },
1831 { .compatible = "qcom,pmi8994-lpg", .data = &pmi8994_lpg_data },
1832 { .compatible = "qcom,pmi8998-lpg", .data = &pmi8998_lpg_data },
1833 { .compatible = "qcom,pmc8180c-lpg", .data = &pm8150l_lpg_data },
1834 { .compatible = "qcom,pmk8550-pwm", .data = &pmk8550_pwm_data },
1835 {}
1836 };
1837 MODULE_DEVICE_TABLE(of, lpg_of_table);
1838
1839 static struct platform_driver lpg_driver = {
1840 .probe = lpg_probe,
1841 .driver = {
1842 .name = "qcom-spmi-lpg",
1843 .of_match_table = lpg_of_table,
1844 },
1845 };
1846 module_platform_driver(lpg_driver);
1847
1848 MODULE_DESCRIPTION("Qualcomm LPG LED driver");
1849 MODULE_LICENSE("GPL v2");
1850