1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com> |
4 | <http://rt2x00.serialmonkey.com> |
5 | |
6 | */ |
7 | |
8 | /* |
9 | Module: rt2x00lib |
10 | Abstract: rt2x00 led specific routines. |
11 | */ |
12 | |
13 | #include <linux/kernel.h> |
14 | #include <linux/module.h> |
15 | |
16 | #include "rt2x00.h" |
17 | #include "rt2x00lib.h" |
18 | |
19 | void rt2x00leds_led_quality(struct rt2x00_dev *rt2x00dev, int ) |
20 | { |
21 | struct rt2x00_led *led = &rt2x00dev->led_qual; |
22 | unsigned int brightness; |
23 | |
24 | if ((led->type != LED_TYPE_QUALITY) || !(led->flags & LED_REGISTERED)) |
25 | return; |
26 | |
27 | /* |
28 | * Led handling requires a positive value for the rssi, |
29 | * to do that correctly we need to add the correction. |
30 | */ |
31 | rssi += rt2x00dev->rssi_offset; |
32 | |
33 | /* |
34 | * Get the rssi level, this is used to convert the rssi |
35 | * to a LED value inside the range LED_OFF - LED_FULL. |
36 | */ |
37 | if (rssi <= 30) |
38 | rssi = 0; |
39 | else if (rssi <= 39) |
40 | rssi = 1; |
41 | else if (rssi <= 49) |
42 | rssi = 2; |
43 | else if (rssi <= 53) |
44 | rssi = 3; |
45 | else if (rssi <= 63) |
46 | rssi = 4; |
47 | else |
48 | rssi = 5; |
49 | |
50 | /* |
51 | * Note that we must _not_ send LED_OFF since the driver |
52 | * is going to calculate the value and might use it in a |
53 | * division. |
54 | */ |
55 | brightness = ((LED_FULL / 6) * rssi) + 1; |
56 | if (brightness != led->led_dev.brightness) { |
57 | led->led_dev.brightness_set(&led->led_dev, brightness); |
58 | led->led_dev.brightness = brightness; |
59 | } |
60 | } |
61 | |
62 | static void rt2x00led_led_simple(struct rt2x00_led *led, bool enabled) |
63 | { |
64 | unsigned int brightness = enabled ? LED_FULL : LED_OFF; |
65 | |
66 | if (!(led->flags & LED_REGISTERED)) |
67 | return; |
68 | |
69 | led->led_dev.brightness_set(&led->led_dev, brightness); |
70 | led->led_dev.brightness = brightness; |
71 | } |
72 | |
73 | void rt2x00led_led_activity(struct rt2x00_dev *rt2x00dev, bool enabled) |
74 | { |
75 | if (rt2x00dev->led_qual.type == LED_TYPE_ACTIVITY) |
76 | rt2x00led_led_simple(led: &rt2x00dev->led_qual, enabled); |
77 | } |
78 | |
79 | void rt2x00leds_led_assoc(struct rt2x00_dev *rt2x00dev, bool enabled) |
80 | { |
81 | if (rt2x00dev->led_assoc.type == LED_TYPE_ASSOC) |
82 | rt2x00led_led_simple(led: &rt2x00dev->led_assoc, enabled); |
83 | } |
84 | |
85 | void rt2x00leds_led_radio(struct rt2x00_dev *rt2x00dev, bool enabled) |
86 | { |
87 | if (rt2x00dev->led_radio.type == LED_TYPE_RADIO) |
88 | rt2x00led_led_simple(led: &rt2x00dev->led_radio, enabled); |
89 | } |
90 | |
91 | static int rt2x00leds_register_led(struct rt2x00_dev *rt2x00dev, |
92 | struct rt2x00_led *led, |
93 | const char *name) |
94 | { |
95 | struct device *device = wiphy_dev(wiphy: rt2x00dev->hw->wiphy); |
96 | int retval; |
97 | |
98 | led->led_dev.name = name; |
99 | led->led_dev.brightness = LED_OFF; |
100 | |
101 | retval = led_classdev_register(parent: device, led_cdev: &led->led_dev); |
102 | if (retval) { |
103 | rt2x00_err(rt2x00dev, "Failed to register led handler\n" ); |
104 | return retval; |
105 | } |
106 | |
107 | led->flags |= LED_REGISTERED; |
108 | |
109 | return 0; |
110 | } |
111 | |
112 | void rt2x00leds_register(struct rt2x00_dev *rt2x00dev) |
113 | { |
114 | char name[36]; |
115 | int retval; |
116 | unsigned long on_period; |
117 | unsigned long off_period; |
118 | const char *phy_name = wiphy_name(wiphy: rt2x00dev->hw->wiphy); |
119 | |
120 | if (rt2x00dev->led_radio.flags & LED_INITIALIZED) { |
121 | snprintf(buf: name, size: sizeof(name), fmt: "%s-%s::radio" , |
122 | rt2x00dev->ops->name, phy_name); |
123 | |
124 | retval = rt2x00leds_register_led(rt2x00dev, |
125 | led: &rt2x00dev->led_radio, |
126 | name); |
127 | if (retval) |
128 | goto exit_fail; |
129 | } |
130 | |
131 | if (rt2x00dev->led_assoc.flags & LED_INITIALIZED) { |
132 | snprintf(buf: name, size: sizeof(name), fmt: "%s-%s::assoc" , |
133 | rt2x00dev->ops->name, phy_name); |
134 | |
135 | retval = rt2x00leds_register_led(rt2x00dev, |
136 | led: &rt2x00dev->led_assoc, |
137 | name); |
138 | if (retval) |
139 | goto exit_fail; |
140 | } |
141 | |
142 | if (rt2x00dev->led_qual.flags & LED_INITIALIZED) { |
143 | snprintf(buf: name, size: sizeof(name), fmt: "%s-%s::quality" , |
144 | rt2x00dev->ops->name, phy_name); |
145 | |
146 | retval = rt2x00leds_register_led(rt2x00dev, |
147 | led: &rt2x00dev->led_qual, |
148 | name); |
149 | if (retval) |
150 | goto exit_fail; |
151 | } |
152 | |
153 | /* |
154 | * Initialize blink time to default value: |
155 | * On period: 70ms |
156 | * Off period: 30ms |
157 | */ |
158 | if (rt2x00dev->led_radio.led_dev.blink_set) { |
159 | on_period = 70; |
160 | off_period = 30; |
161 | rt2x00dev->led_radio.led_dev.blink_set( |
162 | &rt2x00dev->led_radio.led_dev, &on_period, &off_period); |
163 | } |
164 | |
165 | return; |
166 | |
167 | exit_fail: |
168 | rt2x00leds_unregister(rt2x00dev); |
169 | } |
170 | |
171 | static void rt2x00leds_unregister_led(struct rt2x00_led *led) |
172 | { |
173 | led_classdev_unregister(led_cdev: &led->led_dev); |
174 | |
175 | /* |
176 | * This might look weird, but when we are unregistering while |
177 | * suspended the led is already off, and since we haven't |
178 | * fully resumed yet, access to the device might not be |
179 | * possible yet. |
180 | */ |
181 | if (!(led->led_dev.flags & LED_SUSPENDED)) |
182 | led->led_dev.brightness_set(&led->led_dev, LED_OFF); |
183 | |
184 | led->flags &= ~LED_REGISTERED; |
185 | } |
186 | |
187 | void rt2x00leds_unregister(struct rt2x00_dev *rt2x00dev) |
188 | { |
189 | if (rt2x00dev->led_qual.flags & LED_REGISTERED) |
190 | rt2x00leds_unregister_led(led: &rt2x00dev->led_qual); |
191 | if (rt2x00dev->led_assoc.flags & LED_REGISTERED) |
192 | rt2x00leds_unregister_led(led: &rt2x00dev->led_assoc); |
193 | if (rt2x00dev->led_radio.flags & LED_REGISTERED) |
194 | rt2x00leds_unregister_led(led: &rt2x00dev->led_radio); |
195 | } |
196 | |
197 | static inline void rt2x00leds_suspend_led(struct rt2x00_led *led) |
198 | { |
199 | led_classdev_suspend(led_cdev: &led->led_dev); |
200 | |
201 | /* This shouldn't be needed, but just to be safe */ |
202 | led->led_dev.brightness_set(&led->led_dev, LED_OFF); |
203 | led->led_dev.brightness = LED_OFF; |
204 | } |
205 | |
206 | void rt2x00leds_suspend(struct rt2x00_dev *rt2x00dev) |
207 | { |
208 | if (rt2x00dev->led_qual.flags & LED_REGISTERED) |
209 | rt2x00leds_suspend_led(led: &rt2x00dev->led_qual); |
210 | if (rt2x00dev->led_assoc.flags & LED_REGISTERED) |
211 | rt2x00leds_suspend_led(led: &rt2x00dev->led_assoc); |
212 | if (rt2x00dev->led_radio.flags & LED_REGISTERED) |
213 | rt2x00leds_suspend_led(led: &rt2x00dev->led_radio); |
214 | } |
215 | |
216 | static inline void rt2x00leds_resume_led(struct rt2x00_led *led) |
217 | { |
218 | led_classdev_resume(led_cdev: &led->led_dev); |
219 | |
220 | /* Device might have enabled the LEDS during resume */ |
221 | led->led_dev.brightness_set(&led->led_dev, LED_OFF); |
222 | led->led_dev.brightness = LED_OFF; |
223 | } |
224 | |
225 | void rt2x00leds_resume(struct rt2x00_dev *rt2x00dev) |
226 | { |
227 | if (rt2x00dev->led_radio.flags & LED_REGISTERED) |
228 | rt2x00leds_resume_led(led: &rt2x00dev->led_radio); |
229 | if (rt2x00dev->led_assoc.flags & LED_REGISTERED) |
230 | rt2x00leds_resume_led(led: &rt2x00dev->led_assoc); |
231 | if (rt2x00dev->led_qual.flags & LED_REGISTERED) |
232 | rt2x00leds_resume_led(led: &rt2x00dev->led_qual); |
233 | } |
234 | |