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 /* To prevent CPU fault on PPC, do not read a register 37 * unless the interface is started; however, on resume 38 * for hibernation, this routine is entered early. When 39 * that happens, unconditionally return TRUE. 40 */ 41 if (b43_status(dev) < B43_STAT_STARTED) 42 return 1; 43 if (b43_read16(dev, B43_MMIO_RADIO_HWENABLED_LO) 44 & B43_MMIO_RADIO_HWENABLED_LO_MASK) 45 return 1; 46 } 47 return 0; 48} 49 50/* The poll callback for the hardware button. */ 51void b43_rfkill_poll(struct ieee80211_hw *hw) 52{ 53 struct b43_wl *wl = hw_to_b43_wl(hw); 54 struct b43_wldev *dev = wl->current_dev; 55 struct ssb_bus *bus = dev->dev->bus; 56 bool enabled; 57 bool brought_up = false; 58 59 mutex_lock(&wl->mutex); 60 if (unlikely(b43_status(dev) < B43_STAT_INITIALIZED)) { 61 if (ssb_bus_powerup(bus, 0)) { 62 mutex_unlock(&wl->mutex); 63 return; 64 } 65 ssb_device_enable(dev->dev, 0); 66 brought_up = true; 67 } 68 69 enabled = b43_is_hw_radio_enabled(dev); 70 71 if (unlikely(enabled != dev->radio_hw_enable)) { 72 dev->radio_hw_enable = enabled; 73 b43info(wl, "Radio hardware status changed to %s\n", 74 enabled ? "ENABLED" : "DISABLED"); 75 wiphy_rfkill_set_hw_state(hw->wiphy, !enabled); 76 if (enabled != dev->phy.radio_on) 77 b43_software_rfkill(dev, !enabled); 78 } 79 80 if (brought_up) { 81 ssb_device_disable(dev->dev, 0); 82 ssb_bus_may_powerdown(bus); 83 } 84 85 mutex_unlock(&wl->mutex); 86} 87