blob: 7a3218c5ba7dd69085afbddd65d38d6d40a08b08 [file] [log] [blame]
Michael Buesch8e9f7522007-09-27 21:35:34 +02001/*
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
Michael Buesch8e9f7522007-09-27 21:35:34 +020025#include "b43.h"
Larry Finger1a8d12272007-12-14 13:59:11 +010026
Michael Buesch8e9f7522007-09-27 21:35:34 +020027
Michael Buesch42bb4cd2007-09-28 14:22:33 +020028/* Returns TRUE, if the radio is enabled in hardware. */
Johannes Bergf41f3f32009-06-07 12:30:34 -050029bool b43_is_hw_radio_enabled(struct b43_wldev *dev)
Michael Buesch8e9f7522007-09-27 21:35:34 +020030{
Larry Finger692e5652009-09-21 17:59:27 -050031 if (dev->phy.rev >= 3 || dev->phy.type == B43_PHYTYPE_LP) {
Michael Buesch42bb4cd2007-09-28 14:22:33 +020032 if (!(b43_read32(dev, B43_MMIO_RADIO_HWENABLED_HI)
33 & B43_MMIO_RADIO_HWENABLED_HI_MASK))
34 return 1;
35 } else {
36 if (b43_read16(dev, B43_MMIO_RADIO_HWENABLED_LO)
37 & B43_MMIO_RADIO_HWENABLED_LO_MASK)
38 return 1;
Michael Buesch8e9f7522007-09-27 21:35:34 +020039 }
Michael Buesch42bb4cd2007-09-28 14:22:33 +020040 return 0;
Michael Buesch8e9f7522007-09-27 21:35:34 +020041}
42
Michael Buesch42bb4cd2007-09-28 14:22:33 +020043/* The poll callback for the hardware button. */
Johannes Bergf41f3f32009-06-07 12:30:34 -050044void b43_rfkill_poll(struct ieee80211_hw *hw)
Michael Buesch8e9f7522007-09-27 21:35:34 +020045{
Johannes Bergf41f3f32009-06-07 12:30:34 -050046 struct b43_wl *wl = hw_to_b43_wl(hw);
47 struct b43_wldev *dev = wl->current_dev;
48 struct ssb_bus *bus = dev->dev->bus;
Michael Buesch42bb4cd2007-09-28 14:22:33 +020049 bool enabled;
Johannes Bergf41f3f32009-06-07 12:30:34 -050050 bool brought_up = false;
Michael Buesch8e9f7522007-09-27 21:35:34 +020051
Michael Buesch42bb4cd2007-09-28 14:22:33 +020052 mutex_lock(&wl->mutex);
Larry Finger1a8d12272007-12-14 13:59:11 +010053 if (unlikely(b43_status(dev) < B43_STAT_INITIALIZED)) {
Johannes Bergf41f3f32009-06-07 12:30:34 -050054 if (ssb_bus_powerup(bus, 0)) {
55 mutex_unlock(&wl->mutex);
56 return;
57 }
58 ssb_device_enable(dev->dev, 0);
59 brought_up = true;
Larry Finger1a8d12272007-12-14 13:59:11 +010060 }
Johannes Bergf41f3f32009-06-07 12:30:34 -050061
Michael Buesch42bb4cd2007-09-28 14:22:33 +020062 enabled = b43_is_hw_radio_enabled(dev);
Johannes Bergf41f3f32009-06-07 12:30:34 -050063
Michael Buesch42bb4cd2007-09-28 14:22:33 +020064 if (unlikely(enabled != dev->radio_hw_enable)) {
65 dev->radio_hw_enable = enabled;
66 b43info(wl, "Radio hardware status changed to %s\n",
67 enabled ? "ENABLED" : "DISABLED");
Johannes Bergf41f3f32009-06-07 12:30:34 -050068 wiphy_rfkill_set_hw_state(hw->wiphy, !enabled);
Johannes Berg19d337d2009-06-02 13:01:37 +020069 if (enabled != dev->phy.radio_on)
70 b43_software_rfkill(dev, !enabled);
Michael Buesch35c7e662007-11-03 14:34:32 +010071 }
Johannes Bergf41f3f32009-06-07 12:30:34 -050072
73 if (brought_up) {
74 ssb_device_disable(dev->dev, 0);
75 ssb_bus_may_powerdown(bus);
76 }
77
Michael Buesch35c7e662007-11-03 14:34:32 +010078 mutex_unlock(&wl->mutex);
Michael Buesch8e9f7522007-09-27 21:35:34 +020079}