2 Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
3 <http://rt2x00.serialmonkey.com>
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.
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.
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.
23 Abstract: rt2x00 rfkill routines.
26 #include <linux/input-polldev.h>
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/rfkill.h>
32 #include "rt2x00lib.h"
34 static int rt2x00rfkill_toggle_radio(void *data
, enum rfkill_state state
)
36 struct rt2x00_dev
*rt2x00dev
= data
;
39 if (unlikely(!rt2x00dev
))
43 * Only continue if there are enabled interfaces.
45 if (!test_bit(DEVICE_STARTED
, &rt2x00dev
->flags
))
48 if (state
== RFKILL_STATE_UNBLOCKED
) {
49 INFO(rt2x00dev
, "Hardware button pressed, enabling radio.\n");
50 __clear_bit(DEVICE_DISABLED_RADIO_HW
, &rt2x00dev
->flags
);
51 retval
= rt2x00lib_enable_radio(rt2x00dev
);
52 } else if (state
== RFKILL_STATE_SOFT_BLOCKED
) {
53 INFO(rt2x00dev
, "Hardware button pressed, disabling radio.\n");
54 __set_bit(DEVICE_DISABLED_RADIO_HW
, &rt2x00dev
->flags
);
55 rt2x00lib_disable_radio(rt2x00dev
);
57 WARNING(rt2x00dev
, "Received unexpected rfkill state %d.\n",
64 static void rt2x00rfkill_poll(struct input_polled_dev
*poll_dev
)
66 struct rt2x00_dev
*rt2x00dev
= poll_dev
->private;
67 int state
= rt2x00dev
->ops
->lib
->rfkill_poll(rt2x00dev
);
69 if (rt2x00dev
->rfkill
->state
!= state
) {
70 input_report_key(poll_dev
->input
, KEY_WLAN
, 1);
71 input_report_key(poll_dev
->input
, KEY_WLAN
, 0);
75 void rt2x00rfkill_register(struct rt2x00_dev
*rt2x00dev
)
77 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
) ||
78 !test_bit(RFKILL_STATE_ALLOCATED
, &rt2x00dev
->rfkill_state
))
81 if (rfkill_register(rt2x00dev
->rfkill
)) {
82 ERROR(rt2x00dev
, "Failed to register rfkill handler.\n");
86 if (input_register_polled_device(rt2x00dev
->poll_dev
)) {
87 ERROR(rt2x00dev
, "Failed to register polled device.\n");
88 rfkill_unregister(rt2x00dev
->rfkill
);
92 __set_bit(RFKILL_STATE_REGISTERED
, &rt2x00dev
->rfkill_state
);
95 * Force initial poll which will detect the initial device state,
96 * and correctly sends the signal to the rfkill layer about this
99 rt2x00rfkill_poll(rt2x00dev
->poll_dev
);
102 void rt2x00rfkill_unregister(struct rt2x00_dev
*rt2x00dev
)
104 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
) ||
105 !test_bit(RFKILL_STATE_REGISTERED
, &rt2x00dev
->rfkill_state
))
108 input_unregister_polled_device(rt2x00dev
->poll_dev
);
109 rfkill_unregister(rt2x00dev
->rfkill
);
111 __clear_bit(RFKILL_STATE_REGISTERED
, &rt2x00dev
->rfkill_state
);
114 static struct input_polled_dev
*
115 rt2x00rfkill_allocate_polldev(struct rt2x00_dev
*rt2x00dev
)
117 struct input_polled_dev
*poll_dev
;
119 poll_dev
= input_allocate_polled_device();
123 poll_dev
->private = rt2x00dev
;
124 poll_dev
->poll
= rt2x00rfkill_poll
;
125 poll_dev
->poll_interval
= RFKILL_POLL_INTERVAL
;
127 poll_dev
->input
->name
= rt2x00dev
->ops
->name
;
128 poll_dev
->input
->phys
= wiphy_name(rt2x00dev
->hw
->wiphy
);
129 poll_dev
->input
->id
.bustype
= BUS_HOST
;
130 poll_dev
->input
->id
.vendor
= 0x1814;
131 poll_dev
->input
->id
.product
= rt2x00dev
->chip
.rt
;
132 poll_dev
->input
->id
.version
= rt2x00dev
->chip
.rev
;
133 poll_dev
->input
->dev
.parent
= wiphy_dev(rt2x00dev
->hw
->wiphy
);
134 poll_dev
->input
->evbit
[0] = BIT(EV_KEY
);
135 set_bit(KEY_WLAN
, poll_dev
->input
->keybit
);
140 void rt2x00rfkill_allocate(struct rt2x00_dev
*rt2x00dev
)
142 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
))
146 rfkill_allocate(wiphy_dev(rt2x00dev
->hw
->wiphy
), RFKILL_TYPE_WLAN
);
147 if (!rt2x00dev
->rfkill
) {
148 ERROR(rt2x00dev
, "Failed to allocate rfkill handler.\n");
152 rt2x00dev
->rfkill
->name
= rt2x00dev
->ops
->name
;
153 rt2x00dev
->rfkill
->data
= rt2x00dev
;
154 rt2x00dev
->rfkill
->state
= -1;
155 rt2x00dev
->rfkill
->toggle_radio
= rt2x00rfkill_toggle_radio
;
157 rt2x00dev
->poll_dev
= rt2x00rfkill_allocate_polldev(rt2x00dev
);
158 if (!rt2x00dev
->poll_dev
) {
159 ERROR(rt2x00dev
, "Failed to allocate polled device.\n");
160 rfkill_free(rt2x00dev
->rfkill
);
161 rt2x00dev
->rfkill
= NULL
;
168 void rt2x00rfkill_free(struct rt2x00_dev
*rt2x00dev
)
170 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
) ||
171 !test_bit(RFKILL_STATE_ALLOCATED
, &rt2x00dev
->rfkill_state
))
174 input_free_polled_device(rt2x00dev
->poll_dev
);
175 rt2x00dev
->poll_dev
= NULL
;
177 rfkill_free(rt2x00dev
->rfkill
);
178 rt2x00dev
->rfkill
= NULL
;
181 void rt2x00rfkill_suspend(struct rt2x00_dev
*rt2x00dev
)
183 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
) ||
184 !test_bit(RFKILL_STATE_ALLOCATED
, &rt2x00dev
->rfkill_state
))
187 input_free_polled_device(rt2x00dev
->poll_dev
);
188 rt2x00dev
->poll_dev
= NULL
;
191 void rt2x00rfkill_resume(struct rt2x00_dev
*rt2x00dev
)
193 if (!test_bit(CONFIG_SUPPORT_HW_BUTTON
, &rt2x00dev
->flags
) ||
194 !test_bit(RFKILL_STATE_ALLOCATED
, &rt2x00dev
->rfkill_state
))
197 rt2x00dev
->poll_dev
= rt2x00rfkill_allocate_polldev(rt2x00dev
);
198 if (!rt2x00dev
->poll_dev
) {
199 ERROR(rt2x00dev
, "Failed to allocate polled device.\n");