| 1 | |
| 2 | |
| 3 |
|
| 4 | Broadcom B43 wireless driver
|
| 5 | RFKILL support
|
| 6 |
|
| 7 | Copyright (c) 2007 Michael Buesch <[email protected]>
|
| 8 |
|
| 9 |
|
| 10 |
|
| 11 |
|
| 12 | #include "b43.h"
|
| 13 |
|
| 14 |
|
| 15 |
|
| 16 | bool b43_is_hw_radio_enabled(struct b43_wldev *dev)
|
| 17 | {
|
| 18 | return !(b43_read32(dev, B43_MMIO_RADIO_HWENABLED_HI)
|
| 19 | & B43_MMIO_RADIO_HWENABLED_HI_MASK);
|
| 20 | }
|
| 21 |
|
| 22 |
|
| 23 | void b43_rfkill_poll(struct ieee80211_hw *hw)
|
| 24 | {
|
| 25 | struct b43_wl *wl = hw_to_b43_wl(hw);
|
| 26 | struct b43_wldev *dev = wl->current_dev;
|
| 27 | bool enabled;
|
| 28 | bool brought_up = false;
|
| 29 |
|
| 30 | mutex_lock(&wl->mutex);
|
| 31 | if (unlikely(b43_status(dev) < B43_STAT_INITIALIZED)) {
|
| 32 | if (b43_bus_powerup(dev, 0)) {
|
| 33 | mutex_unlock(&wl->mutex);
|
| 34 | return;
|
| 35 | }
|
| 36 | b43_device_enable(dev, 0);
|
| 37 | brought_up = true;
|
| 38 | }
|
| 39 |
|
| 40 | enabled = b43_is_hw_radio_enabled(dev);
|
| 41 |
|
| 42 | if (unlikely(enabled != dev->radio_hw_enable)) {
|
| 43 | dev->radio_hw_enable = enabled;
|
| 44 | b43info(wl, "Radio hardware status changed to %s\n",
|
| 45 | enabled ? "ENABLED" : "DISABLED");
|
| 46 | wiphy_rfkill_set_hw_state(hw->wiphy, !enabled);
|
| 47 | if (enabled != dev->phy.radio_on)
|
| 48 | b43_software_rfkill(dev, !enabled);
|
| 49 | }
|
| 50 |
|
| 51 | if (brought_up) {
|
| 52 | b43_device_disable(dev, 0);
|
| 53 | b43_bus_may_powerdown(dev);
|
| 54 | }
|
| 55 |
|
| 56 | mutex_unlock(&wl->mutex);
|
| 57 | }
|