aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/net/wireless/rt2x00/rt2x00rfkill.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/net/wireless/rt2x00/rt2x00rfkill.c')
-rw-r--r--drivers/net/wireless/rt2x00/rt2x00rfkill.c148
1 files changed, 148 insertions, 0 deletions
diff --git a/drivers/net/wireless/rt2x00/rt2x00rfkill.c b/drivers/net/wireless/rt2x00/rt2x00rfkill.c
new file mode 100644
index 000000000000..dc5b696f4751
--- /dev/null
+++ b/drivers/net/wireless/rt2x00/rt2x00rfkill.c
@@ -0,0 +1,148 @@
1/*
2 Copyright (C) 2004 - 2007 rt2x00 SourceForge Project
3 <http://rt2x00.serialmonkey.com>
4
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
9
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
14
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the
17 Free Software Foundation, Inc.,
18 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
21/*
22 Module: rt2x00rfkill
23 Abstract: rt2x00 rfkill routines.
24 */
25
26/*
27 * Set enviroment defines for rt2x00.h
28 */
29#define DRV_NAME "rt2x00lib"
30
31#include <linux/input-polldev.h>
32#include <linux/kernel.h>
33#include <linux/module.h>
34#include <linux/rfkill.h>
35
36#include "rt2x00.h"
37#include "rt2x00lib.h"
38
39static int rt2x00rfkill_toggle_radio(void *data, enum rfkill_state state)
40{
41 struct rt2x00_dev *rt2x00dev = data;
42 int retval = 0;
43
44 if (unlikely(!rt2x00dev))
45 return 0;
46
47 /*
48 * Only continue if we have an active interface,
49 * either monitor or non-monitor should be present.
50 */
51 if (!is_interface_present(&rt2x00dev->interface) &&
52 !is_monitor_present(&rt2x00dev->interface))
53 return 0;
54
55 if (state == RFKILL_STATE_ON) {
56 INFO(rt2x00dev, "Hardware button pressed, enabling radio.\n");
57 __set_bit(DEVICE_ENABLED_RADIO_HW, &rt2x00dev->flags);
58 retval = rt2x00lib_enable_radio(rt2x00dev);
59 } else if (state == RFKILL_STATE_OFF) {
60 INFO(rt2x00dev, "Hardware button pressed, disabling radio.\n");
61 __clear_bit(DEVICE_ENABLED_RADIO_HW, &rt2x00dev->flags);
62 rt2x00lib_disable_radio(rt2x00dev);
63 }
64
65 return retval;
66}
67
68static void rt2x00rfkill_poll(struct input_polled_dev *poll_dev)
69{
70 struct rt2x00_dev *rt2x00dev = poll_dev->private;
71 int state = rt2x00dev->ops->lib->rfkill_poll(rt2x00dev);
72
73 if (rt2x00dev->rfkill->state != state)
74 input_report_key(poll_dev->input, KEY_WLAN, 1);
75}
76
77int rt2x00rfkill_register(struct rt2x00_dev *rt2x00dev)
78{
79 int retval;
80
81 if (!test_bit(DEVICE_SUPPORT_HW_BUTTON, &rt2x00dev->flags))
82 return 0;
83
84 retval = rfkill_register(rt2x00dev->rfkill);
85 if (retval) {
86 ERROR(rt2x00dev, "Failed to register rfkill handler.\n");
87 return retval;
88 }
89
90 retval = input_register_polled_device(rt2x00dev->poll_dev);
91 if (retval) {
92 ERROR(rt2x00dev, "Failed to register polled device.\n");
93 rfkill_unregister(rt2x00dev->rfkill);
94 return retval;
95 }
96
97 return 0;
98}
99
100void rt2x00rfkill_unregister(struct rt2x00_dev *rt2x00dev)
101{
102 if (!test_bit(DEVICE_SUPPORT_HW_BUTTON, &rt2x00dev->flags))
103 return;
104
105 input_unregister_polled_device(rt2x00dev->poll_dev);
106 rfkill_unregister(rt2x00dev->rfkill);
107}
108
109int rt2x00rfkill_allocate(struct rt2x00_dev *rt2x00dev)
110{
111 struct device *device = wiphy_dev(rt2x00dev->hw->wiphy);
112
113 if (!test_bit(DEVICE_SUPPORT_HW_BUTTON, &rt2x00dev->flags))
114 return 0;
115
116 rt2x00dev->rfkill = rfkill_allocate(device, RFKILL_TYPE_WLAN);
117 if (!rt2x00dev->rfkill) {
118 ERROR(rt2x00dev, "Failed to allocate rfkill handler.\n");
119 return -ENOMEM;
120 }
121
122 rt2x00dev->rfkill->name = rt2x00dev->ops->name;
123 rt2x00dev->rfkill->data = rt2x00dev;
124 rt2x00dev->rfkill->state = rt2x00dev->ops->lib->rfkill_poll(rt2x00dev);
125 rt2x00dev->rfkill->toggle_radio = rt2x00rfkill_toggle_radio;
126
127 rt2x00dev->poll_dev = input_allocate_polled_device();
128 if (!rt2x00dev->poll_dev) {
129 ERROR(rt2x00dev, "Failed to allocate polled device.\n");
130 rfkill_free(rt2x00dev->rfkill);
131 return -ENOMEM;
132 }
133
134 rt2x00dev->poll_dev->private = rt2x00dev;
135 rt2x00dev->poll_dev->poll = rt2x00rfkill_poll;
136 rt2x00dev->poll_dev->poll_interval = RFKILL_POLL_INTERVAL;
137
138 return 0;
139}
140
141void rt2x00rfkill_free(struct rt2x00_dev *rt2x00dev)
142{
143 if (!test_bit(DEVICE_SUPPORT_HW_BUTTON, &rt2x00dev->flags))
144 return;
145
146 input_free_polled_device(rt2x00dev->poll_dev);
147 rfkill_free(rt2x00dev->rfkill);
148}