Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
c72a1d60 RP |
2 | /* |
3 | * LED Class Core | |
4 | * | |
5 | * Copyright 2005-2006 Openedhand Ltd. | |
6 | * | |
7 | * Author: Richard Purdie <rpurdie@openedhand.com> | |
c72a1d60 RP |
8 | */ |
9 | ||
10 | #include <linux/kernel.h> | |
5607ca92 | 11 | #include <linux/led-class-multicolor.h> |
04713306 | 12 | #include <linux/leds.h> |
c72a1d60 RP |
13 | #include <linux/list.h> |
14 | #include <linux/module.h> | |
04713306 | 15 | #include <linux/mutex.h> |
8e1f4561 | 16 | #include <linux/of.h> |
bb4e9af0 | 17 | #include <linux/property.h> |
72f8da32 | 18 | #include <linux/rwsem.h> |
8e1f4561 | 19 | #include <linux/slab.h> |
bb4e9af0 | 20 | #include <uapi/linux/uleds.h> |
c72a1d60 RP |
21 | #include "leds.h" |
22 | ||
72f8da32 | 23 | DECLARE_RWSEM(leds_list_lock); |
4d404fd5 | 24 | EXPORT_SYMBOL_GPL(leds_list_lock); |
c72a1d60 | 25 | |
4d404fd5 | 26 | LIST_HEAD(leds_list); |
c72a1d60 | 27 | EXPORT_SYMBOL_GPL(leds_list); |
a403d930 | 28 | |
493179e6 | 29 | static const char * const led_colors[LED_COLOR_ID_MAX] = { |
bb4e9af0 JA |
30 | [LED_COLOR_ID_WHITE] = "white", |
31 | [LED_COLOR_ID_RED] = "red", | |
32 | [LED_COLOR_ID_GREEN] = "green", | |
33 | [LED_COLOR_ID_BLUE] = "blue", | |
34 | [LED_COLOR_ID_AMBER] = "amber", | |
35 | [LED_COLOR_ID_VIOLET] = "violet", | |
36 | [LED_COLOR_ID_YELLOW] = "yellow", | |
37 | [LED_COLOR_ID_IR] = "ir", | |
10d3e0d8 | 38 | [LED_COLOR_ID_MULTI] = "multicolor", |
54212f5a | 39 | [LED_COLOR_ID_RGB] = "rgb", |
a0679431 OJ |
40 | [LED_COLOR_ID_PURPLE] = "purple", |
41 | [LED_COLOR_ID_ORANGE] = "orange", | |
42 | [LED_COLOR_ID_PINK] = "pink", | |
43 | [LED_COLOR_ID_CYAN] = "cyan", | |
44 | [LED_COLOR_ID_LIME] = "lime", | |
bb4e9af0 | 45 | }; |
bb4e9af0 | 46 | |
af0bfab9 | 47 | static int __led_set_brightness(struct led_classdev *led_cdev, unsigned int value) |
d4887af9 HK |
48 | { |
49 | if (!led_cdev->brightness_set) | |
50 | return -ENOTSUPP; | |
51 | ||
52 | led_cdev->brightness_set(led_cdev, value); | |
53 | ||
54 | return 0; | |
55 | } | |
56 | ||
af0bfab9 | 57 | static int __led_set_brightness_blocking(struct led_classdev *led_cdev, unsigned int value) |
d4887af9 HK |
58 | { |
59 | if (!led_cdev->brightness_set_blocking) | |
60 | return -ENOTSUPP; | |
61 | ||
62 | return led_cdev->brightness_set_blocking(led_cdev, value); | |
63 | } | |
64 | ||
49404665 | 65 | static void led_timer_function(struct timer_list *t) |
757b06ae | 66 | { |
41cb0855 IM |
67 | struct led_classdev *led_cdev = timer_container_of(led_cdev, t, |
68 | blink_timer); | |
757b06ae JA |
69 | unsigned long brightness; |
70 | unsigned long delay; | |
71 | ||
72 | if (!led_cdev->blink_delay_on || !led_cdev->blink_delay_off) { | |
81fe8e5b | 73 | led_set_brightness_nosleep(led_cdev, LED_OFF); |
a9c6ce57 | 74 | clear_bit(LED_BLINK_SW, &led_cdev->work_flags); |
757b06ae JA |
75 | return; |
76 | } | |
77 | ||
a9c6ce57 HG |
78 | if (test_and_clear_bit(LED_BLINK_ONESHOT_STOP, |
79 | &led_cdev->work_flags)) { | |
80 | clear_bit(LED_BLINK_SW, &led_cdev->work_flags); | |
757b06ae JA |
81 | return; |
82 | } | |
83 | ||
84 | brightness = led_get_brightness(led_cdev); | |
85 | if (!brightness) { | |
86 | /* Time to switch the LED on. */ | |
eb1610b4 HG |
87 | if (test_and_clear_bit(LED_BLINK_BRIGHTNESS_CHANGE, |
88 | &led_cdev->work_flags)) | |
89 | brightness = led_cdev->new_blink_brightness; | |
90 | else | |
91 | brightness = led_cdev->blink_brightness; | |
757b06ae JA |
92 | delay = led_cdev->blink_delay_on; |
93 | } else { | |
94 | /* Store the current brightness value to be able | |
95 | * to restore it when the delay_off period is over. | |
96 | */ | |
eb1610b4 | 97 | led_cdev->blink_brightness = brightness; |
757b06ae JA |
98 | brightness = LED_OFF; |
99 | delay = led_cdev->blink_delay_off; | |
100 | } | |
101 | ||
81fe8e5b | 102 | led_set_brightness_nosleep(led_cdev, brightness); |
757b06ae JA |
103 | |
104 | /* Return in next iteration if led is in one-shot mode and we are in | |
105 | * the final blink state so that the led is toggled each delay_on + | |
106 | * delay_off milliseconds in worst case. | |
107 | */ | |
a9c6ce57 HG |
108 | if (test_bit(LED_BLINK_ONESHOT, &led_cdev->work_flags)) { |
109 | if (test_bit(LED_BLINK_INVERT, &led_cdev->work_flags)) { | |
757b06ae | 110 | if (brightness) |
a9c6ce57 HG |
111 | set_bit(LED_BLINK_ONESHOT_STOP, |
112 | &led_cdev->work_flags); | |
757b06ae JA |
113 | } else { |
114 | if (!brightness) | |
a9c6ce57 HG |
115 | set_bit(LED_BLINK_ONESHOT_STOP, |
116 | &led_cdev->work_flags); | |
757b06ae JA |
117 | } |
118 | } | |
119 | ||
120 | mod_timer(&led_cdev->blink_timer, jiffies + msecs_to_jiffies(delay)); | |
121 | } | |
122 | ||
fa15d8c6 HG |
123 | static void set_brightness_delayed_set_brightness(struct led_classdev *led_cdev, |
124 | unsigned int value) | |
757b06ae | 125 | { |
d33d1214 | 126 | int ret; |
757b06ae | 127 | |
fa15d8c6 | 128 | ret = __led_set_brightness(led_cdev, value); |
d33d1214 | 129 | if (ret == -ENOTSUPP) { |
fa15d8c6 | 130 | ret = __led_set_brightness_blocking(led_cdev, value); |
d33d1214 LJ |
131 | if (ret == -ENOTSUPP) |
132 | /* No back-end support to set a fixed brightness value */ | |
133 | return; | |
134 | } | |
135 | ||
136 | /* LED HW might have been unplugged, therefore don't warn */ | |
137 | if (ret == -ENODEV && led_cdev->flags & LED_UNREGISTERING && | |
138 | led_cdev->flags & LED_HW_PLUGGABLE) | |
139 | return; | |
140 | ||
141 | if (ret < 0) | |
1afcadfc JA |
142 | dev_err(led_cdev->dev, |
143 | "Setting an LED's brightness failed (%d)\n", ret); | |
757b06ae JA |
144 | } |
145 | ||
fa15d8c6 HG |
146 | static void set_brightness_delayed(struct work_struct *ws) |
147 | { | |
148 | struct led_classdev *led_cdev = | |
149 | container_of(ws, struct led_classdev, set_brightness_work); | |
150 | ||
151 | if (test_and_clear_bit(LED_BLINK_DISABLE, &led_cdev->work_flags)) { | |
152 | led_stop_software_blink(led_cdev); | |
153 | set_bit(LED_SET_BRIGHTNESS_OFF, &led_cdev->work_flags); | |
154 | } | |
155 | ||
156 | /* | |
157 | * Triggers may call led_set_brightness(LED_OFF), | |
158 | * led_set_brightness(LED_FULL) in quick succession to disable blinking | |
159 | * and turn the LED on. Both actions may have been scheduled to run | |
160 | * before this work item runs once. To make sure this works properly | |
161 | * handle LED_SET_BRIGHTNESS_OFF first. | |
162 | */ | |
2c70953b | 163 | if (test_and_clear_bit(LED_SET_BRIGHTNESS_OFF, &led_cdev->work_flags)) { |
fa15d8c6 | 164 | set_brightness_delayed_set_brightness(led_cdev, LED_OFF); |
2c70953b RP |
165 | /* |
166 | * The consecutives led_set_brightness(LED_OFF), | |
167 | * led_set_brightness(LED_FULL) could have been executed out of | |
168 | * order (LED_FULL first), if the work_flags has been set | |
169 | * between LED_SET_BRIGHTNESS_OFF and LED_SET_BRIGHTNESS of this | |
170 | * work. To avoid ending with the LED turned off, turn the LED | |
171 | * on again. | |
172 | */ | |
173 | if (led_cdev->delayed_set_value != LED_OFF) | |
174 | set_bit(LED_SET_BRIGHTNESS, &led_cdev->work_flags); | |
175 | } | |
fa15d8c6 HG |
176 | |
177 | if (test_and_clear_bit(LED_SET_BRIGHTNESS, &led_cdev->work_flags)) | |
178 | set_brightness_delayed_set_brightness(led_cdev, led_cdev->delayed_set_value); | |
22720a87 HG |
179 | |
180 | if (test_and_clear_bit(LED_SET_BLINK, &led_cdev->work_flags)) { | |
181 | unsigned long delay_on = led_cdev->delayed_delay_on; | |
182 | unsigned long delay_off = led_cdev->delayed_delay_off; | |
183 | ||
184 | led_blink_set(led_cdev, &delay_on, &delay_off); | |
185 | } | |
fa15d8c6 HG |
186 | } |
187 | ||
a403d930 BW |
188 | static void led_set_software_blink(struct led_classdev *led_cdev, |
189 | unsigned long delay_on, | |
190 | unsigned long delay_off) | |
191 | { | |
192 | int current_brightness; | |
193 | ||
194 | current_brightness = led_get_brightness(led_cdev); | |
195 | if (current_brightness) | |
196 | led_cdev->blink_brightness = current_brightness; | |
197 | if (!led_cdev->blink_brightness) | |
198 | led_cdev->blink_brightness = led_cdev->max_brightness; | |
199 | ||
a403d930 BW |
200 | led_cdev->blink_delay_on = delay_on; |
201 | led_cdev->blink_delay_off = delay_off; | |
202 | ||
8d82fef8 SS |
203 | /* never on - just set to off */ |
204 | if (!delay_on) { | |
81fe8e5b | 205 | led_set_brightness_nosleep(led_cdev, LED_OFF); |
a403d930 | 206 | return; |
8d82fef8 | 207 | } |
a403d930 BW |
208 | |
209 | /* never off - just set to brightness */ | |
210 | if (!delay_off) { | |
81fe8e5b JA |
211 | led_set_brightness_nosleep(led_cdev, |
212 | led_cdev->blink_brightness); | |
a403d930 BW |
213 | return; |
214 | } | |
215 | ||
a9c6ce57 | 216 | set_bit(LED_BLINK_SW, &led_cdev->work_flags); |
9067359f | 217 | mod_timer(&led_cdev->blink_timer, jiffies + 1); |
a403d930 BW |
218 | } |
219 | ||
220 | ||
20c0e6b8 | 221 | static void led_blink_setup(struct led_classdev *led_cdev, |
5bb629c5 FB |
222 | unsigned long *delay_on, |
223 | unsigned long *delay_off) | |
a403d930 | 224 | { |
a9c6ce57 | 225 | if (!test_bit(LED_BLINK_ONESHOT, &led_cdev->work_flags) && |
5bb629c5 | 226 | led_cdev->blink_set && |
a403d930 BW |
227 | !led_cdev->blink_set(led_cdev, delay_on, delay_off)) |
228 | return; | |
229 | ||
230 | /* blink with 1 Hz as default if nothing specified */ | |
231 | if (!*delay_on && !*delay_off) | |
232 | *delay_on = *delay_off = 500; | |
233 | ||
234 | led_set_software_blink(led_cdev, *delay_on, *delay_off); | |
235 | } | |
5bb629c5 | 236 | |
757b06ae JA |
237 | void led_init_core(struct led_classdev *led_cdev) |
238 | { | |
239 | INIT_WORK(&led_cdev->set_brightness_work, set_brightness_delayed); | |
240 | ||
49404665 | 241 | timer_setup(&led_cdev->blink_timer, led_timer_function, 0); |
757b06ae JA |
242 | } |
243 | EXPORT_SYMBOL_GPL(led_init_core); | |
244 | ||
5bb629c5 FB |
245 | void led_blink_set(struct led_classdev *led_cdev, |
246 | unsigned long *delay_on, | |
247 | unsigned long *delay_off) | |
248 | { | |
8fa7292f | 249 | timer_delete_sync(&led_cdev->blink_timer); |
5bb629c5 | 250 | |
7b6af2c5 | 251 | clear_bit(LED_BLINK_SW, &led_cdev->work_flags); |
a9c6ce57 HG |
252 | clear_bit(LED_BLINK_ONESHOT, &led_cdev->work_flags); |
253 | clear_bit(LED_BLINK_ONESHOT_STOP, &led_cdev->work_flags); | |
5bb629c5 FB |
254 | |
255 | led_blink_setup(led_cdev, delay_on, delay_off); | |
256 | } | |
2806e2ff | 257 | EXPORT_SYMBOL_GPL(led_blink_set); |
a403d930 | 258 | |
5bb629c5 FB |
259 | void led_blink_set_oneshot(struct led_classdev *led_cdev, |
260 | unsigned long *delay_on, | |
261 | unsigned long *delay_off, | |
262 | int invert) | |
263 | { | |
a9c6ce57 | 264 | if (test_bit(LED_BLINK_ONESHOT, &led_cdev->work_flags) && |
9067359f | 265 | timer_pending(&led_cdev->blink_timer)) |
5bb629c5 FB |
266 | return; |
267 | ||
a9c6ce57 HG |
268 | set_bit(LED_BLINK_ONESHOT, &led_cdev->work_flags); |
269 | clear_bit(LED_BLINK_ONESHOT_STOP, &led_cdev->work_flags); | |
5bb629c5 FB |
270 | |
271 | if (invert) | |
a9c6ce57 | 272 | set_bit(LED_BLINK_INVERT, &led_cdev->work_flags); |
5bb629c5 | 273 | else |
a9c6ce57 | 274 | clear_bit(LED_BLINK_INVERT, &led_cdev->work_flags); |
5bb629c5 FB |
275 | |
276 | led_blink_setup(led_cdev, delay_on, delay_off); | |
277 | } | |
2806e2ff | 278 | EXPORT_SYMBOL_GPL(led_blink_set_oneshot); |
5bb629c5 | 279 | |
22720a87 HG |
280 | void led_blink_set_nosleep(struct led_classdev *led_cdev, unsigned long delay_on, |
281 | unsigned long delay_off) | |
282 | { | |
283 | /* If necessary delegate to a work queue task. */ | |
284 | if (led_cdev->blink_set && led_cdev->brightness_set_blocking) { | |
285 | led_cdev->delayed_delay_on = delay_on; | |
286 | led_cdev->delayed_delay_off = delay_off; | |
287 | set_bit(LED_SET_BLINK, &led_cdev->work_flags); | |
32360bf6 | 288 | queue_work(led_cdev->wq, &led_cdev->set_brightness_work); |
22720a87 HG |
289 | return; |
290 | } | |
291 | ||
292 | led_blink_set(led_cdev, &delay_on, &delay_off); | |
293 | } | |
294 | EXPORT_SYMBOL_GPL(led_blink_set_nosleep); | |
295 | ||
d23a22a7 | 296 | void led_stop_software_blink(struct led_classdev *led_cdev) |
a403d930 | 297 | { |
8fa7292f | 298 | timer_delete_sync(&led_cdev->blink_timer); |
43786482 FB |
299 | led_cdev->blink_delay_on = 0; |
300 | led_cdev->blink_delay_off = 0; | |
a9c6ce57 | 301 | clear_bit(LED_BLINK_SW, &led_cdev->work_flags); |
d23a22a7 FB |
302 | } |
303 | EXPORT_SYMBOL_GPL(led_stop_software_blink); | |
304 | ||
af0bfab9 | 305 | void led_set_brightness(struct led_classdev *led_cdev, unsigned int brightness) |
d23a22a7 | 306 | { |
f1e80c07 | 307 | /* |
7cfe749f | 308 | * If software blink is active, delay brightness setting |
f1e80c07 JA |
309 | * until the next timer tick. |
310 | */ | |
a9c6ce57 | 311 | if (test_bit(LED_BLINK_SW, &led_cdev->work_flags)) { |
f1e80c07 JA |
312 | /* |
313 | * If we need to disable soft blinking delegate this to the | |
314 | * work queue task to avoid problems in case we are called | |
315 | * from hard irq context. | |
316 | */ | |
af0bfab9 | 317 | if (!brightness) { |
a9c6ce57 | 318 | set_bit(LED_BLINK_DISABLE, &led_cdev->work_flags); |
32360bf6 | 319 | queue_work(led_cdev->wq, &led_cdev->set_brightness_work); |
f1e80c07 | 320 | } else { |
a9c6ce57 HG |
321 | set_bit(LED_BLINK_BRIGHTNESS_CHANGE, |
322 | &led_cdev->work_flags); | |
eb1610b4 | 323 | led_cdev->new_blink_brightness = brightness; |
f1e80c07 | 324 | } |
d23a22a7 FB |
325 | return; |
326 | } | |
43786482 | 327 | |
13ae79bb | 328 | led_set_brightness_nosleep(led_cdev, brightness); |
a403d930 | 329 | } |
2806e2ff | 330 | EXPORT_SYMBOL_GPL(led_set_brightness); |
3ef7de53 | 331 | |
af0bfab9 | 332 | void led_set_brightness_nopm(struct led_classdev *led_cdev, unsigned int value) |
81fe8e5b JA |
333 | { |
334 | /* Use brightness_set op if available, it is guaranteed not to sleep */ | |
d4887af9 | 335 | if (!__led_set_brightness(led_cdev, value)) |
81fe8e5b | 336 | return; |
81fe8e5b | 337 | |
fa15d8c6 HG |
338 | /* |
339 | * Brightness setting can sleep, delegate it to a work queue task. | |
340 | * value 0 / LED_OFF is special, since it also disables hw-blinking | |
341 | * (sw-blink disable is handled in led_set_brightness()). | |
342 | * To avoid a hw-blink-disable getting lost when a second brightness | |
343 | * change is done immediately afterwards (before the work runs), | |
344 | * it uses a separate work_flag. | |
345 | */ | |
2c70953b RP |
346 | led_cdev->delayed_set_value = value; |
347 | /* Ensure delayed_set_value is seen before work_flags modification */ | |
348 | smp_mb__before_atomic(); | |
349 | ||
350 | if (value) | |
fa15d8c6 | 351 | set_bit(LED_SET_BRIGHTNESS, &led_cdev->work_flags); |
2c70953b | 352 | else { |
fa15d8c6 | 353 | clear_bit(LED_SET_BRIGHTNESS, &led_cdev->work_flags); |
22720a87 | 354 | clear_bit(LED_SET_BLINK, &led_cdev->work_flags); |
fa15d8c6 HG |
355 | set_bit(LED_SET_BRIGHTNESS_OFF, &led_cdev->work_flags); |
356 | } | |
357 | ||
32360bf6 | 358 | queue_work(led_cdev->wq, &led_cdev->set_brightness_work); |
81fe8e5b JA |
359 | } |
360 | EXPORT_SYMBOL_GPL(led_set_brightness_nopm); | |
361 | ||
af0bfab9 | 362 | void led_set_brightness_nosleep(struct led_classdev *led_cdev, unsigned int value) |
81fe8e5b JA |
363 | { |
364 | led_cdev->brightness = min(value, led_cdev->max_brightness); | |
365 | ||
366 | if (led_cdev->flags & LED_SUSPENDED) | |
367 | return; | |
368 | ||
369 | led_set_brightness_nopm(led_cdev, led_cdev->brightness); | |
370 | } | |
371 | EXPORT_SYMBOL_GPL(led_set_brightness_nosleep); | |
372 | ||
af0bfab9 | 373 | int led_set_brightness_sync(struct led_classdev *led_cdev, unsigned int value) |
13ae79bb JA |
374 | { |
375 | if (led_cdev->blink_delay_on || led_cdev->blink_delay_off) | |
376 | return -EBUSY; | |
377 | ||
378 | led_cdev->brightness = min(value, led_cdev->max_brightness); | |
379 | ||
380 | if (led_cdev->flags & LED_SUSPENDED) | |
381 | return 0; | |
382 | ||
d4887af9 | 383 | return __led_set_brightness_blocking(led_cdev, led_cdev->brightness); |
13ae79bb JA |
384 | } |
385 | EXPORT_SYMBOL_GPL(led_set_brightness_sync); | |
386 | ||
5607ca92 HG |
387 | /* |
388 | * This is a led-core function because just like led_set_brightness() | |
389 | * it is used in the kernel by e.g. triggers. | |
390 | */ | |
391 | void led_mc_set_brightness(struct led_classdev *led_cdev, | |
392 | unsigned int *intensity_value, unsigned int num_colors, | |
393 | unsigned int brightness) | |
394 | { | |
395 | struct led_classdev_mc *mcled_cdev; | |
396 | unsigned int i; | |
397 | ||
398 | if (!(led_cdev->flags & LED_MULTI_COLOR)) { | |
399 | dev_err_once(led_cdev->dev, "error not a multi-color LED\n"); | |
400 | return; | |
401 | } | |
402 | ||
403 | mcled_cdev = lcdev_to_mccdev(led_cdev); | |
404 | if (num_colors != mcled_cdev->num_colors) { | |
405 | dev_err_once(led_cdev->dev, "error num_colors mismatch %u != %u\n", | |
406 | num_colors, mcled_cdev->num_colors); | |
407 | return; | |
408 | } | |
409 | ||
410 | for (i = 0; i < mcled_cdev->num_colors; i++) | |
411 | mcled_cdev->subled_info[i].intensity = intensity_value[i]; | |
412 | ||
413 | led_set_brightness(led_cdev, brightness); | |
414 | } | |
415 | EXPORT_SYMBOL_GPL(led_mc_set_brightness); | |
416 | ||
3ef7de53 JA |
417 | int led_update_brightness(struct led_classdev *led_cdev) |
418 | { | |
49e50aad | 419 | int ret; |
3ef7de53 JA |
420 | |
421 | if (led_cdev->brightness_get) { | |
422 | ret = led_cdev->brightness_get(led_cdev); | |
49e50aad AS |
423 | if (ret < 0) |
424 | return ret; | |
425 | ||
426 | led_cdev->brightness = ret; | |
3ef7de53 JA |
427 | } |
428 | ||
49e50aad | 429 | return 0; |
3ef7de53 | 430 | } |
2806e2ff | 431 | EXPORT_SYMBOL_GPL(led_update_brightness); |
acd899e4 | 432 | |
8e1f4561 KK |
433 | u32 *led_get_default_pattern(struct led_classdev *led_cdev, unsigned int *size) |
434 | { | |
fd81d7e9 | 435 | struct fwnode_handle *fwnode = led_cdev->dev->fwnode; |
8e1f4561 KK |
436 | u32 *pattern; |
437 | int count; | |
438 | ||
fd81d7e9 | 439 | count = fwnode_property_count_u32(fwnode, "led-pattern"); |
8e1f4561 KK |
440 | if (count < 0) |
441 | return NULL; | |
442 | ||
443 | pattern = kcalloc(count, sizeof(*pattern), GFP_KERNEL); | |
444 | if (!pattern) | |
445 | return NULL; | |
446 | ||
fd81d7e9 | 447 | if (fwnode_property_read_u32_array(fwnode, "led-pattern", pattern, count)) { |
8e1f4561 KK |
448 | kfree(pattern); |
449 | return NULL; | |
450 | } | |
451 | ||
452 | *size = count; | |
453 | ||
454 | return pattern; | |
455 | } | |
456 | EXPORT_SYMBOL_GPL(led_get_default_pattern); | |
457 | ||
acd899e4 JA |
458 | /* Caller must ensure led_cdev->led_access held */ |
459 | void led_sysfs_disable(struct led_classdev *led_cdev) | |
460 | { | |
461 | lockdep_assert_held(&led_cdev->led_access); | |
462 | ||
463 | led_cdev->flags |= LED_SYSFS_DISABLE; | |
464 | } | |
465 | EXPORT_SYMBOL_GPL(led_sysfs_disable); | |
466 | ||
467 | /* Caller must ensure led_cdev->led_access held */ | |
468 | void led_sysfs_enable(struct led_classdev *led_cdev) | |
469 | { | |
470 | lockdep_assert_held(&led_cdev->led_access); | |
471 | ||
472 | led_cdev->flags &= ~LED_SYSFS_DISABLE; | |
473 | } | |
474 | EXPORT_SYMBOL_GPL(led_sysfs_enable); | |
bb4e9af0 JA |
475 | |
476 | static void led_parse_fwnode_props(struct device *dev, | |
477 | struct fwnode_handle *fwnode, | |
478 | struct led_properties *props) | |
479 | { | |
480 | int ret; | |
481 | ||
482 | if (!fwnode) | |
483 | return; | |
484 | ||
485 | if (fwnode_property_present(fwnode, "label")) { | |
486 | ret = fwnode_property_read_string(fwnode, "label", &props->label); | |
487 | if (ret) | |
488 | dev_err(dev, "Error parsing 'label' property (%d)\n", ret); | |
489 | return; | |
490 | } | |
491 | ||
492 | if (fwnode_property_present(fwnode, "color")) { | |
493 | ret = fwnode_property_read_u32(fwnode, "color", &props->color); | |
494 | if (ret) | |
495 | dev_err(dev, "Error parsing 'color' property (%d)\n", ret); | |
496 | else if (props->color >= LED_COLOR_ID_MAX) | |
497 | dev_err(dev, "LED color identifier out of range\n"); | |
498 | else | |
499 | props->color_present = true; | |
500 | } | |
501 | ||
502 | ||
503 | if (!fwnode_property_present(fwnode, "function")) | |
504 | return; | |
505 | ||
506 | ret = fwnode_property_read_string(fwnode, "function", &props->function); | |
507 | if (ret) { | |
508 | dev_err(dev, | |
509 | "Error parsing 'function' property (%d)\n", | |
510 | ret); | |
511 | } | |
512 | ||
513 | if (!fwnode_property_present(fwnode, "function-enumerator")) | |
514 | return; | |
515 | ||
516 | ret = fwnode_property_read_u32(fwnode, "function-enumerator", | |
517 | &props->func_enum); | |
518 | if (ret) { | |
519 | dev_err(dev, | |
520 | "Error parsing 'function-enumerator' property (%d)\n", | |
521 | ret); | |
522 | } else { | |
523 | props->func_enum_present = true; | |
524 | } | |
525 | } | |
526 | ||
527 | int led_compose_name(struct device *dev, struct led_init_data *init_data, | |
528 | char *led_classdev_name) | |
529 | { | |
530 | struct led_properties props = {}; | |
531 | struct fwnode_handle *fwnode = init_data->fwnode; | |
532 | const char *devicename = init_data->devicename; | |
ee44a1de | 533 | int n; |
bb4e9af0 JA |
534 | |
535 | if (!led_classdev_name) | |
536 | return -EINVAL; | |
537 | ||
538 | led_parse_fwnode_props(dev, fwnode, &props); | |
539 | ||
540 | if (props.label) { | |
541 | /* | |
542 | * If init_data.devicename is NULL, then it indicates that | |
543 | * DT label should be used as-is for LED class device name. | |
544 | * Otherwise the label is prepended with devicename to compose | |
545 | * the final LED class device name. | |
546 | */ | |
ee44a1de AS |
547 | if (devicename) { |
548 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s:%s", | |
549 | devicename, props.label); | |
bb4e9af0 | 550 | } else { |
ee44a1de | 551 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s", props.label); |
bb4e9af0 JA |
552 | } |
553 | } else if (props.function || props.color_present) { | |
554 | char tmp_buf[LED_MAX_NAME_SIZE]; | |
555 | ||
556 | if (props.func_enum_present) { | |
ee44a1de AS |
557 | n = snprintf(tmp_buf, LED_MAX_NAME_SIZE, "%s:%s-%d", |
558 | props.color_present ? led_colors[props.color] : "", | |
559 | props.function ?: "", props.func_enum); | |
bb4e9af0 | 560 | } else { |
ee44a1de AS |
561 | n = snprintf(tmp_buf, LED_MAX_NAME_SIZE, "%s:%s", |
562 | props.color_present ? led_colors[props.color] : "", | |
563 | props.function ?: ""); | |
bb4e9af0 | 564 | } |
ee44a1de AS |
565 | if (n >= LED_MAX_NAME_SIZE) |
566 | return -E2BIG; | |
567 | ||
bb4e9af0 | 568 | if (init_data->devname_mandatory) { |
ee44a1de AS |
569 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s:%s", |
570 | devicename, tmp_buf); | |
bb4e9af0 | 571 | } else { |
ee44a1de | 572 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s", tmp_buf); |
bb4e9af0 JA |
573 | } |
574 | } else if (init_data->default_label) { | |
575 | if (!devicename) { | |
576 | dev_err(dev, "Legacy LED naming requires devicename segment"); | |
577 | return -EINVAL; | |
578 | } | |
ee44a1de AS |
579 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s:%s", |
580 | devicename, init_data->default_label); | |
bb4e9af0 | 581 | } else if (is_of_node(fwnode)) { |
ee44a1de AS |
582 | n = snprintf(led_classdev_name, LED_MAX_NAME_SIZE, "%s", |
583 | to_of_node(fwnode)->name); | |
bb4e9af0 JA |
584 | } else |
585 | return -EINVAL; | |
586 | ||
ee44a1de AS |
587 | if (n >= LED_MAX_NAME_SIZE) |
588 | return -E2BIG; | |
589 | ||
bb4e9af0 JA |
590 | return 0; |
591 | } | |
592 | EXPORT_SYMBOL_GPL(led_compose_name); | |
791bc411 | 593 | |
5f2e9507 TW |
594 | const char *led_get_color_name(u8 color_id) |
595 | { | |
596 | if (color_id >= ARRAY_SIZE(led_colors)) | |
597 | return NULL; | |
598 | ||
599 | return led_colors[color_id]; | |
600 | } | |
601 | EXPORT_SYMBOL_GPL(led_get_color_name); | |
602 | ||
791bc411 DOH |
603 | enum led_default_state led_init_default_state_get(struct fwnode_handle *fwnode) |
604 | { | |
605 | const char *state = NULL; | |
606 | ||
607 | if (!fwnode_property_read_string(fwnode, "default-state", &state)) { | |
608 | if (!strcmp(state, "keep")) | |
609 | return LEDS_DEFSTATE_KEEP; | |
610 | if (!strcmp(state, "on")) | |
611 | return LEDS_DEFSTATE_ON; | |
612 | } | |
613 | ||
614 | return LEDS_DEFSTATE_OFF; | |
615 | } | |
616 | EXPORT_SYMBOL_GPL(led_init_default_state_get); |