1/* 2 3 Broadcom B43 wireless driver 4 RFKILL support 5 6 Copyright (c) 2007 Michael Buesch <mb@bu3sch.de> 7 8 This program is free software; you can redistribute it and/or modify 9 it under the terms of the GNU General Public License as published by 10 the Free Software Foundation; either version 2 of the License, or 11 (at your option) any later version. 12 13 This program is distributed in the hope that it will be useful, 14 but WITHOUT ANY WARRANTY; without even the implied warranty of 15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 GNU General Public License for more details. 17 18 You should have received a copy of the GNU General Public License 19 along with this program; see the file COPYING. If not, write to 20 the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor, 21 Boston, MA 02110-1301, USA. 22 23*/ 24 25#include "b43.h" 26 27 28/* Returns TRUE, if the radio is enabled in hardware. */ 29bool b43_is_hw_radio_enabled(struct b43_wldev *dev) 30{ 31 if (dev->phy.rev >= 3 || dev->phy.type == B43_PHYTYPE_LP) { 32 if (!(b43_read32(dev, B43_MMIO_RADIO_HWENABLED_HI) 33 & B43_MMIO_RADIO_HWENABLED_HI_MASK)) 34 return 1; 35 } else { 36 if (b43_status(dev) >= B43_STAT_STARTED && 37 b43_read16(dev, B43_MMIO_RADIO_HWENABLED_LO) 38 & B43_MMIO_RADIO_HWENABLED_LO_MASK) 39 return 1; 40 } 41 return 0; 42} 43 44/* The poll callback for the hardware button. */ 45void b43_rfkill_poll(struct ieee80211_hw *hw) 46{ 47 struct b43_wl *wl = hw_to_b43_wl(hw); 48 struct b43_wldev *dev = wl->current_dev; 49 struct ssb_bus *bus = dev->dev->bus; 50 bool enabled; 51 bool brought_up = false; 52 53 mutex_lock(&wl->mutex); 54 if (unlikely(b43_status(dev) < B43_STAT_INITIALIZED)) { 55 if (ssb_bus_powerup(bus, 0)) { 56 mutex_unlock(&wl->mutex); 57 return; 58 } 59 ssb_device_enable(dev->dev, 0); 60 brought_up = true; 61 } 62 63 enabled = b43_is_hw_radio_enabled(dev); 64 65 if (unlikely(enabled != dev->radio_hw_enable)) { 66 dev->radio_hw_enable = enabled; 67 b43info(wl, "Radio hardware status changed to %s\n", 68 enabled ? "ENABLED" : "DISABLED"); 69 wiphy_rfkill_set_hw_state(hw->wiphy, !enabled); 70 if (enabled != dev->phy.radio_on) 71 b43_software_rfkill(dev, !enabled); 72 } 73 74 if (brought_up) { 75 ssb_device_disable(dev->dev, 0); 76 ssb_bus_may_powerdown(bus); 77 } 78 79 mutex_unlock(&wl->mutex); 80} 81