drivers/net/wireless/b43/leds.c

   1 /*
   2
   3   Broadcom B43 wireless driver
   4   LED control
   5
   6   Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>,
   7   Copyright (c) 2005 Stefano Brivio <stefano.brivio@polimi.it>
   8   Copyright (c) 2005-2007 Michael Buesch <mb@bu3sch.de>
   9   Copyright (c) 2005 Danny van Dyk <kugelfang@gentoo.org>
  10   Copyright (c) 2005 Andreas Jaggi <andreas.jaggi@waterwave.ch>
  11
  12   This program is free software; you can redistribute it and/or modify
  13   it under the terms of the GNU General Public License as published by
  14   the Free Software Foundation; either version 2 of the License, or
  15   (at your option) any later version.
  16
  17   This program is distributed in the hope that it will be useful,
  18   but WITHOUT ANY WARRANTY; without even the implied warranty of
  19   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20   GNU General Public License for more details.
  21
  22   You should have received a copy of the GNU General Public License
  23   along with this program; see the file COPYING.  If not, write to
  24   the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
  25   Boston, MA 02110-1301, USA.
  26
  27 */
  28
  29 #include "b43.h"
  30 #include "leds.h"
  31 #include "rfkill.h"
  32
  33
  34 static void b43_led_turn_on(struct b43_wldev *dev, u8 led_index,
  35                             bool activelow)
  36 {
  37         u16 ctl;
  38
  39         ctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL);
  40         if (activelow)
  41                 ctl &= ~(1 << led_index);
  42         else
  43                 ctl |= (1 << led_index);
  44         b43_write16(dev, B43_MMIO_GPIO_CONTROL, ctl);
  45 }
  46
  47 static void b43_led_turn_off(struct b43_wldev *dev, u8 led_index,
  48                              bool activelow)
  49 {
  50         u16 ctl;
  51
  52         ctl = b43_read16(dev, B43_MMIO_GPIO_CONTROL);
  53         if (activelow)
  54                 ctl |= (1 << led_index);
  55         else
  56                 ctl &= ~(1 << led_index);
  57         b43_write16(dev, B43_MMIO_GPIO_CONTROL, ctl);
  58 }
  59
  60 static void b43_led_update(struct b43_wldev *dev,
  61                            struct b43_led *led)
  62 {
  63         bool radio_enabled;
  64         bool turn_on;
  65
  66         if (!led->wl)
  67                 return;
  68
  69         radio_enabled = (dev->phy.radio_on && dev->radio_hw_enable);
  70
  71         /* The led->state read is racy, but we don't care. In case we raced
  72          * with the brightness_set handler, we will be called again soon
  73          * to fixup our state. */
  74         if (radio_enabled)
  75                 turn_on = atomic_read(&led->state) != LED_OFF;
  76         else
  77                 turn_on = 0;
  78         if (turn_on == led->hw_state)
  79                 return;
  80         led->hw_state = turn_on;
  81
  82         if (turn_on)
  83                 b43_led_turn_on(dev, led->index, led->activelow);
  84         else
  85                 b43_led_turn_off(dev, led->index, led->activelow);
  86 }
  87
  88 static void b43_leds_work(struct work_struct *work)
  89 {
  90         struct b43_leds *leds = container_of(work, struct b43_leds, work);
  91         struct b43_wl *wl = container_of(leds, struct b43_wl, leds);
  92         struct b43_wldev *dev;
  93
  94         mutex_lock(&wl->mutex);
  95         dev = wl->current_dev;
  96         if (unlikely(!dev || b43_status(dev) < B43_STAT_STARTED))
  97                 goto out_unlock;
  98
  99         b43_led_update(dev, &wl->leds.led_tx);
 100         b43_led_update(dev, &wl->leds.led_rx);
 101         b43_led_update(dev, &wl->leds.led_radio);
 102         b43_led_update(dev, &wl->leds.led_assoc);
 103
 104 out_unlock:
 105         mutex_unlock(&wl->mutex);
 106 }
 107
 108 /* Callback from the LED subsystem. */
 109 static void b43_led_brightness_set(struct led_classdev *led_dev,
 110                                    enum led_brightness brightness)
 111 {
 112         struct b43_led *led = container_of(led_dev, struct b43_led, led_dev);
 113         struct b43_wl *wl = led->wl;
 114
 115         /* The check for current_dev is only needed while unregistering,
 116          * so it is sequencial and does not race. But we must not dereference
 117          * current_dev here. */
 118         if (likely(wl->current_dev)) {
 119                 atomic_set(&led->state, brightness);
 120                 ieee80211_queue_work(wl->hw, &wl->leds.work);
 121         }
 122 }
 123
 124 static int b43_register_led(struct b43_wldev *dev, struct b43_led *led,
 125                             const char *name, const char *default_trigger,
 126                             u8 led_index, bool activelow)
 127 {
 128         int err;
 129
 130         if (led->wl)
 131                 return -EEXIST;
 132         if (!default_trigger)
 133                 return -EINVAL;
 134         led->wl = dev->wl;
 135         led->index = led_index;
 136         led->activelow = activelow;
 137         strncpy(led->name, name, sizeof(led->name));
 138         atomic_set(&led->state, 0);
 139
 140         led->led_dev.name = led->name;
 141         led->led_dev.default_trigger = default_trigger;
 142         led->led_dev.brightness_set = b43_led_brightness_set;
 143
 144         err = led_classdev_register(dev->dev->dev, &led->led_dev);
 145         if (err) {
 146                 b43warn(dev->wl, "LEDs: Failed to register %s\n", name);
 147                 led->wl = NULL;
 148                 return err;
 149         }
 150
 151         return 0;
 152 }
 153
 154 static void b43_unregister_led(struct b43_led *led)
 155 {
 156         if (!led->wl)
 157                 return;
 158         led_classdev_unregister(&led->led_dev);
 159         led->wl = NULL;
 160 }
 161
 162 static void b43_map_led(struct b43_wldev *dev,
 163                         u8 led_index,
 164                         enum b43_led_behaviour behaviour,
 165                         bool activelow)
 166 {
 167         struct ieee80211_hw *hw = dev->wl->hw;
 168         char name[B43_LED_MAX_NAME_LEN + 1];
 169
 170         /* Map the b43 specific LED behaviour value to the
 171          * generic LED triggers. */
 172         switch (behaviour) {
 173         case B43_LED_INACTIVE:
 174         case B43_LED_OFF:
 175         case B43_LED_ON:
 176                 break;
 177         case B43_LED_ACTIVITY:
 178         case B43_LED_TRANSFER:
 179         case B43_LED_APTRANSFER:
 180                 snprintf(name, sizeof(name),
 181                          "b43-%s::tx", wiphy_name(hw->wiphy));
 182                 b43_register_led(dev, &dev->wl->leds.led_tx, name,
 183                                  ieee80211_get_tx_led_name(hw),
 184                                  led_index, activelow);
 185                 snprintf(name, sizeof(name),
 186                          "b43-%s::rx", wiphy_name(hw->wiphy));
 187                 b43_register_led(dev, &dev->wl->leds.led_rx, name,
 188                                  ieee80211_get_rx_led_name(hw),
 189                                  led_index, activelow);
 190                 break;
 191         case B43_LED_RADIO_ALL:
 192         case B43_LED_RADIO_A:
 193         case B43_LED_RADIO_B:
 194         case B43_LED_MODE_BG:
 195                 snprintf(name, sizeof(name),
 196                          "b43-%s::radio", wiphy_name(hw->wiphy));
 197                 b43_register_led(dev, &dev->wl->leds.led_radio, name,
 198                                  ieee80211_get_radio_led_name(hw),
 199                                  led_index, activelow);
 200                 break;
 201         case B43_LED_WEIRD:
 202         case B43_LED_ASSOC:
 203                 snprintf(name, sizeof(name),
 204                          "b43-%s::assoc", wiphy_name(hw->wiphy));
 205                 b43_register_led(dev, &dev->wl->leds.led_assoc, name,
 206                                  ieee80211_get_assoc_led_name(hw),
 207                                  led_index, activelow);
 208                 break;
 209         default:
 210                 b43warn(dev->wl, "LEDs: Unknown behaviour 0x%02X\n",
 211                         behaviour);
 212                 break;
 213         }
 214 }
 215
 216 static void b43_led_get_sprominfo(struct b43_wldev *dev,
 217                                   unsigned int led_index,
 218                                   enum b43_led_behaviour *behaviour,
 219                                   bool *activelow)
 220 {
 221         struct ssb_bus *bus = dev->dev->bus;
 222         u8 sprom[4];
 223
 224         sprom[0] = bus->sprom.gpio0;
 225         sprom[1] = bus->sprom.gpio1;
 226         sprom[2] = bus->sprom.gpio2;
 227         sprom[3] = bus->sprom.gpio3;
 228
 229         if (sprom[led_index] == 0xFF) {
 230                 /* There is no LED information in the SPROM
 231                  * for this LED. Hardcode it here. */
 232                 *activelow = 0;
 233                 switch (led_index) {
 234                 case 0:
 235                         *behaviour = B43_LED_ACTIVITY;
 236                         *activelow = 1;
 237                         if (bus->boardinfo.vendor == PCI_VENDOR_ID_COMPAQ)
 238                                 *behaviour = B43_LED_RADIO_ALL;
 239                         break;
 240                 case 1:
 241                         *behaviour = B43_LED_RADIO_B;
 242                         if (bus->boardinfo.vendor == PCI_VENDOR_ID_ASUSTEK)
 243                                 *behaviour = B43_LED_ASSOC;
 244                         break;
 245                 case 2:
 246                         *behaviour = B43_LED_RADIO_A;
 247                         break;
 248                 case 3:
 249                         *behaviour = B43_LED_OFF;
 250                         break;
 251                 default:
 252                         B43_WARN_ON(1);
 253                         return;
 254                 }
 255         } else {
 256                 *behaviour = sprom[led_index] & B43_LED_BEHAVIOUR;
 257                 *activelow = !!(sprom[led_index] & B43_LED_ACTIVELOW);
 258         }
 259 }
 260
 261 void b43_leds_init(struct b43_wldev *dev)
 262 {
 263         struct b43_led *led;
 264         unsigned int i;
 265         enum b43_led_behaviour behaviour;
 266         bool activelow;
 267
 268         /* Sync the RF-kill LED state (if we have one) with radio and switch states. */
 269         led = &dev->wl->leds.led_radio;
 270         if (led->wl) {
 271                 if (dev->phy.radio_on && b43_is_hw_radio_enabled(dev)) {
 272                         b43_led_turn_on(dev, led->index, led->activelow);
 273                         led->hw_state = 1;
 274                         atomic_set(&led->state, 1);
 275                 } else {
 276                         b43_led_turn_off(dev, led->index, led->activelow);
 277                         led->hw_state = 0;
 278                         atomic_set(&led->state, 0);
 279                 }
 280         }
 281
 282         /* Initialize TX/RX/ASSOC leds */
 283         led = &dev->wl->leds.led_tx;
 284         if (led->wl) {
 285                 b43_led_turn_off(dev, led->index, led->activelow);
 286                 led->hw_state = 0;
 287                 atomic_set(&led->state, 0);
 288         }
 289         led = &dev->wl->leds.led_rx;
 290         if (led->wl) {
 291                 b43_led_turn_off(dev, led->index, led->activelow);
 292                 led->hw_state = 0;
 293                 atomic_set(&led->state, 0);
 294         }
 295         led = &dev->wl->leds.led_assoc;
 296         if (led->wl) {
 297                 b43_led_turn_off(dev, led->index, led->activelow);
 298                 led->hw_state = 0;
 299                 atomic_set(&led->state, 0);
 300         }
 301
 302         /* Initialize other LED states. */
 303         for (i = 0; i < B43_MAX_NR_LEDS; i++) {
 304                 b43_led_get_sprominfo(dev, i, &behaviour, &activelow);
 305                 switch (behaviour) {
 306                 case B43_LED_OFF:
 307                         b43_led_turn_off(dev, i, activelow);
 308                         break;
 309                 case B43_LED_ON:
 310                         b43_led_turn_on(dev, i, activelow);
 311                         break;
 312                 default:
 313                         /* Leave others as-is. */
 314                         break;
 315                 }
 316         }
 317 }
 318
 319 void b43_leds_exit(struct b43_wldev *dev)
 320 {
 321         struct b43_leds *leds = &dev->wl->leds;
 322
 323         b43_led_turn_off(dev, leds->led_tx.index, leds->led_tx.activelow);
 324         b43_led_turn_off(dev, leds->led_rx.index, leds->led_rx.activelow);
 325         b43_led_turn_off(dev, leds->led_assoc.index, leds->led_assoc.activelow);
 326         b43_led_turn_off(dev, leds->led_radio.index, leds->led_radio.activelow);
 327 }
 328
 329 void b43_leds_register(struct b43_wldev *dev)
 330 {
 331         unsigned int i;
 332         enum b43_led_behaviour behaviour;
 333         bool activelow;
 334
 335         INIT_WORK(&dev->wl->leds.work, b43_leds_work);
 336
 337         /* Register the LEDs to the LED subsystem. */
 338         for (i = 0; i < B43_MAX_NR_LEDS; i++) {
 339                 b43_led_get_sprominfo(dev, i, &behaviour, &activelow);
 340                 b43_map_led(dev, i, behaviour, activelow);
 341         }
 342 }
 343
 344 void b43_leds_unregister(struct b43_wldev *dev)
 345 {
 346         struct b43_leds *leds = &dev->wl->leds;
 347
 348         b43_unregister_led(&leds->led_tx);
 349         b43_unregister_led(&leds->led_rx);
 350         b43_unregister_led(&leds->led_assoc);
 351         b43_unregister_led(&leds->led_radio);
 352 }