1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2015, Sony Mobile Communications, AB.
5 #include <linux/kernel.h>
6 #include <linux/backlight.h>
7 #include <linux/module.h>
9 #include <linux/of_device.h>
10 #include <linux/regmap.h>
13 #define PM8941_WLED_DEFAULT_BRIGHTNESS 2048
15 #define PM8941_WLED_REG_VAL_BASE 0x40
16 #define PM8941_WLED_REG_VAL_MAX 0xFFF
18 #define PM8941_WLED_REG_MOD_EN 0x46
19 #define PM8941_WLED_REG_MOD_EN_BIT BIT(7)
20 #define PM8941_WLED_REG_MOD_EN_MASK BIT(7)
22 #define PM8941_WLED_REG_SYNC 0x47
23 #define PM8941_WLED_REG_SYNC_MASK 0x07
24 #define PM8941_WLED_REG_SYNC_LED1 BIT(0)
25 #define PM8941_WLED_REG_SYNC_LED2 BIT(1)
26 #define PM8941_WLED_REG_SYNC_LED3 BIT(2)
27 #define PM8941_WLED_REG_SYNC_ALL 0x07
28 #define PM8941_WLED_REG_SYNC_CLEAR 0x00
30 #define PM8941_WLED_REG_FREQ 0x4c
31 #define PM8941_WLED_REG_FREQ_MASK 0x0f
33 #define PM8941_WLED_REG_OVP 0x4d
34 #define PM8941_WLED_REG_OVP_MASK 0x03
36 #define PM8941_WLED_REG_BOOST 0x4e
37 #define PM8941_WLED_REG_BOOST_MASK 0x07
39 #define PM8941_WLED_REG_SINK 0x4f
40 #define PM8941_WLED_REG_SINK_MASK 0xe0
41 #define PM8941_WLED_REG_SINK_SHFT 0x05
43 /* Per-'string' registers below */
44 #define PM8941_WLED_REG_STR_OFFSET 0x10
46 #define PM8941_WLED_REG_STR_MOD_EN_BASE 0x60
47 #define PM8941_WLED_REG_STR_MOD_MASK BIT(7)
48 #define PM8941_WLED_REG_STR_MOD_EN BIT(7)
50 #define PM8941_WLED_REG_STR_SCALE_BASE 0x62
51 #define PM8941_WLED_REG_STR_SCALE_MASK 0x1f
53 #define PM8941_WLED_REG_STR_MOD_SRC_BASE 0x63
54 #define PM8941_WLED_REG_STR_MOD_SRC_MASK 0x01
55 #define PM8941_WLED_REG_STR_MOD_SRC_INT 0x00
56 #define PM8941_WLED_REG_STR_MOD_SRC_EXT 0x01
58 #define PM8941_WLED_REG_STR_CABC_BASE 0x66
59 #define PM8941_WLED_REG_STR_CABC_MASK BIT(7)
60 #define PM8941_WLED_REG_STR_CABC_EN BIT(7)
62 struct pm8941_wled_config
{
75 struct regmap
*regmap
;
78 struct pm8941_wled_config cfg
;
81 static int pm8941_wled_update_status(struct backlight_device
*bl
)
83 struct pm8941_wled
*wled
= bl_get_data(bl
);
84 u16 val
= bl
->props
.brightness
;
89 if (bl
->props
.power
!= FB_BLANK_UNBLANK
||
90 bl
->props
.fb_blank
!= FB_BLANK_UNBLANK
||
91 bl
->props
.state
& BL_CORE_FBBLANK
)
95 ctrl
= PM8941_WLED_REG_MOD_EN_BIT
;
97 rc
= regmap_update_bits(wled
->regmap
,
98 wled
->addr
+ PM8941_WLED_REG_MOD_EN
,
99 PM8941_WLED_REG_MOD_EN_MASK
, ctrl
);
103 for (i
= 0; i
< wled
->cfg
.num_strings
; ++i
) {
104 u8 v
[2] = { val
& 0xff, (val
>> 8) & 0xf };
106 rc
= regmap_bulk_write(wled
->regmap
,
107 wled
->addr
+ PM8941_WLED_REG_VAL_BASE
+ 2 * i
,
113 rc
= regmap_update_bits(wled
->regmap
,
114 wled
->addr
+ PM8941_WLED_REG_SYNC
,
115 PM8941_WLED_REG_SYNC_MASK
, PM8941_WLED_REG_SYNC_ALL
);
119 rc
= regmap_update_bits(wled
->regmap
,
120 wled
->addr
+ PM8941_WLED_REG_SYNC
,
121 PM8941_WLED_REG_SYNC_MASK
, PM8941_WLED_REG_SYNC_CLEAR
);
125 static int pm8941_wled_setup(struct pm8941_wled
*wled
)
130 rc
= regmap_update_bits(wled
->regmap
,
131 wled
->addr
+ PM8941_WLED_REG_OVP
,
132 PM8941_WLED_REG_OVP_MASK
, wled
->cfg
.ovp
);
136 rc
= regmap_update_bits(wled
->regmap
,
137 wled
->addr
+ PM8941_WLED_REG_BOOST
,
138 PM8941_WLED_REG_BOOST_MASK
, wled
->cfg
.i_boost_limit
);
142 rc
= regmap_update_bits(wled
->regmap
,
143 wled
->addr
+ PM8941_WLED_REG_FREQ
,
144 PM8941_WLED_REG_FREQ_MASK
, wled
->cfg
.switch_freq
);
148 if (wled
->cfg
.cs_out_en
) {
149 u8 all
= (BIT(wled
->cfg
.num_strings
) - 1)
150 << PM8941_WLED_REG_SINK_SHFT
;
152 rc
= regmap_update_bits(wled
->regmap
,
153 wled
->addr
+ PM8941_WLED_REG_SINK
,
154 PM8941_WLED_REG_SINK_MASK
, all
);
159 for (i
= 0; i
< wled
->cfg
.num_strings
; ++i
) {
160 u16 addr
= wled
->addr
+ PM8941_WLED_REG_STR_OFFSET
* i
;
162 rc
= regmap_update_bits(wled
->regmap
,
163 addr
+ PM8941_WLED_REG_STR_MOD_EN_BASE
,
164 PM8941_WLED_REG_STR_MOD_MASK
,
165 PM8941_WLED_REG_STR_MOD_EN
);
169 if (wled
->cfg
.ext_gen
) {
170 rc
= regmap_update_bits(wled
->regmap
,
171 addr
+ PM8941_WLED_REG_STR_MOD_SRC_BASE
,
172 PM8941_WLED_REG_STR_MOD_SRC_MASK
,
173 PM8941_WLED_REG_STR_MOD_SRC_EXT
);
178 rc
= regmap_update_bits(wled
->regmap
,
179 addr
+ PM8941_WLED_REG_STR_SCALE_BASE
,
180 PM8941_WLED_REG_STR_SCALE_MASK
,
185 rc
= regmap_update_bits(wled
->regmap
,
186 addr
+ PM8941_WLED_REG_STR_CABC_BASE
,
187 PM8941_WLED_REG_STR_CABC_MASK
,
189 PM8941_WLED_REG_STR_CABC_EN
: 0);
197 static const struct pm8941_wled_config pm8941_wled_config_defaults
= {
208 struct pm8941_wled_var_cfg
{
214 static const u32 pm8941_wled_i_boost_limit_values
[] = {
215 105, 385, 525, 805, 980, 1260, 1400, 1680,
218 static const struct pm8941_wled_var_cfg pm8941_wled_i_boost_limit_cfg
= {
219 .values
= pm8941_wled_i_boost_limit_values
,
220 .size
= ARRAY_SIZE(pm8941_wled_i_boost_limit_values
),
223 static const u32 pm8941_wled_ovp_values
[] = {
227 static const struct pm8941_wled_var_cfg pm8941_wled_ovp_cfg
= {
228 .values
= pm8941_wled_ovp_values
,
229 .size
= ARRAY_SIZE(pm8941_wled_ovp_values
),
232 static u32
pm8941_wled_num_strings_values_fn(u32 idx
)
237 static const struct pm8941_wled_var_cfg pm8941_wled_num_strings_cfg
= {
238 .fn
= pm8941_wled_num_strings_values_fn
,
242 static u32
pm8941_wled_switch_freq_values_fn(u32 idx
)
244 return 19200 / (2 * (1 + idx
));
247 static const struct pm8941_wled_var_cfg pm8941_wled_switch_freq_cfg
= {
248 .fn
= pm8941_wled_switch_freq_values_fn
,
252 static const struct pm8941_wled_var_cfg pm8941_wled_i_limit_cfg
= {
256 static u32
pm8941_wled_values(const struct pm8941_wled_var_cfg
*cfg
, u32 idx
)
258 if (idx
>= cfg
->size
)
263 return cfg
->values
[idx
];
267 static int pm8941_wled_configure(struct pm8941_wled
*wled
, struct device
*dev
)
269 struct pm8941_wled_config
*cfg
= &wled
->cfg
;
279 const struct pm8941_wled_var_cfg
*cfg
;
282 "qcom,current-boost-limit",
284 .cfg
= &pm8941_wled_i_boost_limit_cfg
,
287 "qcom,current-limit",
289 .cfg
= &pm8941_wled_i_limit_cfg
,
294 .cfg
= &pm8941_wled_ovp_cfg
,
297 "qcom,switching-freq",
299 .cfg
= &pm8941_wled_switch_freq_cfg
,
304 .cfg
= &pm8941_wled_num_strings_cfg
,
311 { "qcom,cs-out", &cfg
->cs_out_en
, },
312 { "qcom,ext-gen", &cfg
->ext_gen
, },
313 { "qcom,cabc", &cfg
->cabc_en
, },
316 rc
= of_property_read_u32(dev
->of_node
, "reg", &val
);
317 if (rc
|| val
> 0xffff) {
318 dev_err(dev
, "invalid IO resources\n");
319 return rc
? rc
: -EINVAL
;
323 rc
= of_property_read_string(dev
->of_node
, "label", &wled
->name
);
325 wled
->name
= devm_kasprintf(dev
, GFP_KERNEL
, "%pOFn", dev
->of_node
);
327 *cfg
= pm8941_wled_config_defaults
;
328 for (i
= 0; i
< ARRAY_SIZE(u32_opts
); ++i
) {
329 rc
= of_property_read_u32(dev
->of_node
, u32_opts
[i
].name
, &val
);
333 dev_err(dev
, "error reading '%s'\n", u32_opts
[i
].name
);
338 for (j
= 0; c
!= val
; j
++) {
339 c
= pm8941_wled_values(u32_opts
[i
].cfg
, j
);
341 dev_err(dev
, "invalid value for '%s'\n",
347 dev_dbg(dev
, "'%s' = %u\n", u32_opts
[i
].name
, c
);
348 *u32_opts
[i
].val_ptr
= j
;
351 for (i
= 0; i
< ARRAY_SIZE(bool_opts
); ++i
) {
352 if (of_property_read_bool(dev
->of_node
, bool_opts
[i
].name
))
353 *bool_opts
[i
].val_ptr
= true;
356 cfg
->num_strings
= cfg
->num_strings
+ 1;
361 static const struct backlight_ops pm8941_wled_ops
= {
362 .update_status
= pm8941_wled_update_status
,
365 static int pm8941_wled_probe(struct platform_device
*pdev
)
367 struct backlight_properties props
;
368 struct backlight_device
*bl
;
369 struct pm8941_wled
*wled
;
370 struct regmap
*regmap
;
374 regmap
= dev_get_regmap(pdev
->dev
.parent
, NULL
);
376 dev_err(&pdev
->dev
, "Unable to get regmap\n");
380 wled
= devm_kzalloc(&pdev
->dev
, sizeof(*wled
), GFP_KERNEL
);
384 wled
->regmap
= regmap
;
386 rc
= pm8941_wled_configure(wled
, &pdev
->dev
);
390 rc
= pm8941_wled_setup(wled
);
394 val
= PM8941_WLED_DEFAULT_BRIGHTNESS
;
395 of_property_read_u32(pdev
->dev
.of_node
, "default-brightness", &val
);
397 memset(&props
, 0, sizeof(struct backlight_properties
));
398 props
.type
= BACKLIGHT_RAW
;
399 props
.brightness
= val
;
400 props
.max_brightness
= PM8941_WLED_REG_VAL_MAX
;
401 bl
= devm_backlight_device_register(&pdev
->dev
, wled
->name
,
403 &pm8941_wled_ops
, &props
);
404 return PTR_ERR_OR_ZERO(bl
);
407 static const struct of_device_id pm8941_wled_match_table
[] = {
408 { .compatible
= "qcom,pm8941-wled" },
411 MODULE_DEVICE_TABLE(of
, pm8941_wled_match_table
);
413 static struct platform_driver pm8941_wled_driver
= {
414 .probe
= pm8941_wled_probe
,
416 .name
= "pm8941-wled",
417 .of_match_table
= pm8941_wled_match_table
,
421 module_platform_driver(pm8941_wled_driver
);
423 MODULE_DESCRIPTION("pm8941 wled driver");
424 MODULE_LICENSE("GPL v2");