kernel/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 <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 }