| 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 <[email protected]> |
| 8 |
|
| 9 |
|
| 10 |
*/ |
| 11 |
|
| 12 |
#include "radio.h" |
| 13 |
#include "b43legacy.h" |
| 14 |
|
| 15 |
|
| 16 |
/* Returns TRUE, if the radio is enabled in hardware. */ |
| 17 |
bool b43legacy_is_hw_radio_enabled(struct b43legacy_wldev *dev) |
| 18 |
{ |
| 19 |
if (dev->dev->id.revision >= 3) { |
| 20 |
if (!(b43legacy_read32(dev, B43legacy_MMIO_RADIO_HWENABLED_HI) |
| 21 |
& B43legacy_MMIO_RADIO_HWENABLED_HI_MASK)) |
| 22 |
return true; |
| 23 |
} else { |
| 24 |
/* To prevent CPU fault on PPC, do not read a register |
| 25 |
* unless the interface is started; however, on resume |
| 26 |
* for hibernation, this routine is entered early. When |
| 27 |
* that happens, unconditionally return TRUE. |
| 28 |
*/ |
| 29 |
if (b43legacy_status(dev) < B43legacy_STAT_STARTED) |
| 30 |
return true; |
| 31 |
if (b43legacy_read16(dev, B43legacy_MMIO_RADIO_HWENABLED_LO) |
| 32 |
& B43legacy_MMIO_RADIO_HWENABLED_LO_MASK) |
| 33 |
return true; |
| 34 |
} |
| 35 |
return false; |
| 36 |
} |
| 37 |
|
| 38 |
/* The poll callback for the hardware button. */ |
| 39 |
void b43legacy_rfkill_poll(struct ieee80211_hw *hw) |
| 40 |
{ |
| 41 |
struct b43legacy_wl *wl = hw_to_b43legacy_wl(hw); |
| 42 |
struct b43legacy_wldev *dev = wl->current_dev; |
| 43 |
struct ssb_bus *bus = dev->dev->bus; |
| 44 |
bool enabled; |
| 45 |
bool brought_up = false; |
| 46 |
|
| 47 |
mutex_lock(&wl->mutex); |
| 48 |
if (unlikely(b43legacy_status(dev) < B43legacy_STAT_INITIALIZED)) { |
| 49 |
if (ssb_bus_powerup(bus, 0)) { |
| 50 |
mutex_unlock(&wl->mutex); |
| 51 |
return; |
| 52 |
} |
| 53 |
ssb_device_enable(dev->dev, 0); |
| 54 |
brought_up = true; |
| 55 |
} |
| 56 |
|
| 57 |
enabled = b43legacy_is_hw_radio_enabled(dev); |
| 58 |
|
| 59 |
if (unlikely(enabled != dev->radio_hw_enable)) { |
| 60 |
dev->radio_hw_enable = enabled; |
| 61 |
b43legacyinfo(wl, "Radio hardware status changed to %s\n", |
| 62 |
enabled ? "ENABLED" : "DISABLED"); |
| 63 |
wiphy_rfkill_set_hw_state(hw->wiphy, !enabled); |
| 64 |
if (enabled != dev->phy.radio_on) { |
| 65 |
if (enabled) |
| 66 |
b43legacy_radio_turn_on(dev); |
| 67 |
else |
| 68 |
b43legacy_radio_turn_off(dev, 0); |
| 69 |
} |
| 70 |
} |
| 71 |
|
| 72 |
if (brought_up) { |
| 73 |
ssb_device_disable(dev->dev, 0); |
| 74 |
ssb_bus_may_powerdown(bus); |
| 75 |
} |
| 76 |
|
| 77 |
mutex_unlock(&wl->mutex); |
| 78 |
} |