3 Broadcom B43 wireless driver
6 Copyright (c) 2007 Michael Buesch <mb@bu3sch.de>
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.
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.
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.
27 #include "phy_common.h"
29 #include <linux/kmod.h>
32 /* Returns TRUE, if the radio is enabled in hardware. */
33 static bool b43_is_hw_radio_enabled(struct b43_wldev
*dev
)
35 if (dev
->phy
.rev
>= 3) {
36 if (!(b43_read32(dev
, B43_MMIO_RADIO_HWENABLED_HI
)
37 & B43_MMIO_RADIO_HWENABLED_HI_MASK
))
40 if (b43_read16(dev
, B43_MMIO_RADIO_HWENABLED_LO
)
41 & B43_MMIO_RADIO_HWENABLED_LO_MASK
)
47 /* The poll callback for the hardware button. */
48 static void b43_rfkill_poll(struct rfkill
*rfkill
, void *data
)
50 struct b43_wldev
*dev
= data
;
51 struct b43_wl
*wl
= dev
->wl
;
54 mutex_lock(&wl
->mutex
);
55 if (unlikely(b43_status(dev
) < B43_STAT_INITIALIZED
)) {
56 mutex_unlock(&wl
->mutex
);
59 enabled
= b43_is_hw_radio_enabled(dev
);
60 if (unlikely(enabled
!= dev
->radio_hw_enable
)) {
61 dev
->radio_hw_enable
= enabled
;
62 b43info(wl
, "Radio hardware status changed to %s\n",
63 enabled
? "ENABLED" : "DISABLED");
64 enabled
= !rfkill_set_hw_state(rfkill
, !enabled
);
65 if (enabled
!= dev
->phy
.radio_on
)
66 b43_software_rfkill(dev
, !enabled
);
68 mutex_unlock(&wl
->mutex
);
71 /* Called when the RFKILL toggled in software. */
72 static int b43_rfkill_soft_set(void *data
, bool blocked
)
74 struct b43_wldev
*dev
= data
;
75 struct b43_wl
*wl
= dev
->wl
;
78 if (WARN_ON(!wl
->rfkill
.registered
))
81 mutex_lock(&wl
->mutex
);
83 if (b43_status(dev
) < B43_STAT_INITIALIZED
)
86 if (!dev
->radio_hw_enable
)
89 if (!blocked
!= dev
->phy
.radio_on
)
90 b43_software_rfkill(dev
, blocked
);
93 mutex_unlock(&wl
->mutex
);
97 const char *b43_rfkill_led_name(struct b43_wldev
*dev
)
99 struct b43_rfkill
*rfk
= &(dev
->wl
->rfkill
);
101 if (!rfk
->registered
)
103 return rfkill_get_led_trigger_name(rfk
->rfkill
);
106 static const struct rfkill_ops b43_rfkill_ops
= {
107 .set_block
= b43_rfkill_soft_set
,
108 .poll
= b43_rfkill_poll
,
111 void b43_rfkill_init(struct b43_wldev
*dev
)
113 struct b43_wl
*wl
= dev
->wl
;
114 struct b43_rfkill
*rfk
= &(wl
->rfkill
);
119 snprintf(rfk
->name
, sizeof(rfk
->name
),
120 "b43-%s", wiphy_name(wl
->hw
->wiphy
));
122 rfk
->rfkill
= rfkill_alloc(rfk
->name
,
125 &b43_rfkill_ops
, dev
);
129 err
= rfkill_register(rfk
->rfkill
);
137 rfkill_destroy(rfk
->rfkill
);
140 b43warn(wl
, "RF-kill button init failed\n");
143 void b43_rfkill_exit(struct b43_wldev
*dev
)
145 struct b43_rfkill
*rfk
= &(dev
->wl
->rfkill
);
147 if (!rfk
->registered
)
151 rfkill_unregister(rfk
->rfkill
);
152 rfkill_destroy(rfk
->rfkill
);