blob: 14590332c81ccca331bb6160916457df872c37a6 [file] [log] [blame]
Jiri Bencf0706e82007-05-05 11:45:53 -07001/*
2 * Copyright 2006, Johannes Berg <johannes@sipsolutions.net>
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 */
8
9/* just for IFNAMSIZ */
10#include <linux/if.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090011#include <linux/slab.h>
Johannes Berg2c8dccc2008-04-08 15:14:40 -040012#include "led.h"
Jiri Bencf0706e82007-05-05 11:45:53 -070013
14void ieee80211_led_rx(struct ieee80211_local *local)
15{
16 if (unlikely(!local->rx_led))
17 return;
18 if (local->rx_led_counter++ % 2 == 0)
19 led_trigger_event(local->rx_led, LED_OFF);
20 else
21 led_trigger_event(local->rx_led, LED_FULL);
22}
23
24/* q is 1 if a packet was enqueued, 0 if it has been transmitted */
25void ieee80211_led_tx(struct ieee80211_local *local, int q)
26{
27 if (unlikely(!local->tx_led))
28 return;
29 /* not sure how this is supposed to work ... */
30 local->tx_led_counter += 2*q-1;
31 if (local->tx_led_counter % 2 == 0)
32 led_trigger_event(local->tx_led, LED_OFF);
33 else
34 led_trigger_event(local->tx_led, LED_FULL);
35}
36
Michael Buesch47f0c502007-09-27 15:10:44 +020037void ieee80211_led_assoc(struct ieee80211_local *local, bool associated)
38{
39 if (unlikely(!local->assoc_led))
40 return;
41 if (associated)
42 led_trigger_event(local->assoc_led, LED_FULL);
43 else
44 led_trigger_event(local->assoc_led, LED_OFF);
45}
46
Ivo van Doorncdcb0062008-01-07 19:45:24 +010047void ieee80211_led_radio(struct ieee80211_local *local, bool enabled)
48{
49 if (unlikely(!local->radio_led))
50 return;
51 if (enabled)
52 led_trigger_event(local->radio_led, LED_FULL);
53 else
54 led_trigger_event(local->radio_led, LED_OFF);
55}
56
Johannes Bergfe67c912010-11-27 20:02:59 +010057void ieee80211_led_names(struct ieee80211_local *local)
58{
59 snprintf(local->rx_led_name, sizeof(local->rx_led_name),
60 "%srx", wiphy_name(local->hw.wiphy));
61 snprintf(local->tx_led_name, sizeof(local->tx_led_name),
62 "%stx", wiphy_name(local->hw.wiphy));
63 snprintf(local->assoc_led_name, sizeof(local->assoc_led_name),
64 "%sassoc", wiphy_name(local->hw.wiphy));
65 snprintf(local->radio_led_name, sizeof(local->radio_led_name),
66 "%sradio", wiphy_name(local->hw.wiphy));
67}
68
Jiri Bencf0706e82007-05-05 11:45:53 -070069void ieee80211_led_init(struct ieee80211_local *local)
70{
71 local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
Michael Buesch47f0c502007-09-27 15:10:44 +020072 if (local->rx_led) {
Michael Buesch47f0c502007-09-27 15:10:44 +020073 local->rx_led->name = local->rx_led_name;
74 if (led_trigger_register(local->rx_led)) {
75 kfree(local->rx_led);
76 local->rx_led = NULL;
77 }
Jiri Bencf0706e82007-05-05 11:45:53 -070078 }
79
80 local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
Michael Buesch47f0c502007-09-27 15:10:44 +020081 if (local->tx_led) {
Michael Buesch47f0c502007-09-27 15:10:44 +020082 local->tx_led->name = local->tx_led_name;
83 if (led_trigger_register(local->tx_led)) {
84 kfree(local->tx_led);
85 local->tx_led = NULL;
86 }
87 }
88
89 local->assoc_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
90 if (local->assoc_led) {
Michael Buesch47f0c502007-09-27 15:10:44 +020091 local->assoc_led->name = local->assoc_led_name;
92 if (led_trigger_register(local->assoc_led)) {
93 kfree(local->assoc_led);
94 local->assoc_led = NULL;
95 }
Jiri Bencf0706e82007-05-05 11:45:53 -070096 }
Ivo van Doorncdcb0062008-01-07 19:45:24 +010097
98 local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
99 if (local->radio_led) {
Ivo van Doorncdcb0062008-01-07 19:45:24 +0100100 local->radio_led->name = local->radio_led_name;
101 if (led_trigger_register(local->radio_led)) {
102 kfree(local->radio_led);
103 local->radio_led = NULL;
104 }
105 }
Johannes Berge1e54062010-11-30 08:58:45 +0100106
107 if (local->tpt_led_trigger) {
108 if (led_trigger_register(&local->tpt_led_trigger->trig)) {
109 kfree(local->tpt_led_trigger);
110 local->tpt_led_trigger = NULL;
111 }
112 }
Jiri Bencf0706e82007-05-05 11:45:53 -0700113}
114
115void ieee80211_led_exit(struct ieee80211_local *local)
116{
Ivo van Doorncdcb0062008-01-07 19:45:24 +0100117 if (local->radio_led) {
118 led_trigger_unregister(local->radio_led);
119 kfree(local->radio_led);
120 }
Michael Buesch47f0c502007-09-27 15:10:44 +0200121 if (local->assoc_led) {
122 led_trigger_unregister(local->assoc_led);
123 kfree(local->assoc_led);
124 }
Jiri Bencf0706e82007-05-05 11:45:53 -0700125 if (local->tx_led) {
126 led_trigger_unregister(local->tx_led);
127 kfree(local->tx_led);
128 }
129 if (local->rx_led) {
130 led_trigger_unregister(local->rx_led);
131 kfree(local->rx_led);
132 }
Johannes Berge1e54062010-11-30 08:58:45 +0100133
134 if (local->tpt_led_trigger) {
135 led_trigger_unregister(&local->tpt_led_trigger->trig);
136 kfree(local->tpt_led_trigger);
137 }
Jiri Bencf0706e82007-05-05 11:45:53 -0700138}
139
Ivo van Doorncdcb0062008-01-07 19:45:24 +0100140char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw)
141{
142 struct ieee80211_local *local = hw_to_local(hw);
143
Johannes Bergfe67c912010-11-27 20:02:59 +0100144 return local->radio_led_name;
Ivo van Doorncdcb0062008-01-07 19:45:24 +0100145}
146EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
147
Michael Buesch47f0c502007-09-27 15:10:44 +0200148char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw)
149{
150 struct ieee80211_local *local = hw_to_local(hw);
151
Johannes Bergfe67c912010-11-27 20:02:59 +0100152 return local->assoc_led_name;
Michael Buesch47f0c502007-09-27 15:10:44 +0200153}
154EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
155
Jiri Bencf0706e82007-05-05 11:45:53 -0700156char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw)
157{
158 struct ieee80211_local *local = hw_to_local(hw);
159
Johannes Bergfe67c912010-11-27 20:02:59 +0100160 return local->tx_led_name;
Jiri Bencf0706e82007-05-05 11:45:53 -0700161}
162EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
163
164char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw)
165{
166 struct ieee80211_local *local = hw_to_local(hw);
167
Johannes Bergfe67c912010-11-27 20:02:59 +0100168 return local->rx_led_name;
Jiri Bencf0706e82007-05-05 11:45:53 -0700169}
170EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
Johannes Berge1e54062010-11-30 08:58:45 +0100171
172static unsigned long tpt_trig_traffic(struct ieee80211_local *local,
173 struct tpt_led_trigger *tpt_trig)
174{
175 unsigned long traffic, delta;
176
177 traffic = tpt_trig->tx_bytes + tpt_trig->rx_bytes;
178
179 delta = traffic - tpt_trig->prev_traffic;
180 tpt_trig->prev_traffic = traffic;
181 return DIV_ROUND_UP(delta, 1024 / 8);
182}
183
184static void tpt_trig_timer(unsigned long data)
185{
186 struct ieee80211_local *local = (void *)data;
187 struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
188 struct led_classdev *led_cdev;
189 unsigned long on, off, tpt;
190 int i;
191
192 if (!tpt_trig->running)
193 return;
194
195 mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
196
197 tpt = tpt_trig_traffic(local, tpt_trig);
198
199 /* default to just solid on */
200 on = 1;
201 off = 0;
202
203 for (i = tpt_trig->blink_table_len - 1; i >= 0; i--) {
204 if (tpt_trig->blink_table[i].throughput < 0 ||
205 tpt > tpt_trig->blink_table[i].throughput) {
206 off = tpt_trig->blink_table[i].blink_time / 2;
207 on = tpt_trig->blink_table[i].blink_time - off;
208 break;
209 }
210 }
211
212 read_lock(&tpt_trig->trig.leddev_list_lock);
213 list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
214 led_blink_set(led_cdev, &on, &off);
215 read_unlock(&tpt_trig->trig.leddev_list_lock);
216}
217
Johannes Berg06778b12010-12-22 10:15:52 +0100218char *__ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
219 unsigned int flags,
Johannes Berge1e54062010-11-30 08:58:45 +0100220 const struct ieee80211_tpt_blink *blink_table,
221 unsigned int blink_table_len)
222{
223 struct ieee80211_local *local = hw_to_local(hw);
224 struct tpt_led_trigger *tpt_trig;
225
226 if (WARN_ON(local->tpt_led_trigger))
227 return NULL;
228
229 tpt_trig = kzalloc(sizeof(struct tpt_led_trigger), GFP_KERNEL);
230 if (!tpt_trig)
231 return NULL;
232
233 snprintf(tpt_trig->name, sizeof(tpt_trig->name),
234 "%stpt", wiphy_name(local->hw.wiphy));
235
236 tpt_trig->trig.name = tpt_trig->name;
237
238 tpt_trig->blink_table = blink_table;
239 tpt_trig->blink_table_len = blink_table_len;
Johannes Berg67408c82010-11-30 08:59:23 +0100240 tpt_trig->want = flags;
Johannes Berge1e54062010-11-30 08:58:45 +0100241
242 setup_timer(&tpt_trig->timer, tpt_trig_timer, (unsigned long)local);
243
244 local->tpt_led_trigger = tpt_trig;
245
246 return tpt_trig->name;
247}
248EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
249
Johannes Berg67408c82010-11-30 08:59:23 +0100250static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
Johannes Berge1e54062010-11-30 08:58:45 +0100251{
252 struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
253
Johannes Berg67408c82010-11-30 08:59:23 +0100254 if (tpt_trig->running)
Johannes Berge1e54062010-11-30 08:58:45 +0100255 return;
256
257 /* reset traffic */
258 tpt_trig_traffic(local, tpt_trig);
259 tpt_trig->running = true;
260
261 tpt_trig_timer((unsigned long)local);
262 mod_timer(&tpt_trig->timer, round_jiffies(jiffies + HZ));
263}
264
Johannes Berg67408c82010-11-30 08:59:23 +0100265static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
Johannes Berge1e54062010-11-30 08:58:45 +0100266{
267 struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
268 struct led_classdev *led_cdev;
269
Johannes Berg67408c82010-11-30 08:59:23 +0100270 if (!tpt_trig->running)
Johannes Berge1e54062010-11-30 08:58:45 +0100271 return;
272
273 tpt_trig->running = false;
274 del_timer_sync(&tpt_trig->timer);
275
276 read_lock(&tpt_trig->trig.leddev_list_lock);
277 list_for_each_entry(led_cdev, &tpt_trig->trig.led_cdevs, trig_list)
278 led_brightness_set(led_cdev, LED_OFF);
279 read_unlock(&tpt_trig->trig.leddev_list_lock);
280}
Johannes Berg67408c82010-11-30 08:59:23 +0100281
282void ieee80211_mod_tpt_led_trig(struct ieee80211_local *local,
283 unsigned int types_on, unsigned int types_off)
284{
285 struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
286 bool allowed;
287
288 WARN_ON(types_on & types_off);
289
290 if (!tpt_trig)
291 return;
292
293 tpt_trig->active &= ~types_off;
294 tpt_trig->active |= types_on;
295
296 /*
297 * Regardless of wanted state, we shouldn't blink when
298 * the radio is disabled -- this can happen due to some
299 * code ordering issues with __ieee80211_recalc_idle()
300 * being called before the radio is started.
301 */
302 allowed = tpt_trig->active & IEEE80211_TPT_LEDTRIG_FL_RADIO;
303
304 if (!allowed || !(tpt_trig->active & tpt_trig->want))
305 ieee80211_stop_tpt_led_trig(local);
306 else
307 ieee80211_start_tpt_led_trig(local);
308}