| 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
|---|---|
| 2 | /* |
| 3 | |
| 4 | Broadcom B43 wireless driver |
| 5 | RFKILL support |
| 6 | |
| 7 | Copyright (c) 2007 Michael Buesch <m@bues.ch> |
| 8 | |
| 9 | |
| 10 | */ |
| 11 | |
| 12 | #include "b43.h" |
| 13 | |
| 14 | |
| 15 | /* Returns TRUE, if the radio is enabled in hardware. */ |
| 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 | /* The poll callback for the hardware button. */ |
| 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(wldev: dev, dynamic_pctl: 0)) { |
| 33 | mutex_unlock(lock: &wl->mutex); |
| 34 | return; |
| 35 | } |
| 36 | b43_device_enable(wldev: dev, core_specific_flags: 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, fmt: "Radio hardware status changed to %s\n", |
| 45 | enabled ? "ENABLED": "DISABLED"); |
| 46 | wiphy_rfkill_set_hw_state(wiphy: hw->wiphy, blocked: !enabled); |
| 47 | if (enabled != dev->phy.radio_on) |
| 48 | b43_software_rfkill(dev, blocked: !enabled); |
| 49 | } |
| 50 | |
| 51 | if (brought_up) { |
| 52 | b43_device_disable(wldev: dev, core_specific_flags: 0); |
| 53 | b43_bus_may_powerdown(wldev: dev); |
| 54 | } |
| 55 | |
| 56 | mutex_unlock(lock: &wl->mutex); |
| 57 | } |
| 58 |