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