Merge branch 'fix/asoc' into for-linus
[linux-2.6-microblaze.git] / net / mac80211 / led.c
1 /*
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>
11 #include <linux/slab.h>
12 #include "led.h"
13
14 void 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 */
25 void 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
37 void 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
47 void 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
57 void 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
69 void ieee80211_led_init(struct ieee80211_local *local)
70 {
71         local->rx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
72         if (local->rx_led) {
73                 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                 }
78         }
79
80         local->tx_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
81         if (local->tx_led) {
82                 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) {
91                 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                 }
96         }
97
98         local->radio_led = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
99         if (local->radio_led) {
100                 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         }
106
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         }
113 }
114
115 void ieee80211_led_exit(struct ieee80211_local *local)
116 {
117         if (local->radio_led) {
118                 led_trigger_unregister(local->radio_led);
119                 kfree(local->radio_led);
120         }
121         if (local->assoc_led) {
122                 led_trigger_unregister(local->assoc_led);
123                 kfree(local->assoc_led);
124         }
125         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         }
133
134         if (local->tpt_led_trigger) {
135                 led_trigger_unregister(&local->tpt_led_trigger->trig);
136                 kfree(local->tpt_led_trigger);
137         }
138 }
139
140 char *__ieee80211_get_radio_led_name(struct ieee80211_hw *hw)
141 {
142         struct ieee80211_local *local = hw_to_local(hw);
143
144         return local->radio_led_name;
145 }
146 EXPORT_SYMBOL(__ieee80211_get_radio_led_name);
147
148 char *__ieee80211_get_assoc_led_name(struct ieee80211_hw *hw)
149 {
150         struct ieee80211_local *local = hw_to_local(hw);
151
152         return local->assoc_led_name;
153 }
154 EXPORT_SYMBOL(__ieee80211_get_assoc_led_name);
155
156 char *__ieee80211_get_tx_led_name(struct ieee80211_hw *hw)
157 {
158         struct ieee80211_local *local = hw_to_local(hw);
159
160         return local->tx_led_name;
161 }
162 EXPORT_SYMBOL(__ieee80211_get_tx_led_name);
163
164 char *__ieee80211_get_rx_led_name(struct ieee80211_hw *hw)
165 {
166         struct ieee80211_local *local = hw_to_local(hw);
167
168         return local->rx_led_name;
169 }
170 EXPORT_SYMBOL(__ieee80211_get_rx_led_name);
171
172 static 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
184 static 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
218 char *__ieee80211_create_tpt_led_trigger(struct ieee80211_hw *hw,
219                                 unsigned int flags,
220                                 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;
240         tpt_trig->want = flags;
241
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 }
248 EXPORT_SYMBOL(__ieee80211_create_tpt_led_trigger);
249
250 static void ieee80211_start_tpt_led_trig(struct ieee80211_local *local)
251 {
252         struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
253
254         if (tpt_trig->running)
255                 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
265 static void ieee80211_stop_tpt_led_trig(struct ieee80211_local *local)
266 {
267         struct tpt_led_trigger *tpt_trig = local->tpt_led_trigger;
268         struct led_classdev *led_cdev;
269
270         if (!tpt_trig->running)
271                 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 }
281
282 void 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 }