[RT2x00]: add driver for Ralink wireless hardware
[linux-2.6.git] / drivers / net / wireless / rt2x00 / rt2x00rfkill.c
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
39 static 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
68 static 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
77 int 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
100 void 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
109 int 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
141 void 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 }