Commit | Line | Data |
---|---|---|
c72a1d60 RP |
1 | /* |
2 | * LED Class Core | |
3 | * | |
4 | * Copyright 2005-2006 Openedhand Ltd. | |
5 | * | |
6 | * Author: Richard Purdie <rpurdie@openedhand.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | * | |
12 | */ | |
13 | ||
14 | #include <linux/kernel.h> | |
15 | #include <linux/list.h> | |
16 | #include <linux/module.h> | |
72f8da32 | 17 | #include <linux/rwsem.h> |
c72a1d60 | 18 | #include <linux/leds.h> |
8b37e1be | 19 | #include <linux/workqueue.h> |
c72a1d60 RP |
20 | #include "leds.h" |
21 | ||
72f8da32 | 22 | DECLARE_RWSEM(leds_list_lock); |
4d404fd5 | 23 | EXPORT_SYMBOL_GPL(leds_list_lock); |
c72a1d60 | 24 | |
4d404fd5 | 25 | LIST_HEAD(leds_list); |
c72a1d60 | 26 | EXPORT_SYMBOL_GPL(leds_list); |
a403d930 | 27 | |
a403d930 BW |
28 | static void led_set_software_blink(struct led_classdev *led_cdev, |
29 | unsigned long delay_on, | |
30 | unsigned long delay_off) | |
31 | { | |
32 | int current_brightness; | |
33 | ||
34 | current_brightness = led_get_brightness(led_cdev); | |
35 | if (current_brightness) | |
36 | led_cdev->blink_brightness = current_brightness; | |
37 | if (!led_cdev->blink_brightness) | |
38 | led_cdev->blink_brightness = led_cdev->max_brightness; | |
39 | ||
a403d930 BW |
40 | led_cdev->blink_delay_on = delay_on; |
41 | led_cdev->blink_delay_off = delay_off; | |
42 | ||
8d82fef8 SS |
43 | /* never on - just set to off */ |
44 | if (!delay_on) { | |
45 | __led_set_brightness(led_cdev, LED_OFF); | |
a403d930 | 46 | return; |
8d82fef8 | 47 | } |
a403d930 BW |
48 | |
49 | /* never off - just set to brightness */ | |
50 | if (!delay_off) { | |
0da3e65b | 51 | __led_set_brightness(led_cdev, led_cdev->blink_brightness); |
a403d930 BW |
52 | return; |
53 | } | |
54 | ||
8b37e1be | 55 | queue_delayed_work(system_wq, &led_cdev->blink_work, 1); |
a403d930 BW |
56 | } |
57 | ||
58 | ||
20c0e6b8 | 59 | static void led_blink_setup(struct led_classdev *led_cdev, |
5bb629c5 FB |
60 | unsigned long *delay_on, |
61 | unsigned long *delay_off) | |
a403d930 | 62 | { |
5bb629c5 FB |
63 | if (!(led_cdev->flags & LED_BLINK_ONESHOT) && |
64 | led_cdev->blink_set && | |
a403d930 BW |
65 | !led_cdev->blink_set(led_cdev, delay_on, delay_off)) |
66 | return; | |
67 | ||
68 | /* blink with 1 Hz as default if nothing specified */ | |
69 | if (!*delay_on && !*delay_off) | |
70 | *delay_on = *delay_off = 500; | |
71 | ||
72 | led_set_software_blink(led_cdev, *delay_on, *delay_off); | |
73 | } | |
5bb629c5 FB |
74 | |
75 | void led_blink_set(struct led_classdev *led_cdev, | |
76 | unsigned long *delay_on, | |
77 | unsigned long *delay_off) | |
78 | { | |
8b37e1be | 79 | cancel_delayed_work_sync(&led_cdev->blink_work); |
5bb629c5 FB |
80 | |
81 | led_cdev->flags &= ~LED_BLINK_ONESHOT; | |
82 | led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP; | |
83 | ||
84 | led_blink_setup(led_cdev, delay_on, delay_off); | |
85 | } | |
a403d930 BW |
86 | EXPORT_SYMBOL(led_blink_set); |
87 | ||
5bb629c5 FB |
88 | void led_blink_set_oneshot(struct led_classdev *led_cdev, |
89 | unsigned long *delay_on, | |
90 | unsigned long *delay_off, | |
91 | int invert) | |
92 | { | |
93 | if ((led_cdev->flags & LED_BLINK_ONESHOT) && | |
8b37e1be | 94 | delayed_work_pending(&led_cdev->blink_work)) |
5bb629c5 FB |
95 | return; |
96 | ||
97 | led_cdev->flags |= LED_BLINK_ONESHOT; | |
98 | led_cdev->flags &= ~LED_BLINK_ONESHOT_STOP; | |
99 | ||
100 | if (invert) | |
101 | led_cdev->flags |= LED_BLINK_INVERT; | |
102 | else | |
103 | led_cdev->flags &= ~LED_BLINK_INVERT; | |
104 | ||
105 | led_blink_setup(led_cdev, delay_on, delay_off); | |
106 | } | |
107 | EXPORT_SYMBOL(led_blink_set_oneshot); | |
108 | ||
d23a22a7 | 109 | void led_stop_software_blink(struct led_classdev *led_cdev) |
a403d930 | 110 | { |
8b37e1be | 111 | cancel_delayed_work_sync(&led_cdev->blink_work); |
43786482 FB |
112 | led_cdev->blink_delay_on = 0; |
113 | led_cdev->blink_delay_off = 0; | |
d23a22a7 FB |
114 | } |
115 | EXPORT_SYMBOL_GPL(led_stop_software_blink); | |
116 | ||
117 | void led_set_brightness(struct led_classdev *led_cdev, | |
118 | enum led_brightness brightness) | |
119 | { | |
8b37e1be | 120 | /* delay brightness setting if need to stop soft-blink work */ |
d23a22a7 FB |
121 | if (led_cdev->blink_delay_on || led_cdev->blink_delay_off) { |
122 | led_cdev->delayed_set_value = brightness; | |
123 | schedule_work(&led_cdev->set_brightness_work); | |
124 | return; | |
125 | } | |
43786482 | 126 | |
0da3e65b | 127 | __led_set_brightness(led_cdev, brightness); |
a403d930 | 128 | } |
19cd67e2 | 129 | EXPORT_SYMBOL(led_set_brightness); |