Branch data Line data Source code
1 : : // SPDX-License-Identifier: GPL-2.0-only
2 : : /*
3 : : * Copyright 2006, Johannes Berg <johannes@sipsolutions.net>
4 : : */
5 : :
6 : : /* just for IFNAMSIZ */
7 : : #include <linux/if.h>
8 : : #include <linux/slab.h>
9 : : #include <linux/export.h>
10 : : #include "led.h"
11 : :
12 : 0 : void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
13 : : {
14 [ # # ]: 0 : if (!atomic_read(&local->assoc_led_active))
15 : : return;
16 [ # # ]: 0 : if (associated)
17 : 0 : led_trigger_event(&local->assoc_led, LED_FULL);
18 : : else
19 : 0 : led_trigger_event(&local->assoc_led, LED_OFF);
20 : : }
21 : :
22 : 6 : void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
23 : : {
24 [ + - ]: 6 : if (!atomic_read(&local->radio_led_active))
25 : : return;
26 [ + - ]: 6 : if (enabled)
27 : 6 : led_trigger_event(&local->radio_led, LED_FULL);
28 : : else
29 : 0 : led_trigger_event(&local->radio_led, LED_OFF);
30 : : }
31 : :
32 : 30 : void ieee80211_alloc_led_names(struct ieee80211_local *local)
33 : : {
34 : 30 : local->rx_led.name = kasprintf(GFP_KERNEL, "%srx",
35 [ + - ]: 30 : wiphy_name(local->hw.wiphy));
36 : 30 : local->tx_led.name = kasprintf(GFP_KERNEL, "%stx",
37 [ + - ]: 30 : wiphy_name(local->hw.wiphy));
38 : 30 : local->assoc_led.name = kasprintf(GFP_KERNEL, "%sassoc",
39 [ + - ]: 30 : wiphy_name(local->hw.wiphy));
40 : 30 : local->radio_led.name = kasprintf(GFP_KERNEL, "%sradio",
41 [ + - ]: 30 : wiphy_name(local->hw.wiphy));
42 : 30 : }
43 : :
44 : 24 : void ieee80211_free_led_names(struct ieee80211_local *local)
45 : : {
46 : 24 : kfree(local->rx_led.name);
47 : 24 : kfree(local->tx_led.name);
48 : 24 : kfree(local->assoc_led.name);
49 : 24 : kfree(local->radio_led.name);
50 : 24 : }
51 : :
52 : 0 : static int ieee80211_tx_led_activate(struct led_classdev *led_cdev)
53 : : {
54 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
55 : : struct ieee80211_local,
56 : : tx_led);
57 : :
58 : 0 : atomic_inc(&local->tx_led_active);
59 : :
60 : 0 : return 0;
61 : : }
62 : :
63 : 0 : static void ieee80211_tx_led_deactivate(struct led_classdev *led_cdev)
64 : : {
65 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
66 : : struct ieee80211_local,
67 : : tx_led);
68 : :
69 : 0 : atomic_dec(&local->tx_led_active);
70 : 0 : }
71 : :
72 : 0 : static int ieee80211_rx_led_activate(struct led_classdev *led_cdev)
73 : : {
74 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
75 : : struct ieee80211_local,
76 : : rx_led);
77 : :
78 : 0 : atomic_inc(&local->rx_led_active);
79 : :
80 : 0 : return 0;
81 : : }
82 : :
83 : 0 : static void ieee80211_rx_led_deactivate(struct led_classdev *led_cdev)
84 : : {
85 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
86 : : struct ieee80211_local,
87 : : rx_led);
88 : :
89 : 0 : atomic_dec(&local->rx_led_active);
90 : 0 : }
91 : :
92 : 0 : static int ieee80211_assoc_led_activate(struct led_classdev *led_cdev)
93 : : {
94 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
95 : : struct ieee80211_local,
96 : : assoc_led);
97 : :
98 : 0 : atomic_inc(&local->assoc_led_active);
99 : :
100 : 0 : return 0;
101 : : }
102 : :
103 : 0 : static void ieee80211_assoc_led_deactivate(struct led_classdev *led_cdev)
104 : : {
105 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
106 : : struct ieee80211_local,
107 : : assoc_led);
108 : :
109 : 0 : atomic_dec(&local->assoc_led_active);
110 : 0 : }
111 : :
112 : 6 : static int ieee80211_radio_led_activate(struct led_classdev *led_cdev)
113 : : {
114 : 6 : struct ieee80211_local *local = container_of(led_cdev->trigger,
115 : : struct ieee80211_local,
116 : : radio_led);
117 : :
118 : 6 : atomic_inc(&local->radio_led_active);
119 : :
120 : 6 : return 0;
121 : : }
122 : :
123 : 0 : static void ieee80211_radio_led_deactivate(struct led_classdev *led_cdev)
124 : : {
125 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
126 : : struct ieee80211_local,
127 : : radio_led);
128 : :
129 : 0 : atomic_dec(&local->radio_led_active);
130 : 0 : }
131 : :
132 : 0 : static int ieee80211_tpt_led_activate(struct led_classdev *led_cdev)
133 : : {
134 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
135 : : struct ieee80211_local,
136 : : tpt_led);
137 : :
138 : 0 : atomic_inc(&local->tpt_led_active);
139 : :
140 : 0 : return 0;
141 : : }
142 : :
143 : 0 : static void ieee80211_tpt_led_deactivate(struct led_classdev *led_cdev)
144 : : {
145 : 0 : struct ieee80211_local *local = container_of(led_cdev->trigger,
146 : : struct ieee80211_local,
147 : : tpt_led);
148 : :
149 : 0 : atomic_dec(&local->tpt_led_active);
150 : 0 : }
151 : :
152 : 6 : void ieee80211_led_init(struct ieee80211_local *local)
153 : : {
154 : 6 : atomic_set(&local->rx_led_active, 0);
155 : 6 : local->rx_led.activate = ieee80211_rx_led_activate;
156 : 6 : local->rx_led.deactivate = ieee80211_rx_led_deactivate;
157 [ + - - + ]: 6 : if (local->rx_led.name && led_trigger_register(&local->rx_led)) {
158 : 0 : kfree(local->rx_led.name);
159 : 0 : local->rx_led.name = NULL;
160 : : }
161 : :
162 : 6 : atomic_set(&local->tx_led_active, 0);
163 : 6 : local->tx_led.activate = ieee80211_tx_led_activate;
164 : 6 : local->tx_led.deactivate = ieee80211_tx_led_deactivate;
165 [ + - - + ]: 6 : if (local->tx_led.name && led_trigger_register(&local->tx_led)) {
166 : 0 : kfree(local->tx_led.name);
167 : 0 : local->tx_led.name = NULL;
168 : : }
169 : :
170 : 6 : atomic_set(&local->assoc_led_active, 0);
171 : 6 : local->assoc_led.activate = ieee80211_assoc_led_activate;
172 : 6 : local->assoc_led.deactivate = ieee80211_assoc_led_deactivate;
173 [ + - - + ]: 6 : if (local->assoc_led.name && led_trigger_register(&local->assoc_led)) {
174 : 0 : kfree(local->assoc_led.name);
175 : 0 : local->assoc_led.name = NULL;
176 : : }
177 : :
178 : 6 : atomic_set(&local->radio_led_active, 0);
179 : 6 : local->radio_led.activate = ieee80211_radio_led_activate;
180 : 6 : local->radio_led.deactivate = ieee80211_radio_led_deactivate;
181 [ + - - + ]: 6 : if (local->radio_led.name && led_trigger_register(&local->radio_led)) {
182 : 0 : kfree(local->radio_led.name);
183 : 0 : local->radio_led.name = NULL;
184 : : }
185 : :
186 : 6 : atomic_set(&local->tpt_led_active, 0);
187 [ + - ]: 6 : if (local->tpt_led_trigger) {
188 : 6 : local->tpt_led.activate = ieee80211_tpt_led_activate;
189 : 6 : local->tpt_led.deactivate = ieee80211_tpt_led_deactivate;
190 [ - + ]: 6 : if (led_trigger_register(&local->tpt_led)) {
191 : 0 : kfree(local->tpt_led_trigger);
192 : 0 : local->tpt_led_trigger = NULL;
193 : : }
194 : : }
195 : 6 : }
196 : :
197 : 0 : void ieee80211_led_exit(struct ieee80211_local *local)
198 : : {
199 [ # # ]: 0 : if (local->radio_led.name)
200 : 0 : led_trigger_unregister(&local->radio_led);
201 [ # # ]: 0 : if (local->assoc_led.name)
202 : 0 : led_trigger_unregister(&local->assoc_led);
203 [ # # ]: 0 : if (local->tx_led.name)
204 : 0 : led_trigger_unregister(&local->tx_led);
205 [ # # ]: 0 : if (local->rx_led.name)
206 : 0 : led_trigger_unregister(&local->rx_led);
207 : :
208 [ # # ]: 0 : if (local->tpt_led_trigger) {
209 : 0 : led_trigger_unregister(&local->tpt_led);
210 : 0 : kfree(local->tpt_led_trigger);
211 : : }
212 : 0 : }
213 : :
214 : 6 : const char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw)
215 : : {
216 : 6 : struct ieee80211_local *local = hw_to_local(hw);
217 : :
218 : 6 : return local->radio_led.name;
219 : : }
220 : : EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
221 : :
222 : 0 : const char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw)
223 : : {
224 : 0 : struct ieee80211_local *local = hw_to_local(hw);
225 : :
226 : 0 : return local->assoc_led.name;
227 : : }
228 : : EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
229 : :
230 : 0 : const char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw)
231 : : {
232 : 0 : struct ieee80211_local *local = hw_to_local(hw);
233 : :
234 : 0 : return local->tx_led.name;
235 : : }
236 : : EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
237 : :
238 : 0 : const char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw)
239 : : {
240 : 0 : struct ieee80211_local *local = hw_to_local(hw);
241 : :
242 : 0 : return local->rx_led.name;
243 : : }
244 : : EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
245 : :
246 : 27 : static unsigned long tpt_trig_traffic(struct ieee80211_local *local,
247 : : struct tpt_led_trigger *tpt_trig)
248 : : {
249 : 27 : unsigned long traffic, delta;
250 : :
251 : 27 : traffic = tpt_trig->tx_bytes + tpt_trig->rx_bytes;
252 : :
253 : 27 : delta = traffic - tpt_trig->prev_traffic;
254 : 27 : tpt_trig->prev_traffic = traffic;
255 : 27 : return DIV_ROUND_UP(delta, 1024 / 8);
256 : : }
257 : :
258 : 27 : static void tpt_trig_timer(struct timer_list *t)
259 : : {
260 : 27 : struct tpt_led_trigger *tpt_trig = from_timer(tpt_trig, t, timer);
261 : 27 : struct ieee80211_local *local = tpt_trig->local;
262 : 27 : struct led_classdev *led_cdev;
263 : 27 : unsigned long on, off, tpt;
264 : 27 : int i;
265 : :
266 [ - + ]: 27 : if (!tpt_trig->running)
267 : 0 : return;
268 : :
269 : 27 : mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
270 : :
271 : 27 : tpt = tpt_trig_traffic(local, tpt_trig);
272 : :
273 : : /* default to just solid on */
274 : 27 : on = 1;
275 : 27 : off = 0;
276 : :
277 [ + + ]: 297 : for (i = tpt_trig->blink_table_len - 1; i >= 0; i--) {
278 [ + - ]: 270 : if (tpt_trig->blink_table[i].throughput < 0 ||
279 [ - + ]: 270 : tpt > tpt_trig->blink_table[i].throughput) {
280 : 0 : off = tpt_trig->blink_table[i].blink_time / 2;
281 : 0 : on = tpt_trig->blink_table[i].blink_time - off;
282 : 0 : break;
283 : : }
284 : : }
285 : :
286 : 27 : read_lock(&local->tpt_led.leddev_list_lock);
287 [ - + ]: 27 : list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
288 : 0 : led_blink_set(led_cdev, &on, &off);
289 : 27 : read_unlock(&local->tpt_led.leddev_list_lock);
290 : : }
291 : :
292 : : const char *
293 : 6 : __ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
294 : : unsigned int flags,
295 : : const struct ieee80211_tpt_blink *blink_table,
296 : : unsigned int blink_table_len)
297 : : {
298 [ - + ]: 6 : struct ieee80211_local *local = hw_to_local(hw);
299 : 6 : struct tpt_led_trigger *tpt_trig;
300 : :
301 [ - + + - ]: 6 : if (WARN_ON(local->tpt_led_trigger))
302 : : return NULL;
303 : :
304 : 6 : tpt_trig = kzalloc(sizeof(struct tpt_led_trigger), GFP_KERNEL);
305 [ + - ]: 6 : if (!tpt_trig)
306 : : return NULL;
307 : :
308 : 12 : snprintf(tpt_trig->name, sizeof(tpt_trig->name),
309 [ + - ]: 6 : "%stpt", wiphy_name(local->hw.wiphy));
310 : :
311 : 6 : local->tpt_led.name = tpt_trig->name;
312 : :
313 : 6 : tpt_trig->blink_table = blink_table;
314 : 6 : tpt_trig->blink_table_len = blink_table_len;
315 : 6 : tpt_trig->want = flags;
316 : 6 : tpt_trig->local = local;
317 : :
318 : 6 : timer_setup(&tpt_trig->timer, tpt_trig_timer, 0);
319 : :
320 : 6 : local->tpt_led_trigger = tpt_trig;
321 : :
322 : 6 : return tpt_trig->name;
323 : : }
324 : : EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
325 : :
326 : : static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
327 : : {
328 : : struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
329 : :
330 : : if (tpt_trig->running)
331 : : return;
332 : :
333 : : /* reset traffic */
334 : : tpt_trig_traffic(local, tpt_trig);
335 : : tpt_trig->running = true;
336 : :
337 : : tpt_trig_timer(&tpt_trig->timer);
338 : : mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
339 : : }
340 : :
341 : 0 : static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
342 : : {
343 : 0 : struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
344 : 0 : struct led_classdev *led_cdev;
345 : :
346 [ # # ]: 0 : if (!tpt_trig->running)
347 : : return;
348 : :
349 : 0 : tpt_trig->running = false;
350 : 0 : del_timer_sync(&tpt_trig->timer);
351 : :
352 : 0 : read_lock(&local->tpt_led.leddev_list_lock);
353 [ # # ]: 0 : list_for_each_entry(led_cdev, &local->tpt_led.led_cdevs, trig_list)
354 : 0 : led_set_brightness(led_cdev, LED_OFF);
355 : 0 : read_unlock(&local->tpt_led.leddev_list_lock);
356 : : }
357 : :
358 : 6 : void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
359 : : unsigned int types_on, unsigned int types_off)
360 : : {
361 : 6 : struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
362 : 6 : bool allowed;
363 : :
364 [ - + ]: 6 : WARN_ON(types_on & types_off);
365 : :
366 [ + - ]: 6 : if (!tpt_trig)
367 : : return;
368 : :
369 : 6 : tpt_trig->active &= ~types_off;
370 : 6 : tpt_trig->active |= types_on;
371 : :
372 : : /*
373 : : * Regardless of wanted state, we shouldn't blink when
374 : : * the radio is disabled -- this can happen due to some
375 : : * code ordering issues with __ieee80211_recalc_idle()
376 : : * being called before the radio is started.
377 : : */
378 : 6 : allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;
379 : :
380 [ + - - + ]: 6 : if (!allowed || !(tpt_trig->active & tpt_trig->want))
381 : 0 : ieee80211_stop_tpt_led_trig(local);
382 : : else
383 : 6 : ieee80211_start_tpt_led_trig(local);
384 : : }
|