diff options
-rw-r--r-- | include/linux/rfkill.h | 89 | ||||
-rw-r--r-- | net/Kconfig | 2 | ||||
-rw-r--r-- | net/Makefile | 1 | ||||
-rw-r--r-- | net/rfkill/Kconfig | 24 | ||||
-rw-r--r-- | net/rfkill/Makefile | 6 | ||||
-rw-r--r-- | net/rfkill/rfkill-input.c | 174 | ||||
-rw-r--r-- | net/rfkill/rfkill.c | 407 |
7 files changed, 703 insertions, 0 deletions
diff --git a/include/linux/rfkill.h b/include/linux/rfkill.h new file mode 100644 index 000000000000..7c1ffbab7865 --- /dev/null +++ b/include/linux/rfkill.h | |||
@@ -0,0 +1,89 @@ | |||
1 | #ifndef __RFKILL_H | ||
2 | #define __RFKILL_H | ||
3 | |||
4 | /* | ||
5 | * Copyright (C) 2006 Ivo van Doorn | ||
6 | * Copyright (C) 2007 Dmitry Torokhov | ||
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; if not, write to the | ||
20 | * Free Software Foundation, Inc., | ||
21 | * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
22 | */ | ||
23 | |||
24 | #include <linux/types.h> | ||
25 | #include <linux/kernel.h> | ||
26 | #include <linux/list.h> | ||
27 | #include <linux/mutex.h> | ||
28 | #include <linux/device.h> | ||
29 | |||
30 | /** | ||
31 | * enum rfkill_type - type of rfkill switch. | ||
32 | * RFKILL_TYPE_WLAN: switch is no a Wireless network devices. | ||
33 | * RFKILL_TYPE_BlUETOOTH: switch is on a bluetooth device. | ||
34 | * RFKILL_TYPE_IRDA: switch is on an infrared devices. | ||
35 | */ | ||
36 | enum rfkill_type { | ||
37 | RFKILL_TYPE_WLAN = 0, | ||
38 | RFKILL_TYPE_BLUETOOTH = 1, | ||
39 | RFKILL_TYPE_IRDA = 2, | ||
40 | RFKILL_TYPE_MAX = 3, | ||
41 | }; | ||
42 | |||
43 | enum rfkill_state { | ||
44 | RFKILL_STATE_OFF = 0, | ||
45 | RFKILL_STATE_ON = 1, | ||
46 | }; | ||
47 | |||
48 | /** | ||
49 | * struct rfkill - rfkill control structure. | ||
50 | * @name: Name of the switch. | ||
51 | * @type: Radio type which the button controls, the value stored | ||
52 | * here should be a value from enum rfkill_type. | ||
53 | * @state: State of the switch (on/off). | ||
54 | * @user_claim: Set when the switch is controlled exlusively by userspace. | ||
55 | * @mutex: Guards switch state transitions | ||
56 | * @data: Pointer to the RF button drivers private data which will be | ||
57 | * passed along when toggling radio state. | ||
58 | * @toggle_radio(): Mandatory handler to control state of the radio. | ||
59 | * @dev: Device structure integrating the switch into device tree. | ||
60 | * @node: Used to place switch into list of all switches known to the | ||
61 | * the system. | ||
62 | * | ||
63 | * This structure represents a RF switch located on a network device. | ||
64 | */ | ||
65 | struct rfkill { | ||
66 | char *name; | ||
67 | enum rfkill_type type; | ||
68 | |||
69 | enum rfkill_state state; | ||
70 | bool user_claim; | ||
71 | |||
72 | struct mutex mutex; | ||
73 | |||
74 | void *data; | ||
75 | int (*toggle_radio)(void *data, enum rfkill_state state); | ||
76 | |||
77 | struct device dev; | ||
78 | struct list_head node; | ||
79 | }; | ||
80 | #define to_rfkill(d) container_of(d, struct rfkill, dev) | ||
81 | |||
82 | struct rfkill *rfkill_allocate(struct device *parent, enum rfkill_type type); | ||
83 | void rfkill_free(struct rfkill *rfkill); | ||
84 | int rfkill_register(struct rfkill *rfkill); | ||
85 | void rfkill_unregister(struct rfkill *rfkill); | ||
86 | |||
87 | void rfkill_switch_all(enum rfkill_type type, enum rfkill_state state); | ||
88 | |||
89 | #endif /* RFKILL_H */ | ||
diff --git a/net/Kconfig b/net/Kconfig index 5b2227813923..caeacd16656a 100644 --- a/net/Kconfig +++ b/net/Kconfig | |||
@@ -225,6 +225,8 @@ source "net/ieee80211/Kconfig" | |||
225 | 225 | ||
226 | endmenu | 226 | endmenu |
227 | 227 | ||
228 | source "net/rfkill/Kconfig" | ||
229 | |||
228 | endif # if NET | 230 | endif # if NET |
229 | endmenu # Networking | 231 | endmenu # Networking |
230 | 232 | ||
diff --git a/net/Makefile b/net/Makefile index 9fdb60c2e4a1..34e5b2d7f877 100644 --- a/net/Makefile +++ b/net/Makefile | |||
@@ -51,6 +51,7 @@ obj-$(CONFIG_IEEE80211) += ieee80211/ | |||
51 | obj-$(CONFIG_TIPC) += tipc/ | 51 | obj-$(CONFIG_TIPC) += tipc/ |
52 | obj-$(CONFIG_NETLABEL) += netlabel/ | 52 | obj-$(CONFIG_NETLABEL) += netlabel/ |
53 | obj-$(CONFIG_IUCV) += iucv/ | 53 | obj-$(CONFIG_IUCV) += iucv/ |
54 | obj-$(CONFIG_RFKILL) += rfkill/ | ||
54 | 55 | ||
55 | ifeq ($(CONFIG_NET),y) | 56 | ifeq ($(CONFIG_NET),y) |
56 | obj-$(CONFIG_SYSCTL) += sysctl_net.o | 57 | obj-$(CONFIG_SYSCTL) += sysctl_net.o |
diff --git a/net/rfkill/Kconfig b/net/rfkill/Kconfig new file mode 100644 index 000000000000..8b31759ee8b0 --- /dev/null +++ b/net/rfkill/Kconfig | |||
@@ -0,0 +1,24 @@ | |||
1 | # | ||
2 | # RF switch subsystem configuration | ||
3 | # | ||
4 | menuconfig RFKILL | ||
5 | tristate "RF switch subsystem support" | ||
6 | help | ||
7 | Say Y here if you want to have control over RF switches | ||
8 | found on many WiFi, Bluetooth and IRDA cards. | ||
9 | |||
10 | To compile this driver as a module, choose M here: the | ||
11 | module will be called rfkill. | ||
12 | |||
13 | config RFKILL_INPUT | ||
14 | tristate "Input layer to RF switch connector" | ||
15 | depends on RFKILL && INPUT | ||
16 | help | ||
17 | Say Y here if you want kernel automatically toggle state | ||
18 | of RF switches on and off when user presses appropriate | ||
19 | button or a key on the keyboard. Without this module you | ||
20 | need a some kind of userspace application to control | ||
21 | state of the switches. | ||
22 | |||
23 | To compile this driver as a module, choose M here: the | ||
24 | module will be called rfkill-input. | ||
diff --git a/net/rfkill/Makefile b/net/rfkill/Makefile new file mode 100644 index 000000000000..b38c430be057 --- /dev/null +++ b/net/rfkill/Makefile | |||
@@ -0,0 +1,6 @@ | |||
1 | # | ||
2 | # Makefile for the RF switch subsystem. | ||
3 | # | ||
4 | |||
5 | obj-$(CONFIG_RFKILL) += rfkill.o | ||
6 | obj-$(CONFIG_RFKILL_INPUT) += rfkill-input.o | ||
diff --git a/net/rfkill/rfkill-input.c b/net/rfkill/rfkill-input.c new file mode 100644 index 000000000000..e5c840c30284 --- /dev/null +++ b/net/rfkill/rfkill-input.c | |||
@@ -0,0 +1,174 @@ | |||
1 | /* | ||
2 | * Input layer to RF Kill interface connector | ||
3 | * | ||
4 | * Copyright (c) 2007 Dmitry Torokhov | ||
5 | */ | ||
6 | |||
7 | /* | ||
8 | * This program is free software; you can redistribute it and/or modify it | ||
9 | * under the terms of the GNU General Public License version 2 as published | ||
10 | * by the Free Software Foundation. | ||
11 | */ | ||
12 | |||
13 | #include <linux/module.h> | ||
14 | #include <linux/input.h> | ||
15 | #include <linux/slab.h> | ||
16 | #include <linux/workqueue.h> | ||
17 | #include <linux/init.h> | ||
18 | #include <linux/rfkill.h> | ||
19 | |||
20 | MODULE_AUTHOR("Dmitry Torokhov <dtor@mail.ru>"); | ||
21 | MODULE_DESCRIPTION("Input layer to RF switch connector"); | ||
22 | MODULE_LICENSE("GPL"); | ||
23 | |||
24 | struct rfkill_task { | ||
25 | struct work_struct work; | ||
26 | enum rfkill_type type; | ||
27 | struct mutex mutex; /* ensures that task is serialized */ | ||
28 | spinlock_t lock; /* for accessing last and desired state */ | ||
29 | unsigned long last; /* last schedule */ | ||
30 | enum rfkill_state desired_state; /* on/off */ | ||
31 | enum rfkill_state current_state; /* on/off */ | ||
32 | }; | ||
33 | |||
34 | static void rfkill_task_handler(struct work_struct *work) | ||
35 | { | ||
36 | struct rfkill_task *task = container_of(work, struct rfkill_task, work); | ||
37 | enum rfkill_state state; | ||
38 | |||
39 | mutex_lock(&task->mutex); | ||
40 | |||
41 | /* | ||
42 | * Use temp variable to fetch desired state to keep it | ||
43 | * consistent even if rfkill_schedule_toggle() runs in | ||
44 | * another thread or interrupts us. | ||
45 | */ | ||
46 | state = task->desired_state; | ||
47 | |||
48 | if (state != task->current_state) { | ||
49 | rfkill_switch_all(task->type, state); | ||
50 | task->current_state = state; | ||
51 | } | ||
52 | |||
53 | mutex_unlock(&task->mutex); | ||
54 | } | ||
55 | |||
56 | static void rfkill_schedule_toggle(struct rfkill_task *task) | ||
57 | { | ||
58 | unsigned int flags; | ||
59 | |||
60 | spin_lock_irqsave(&task->lock, flags); | ||
61 | |||
62 | if (time_after(jiffies, task->last + msecs_to_jiffies(200))) { | ||
63 | task->desired_state = !task->desired_state; | ||
64 | task->last = jiffies; | ||
65 | schedule_work(&task->work); | ||
66 | } | ||
67 | |||
68 | spin_unlock_irqrestore(&task->lock, flags); | ||
69 | } | ||
70 | |||
71 | #define DEFINE_RFKILL_TASK(n, t) \ | ||
72 | struct rfkill_task n = { \ | ||
73 | .work = __WORK_INITIALIZER(n.work, \ | ||
74 | rfkill_task_handler), \ | ||
75 | .type = t, \ | ||
76 | .mutex = __MUTEX_INITIALIZER(n.mutex), \ | ||
77 | .lock = __SPIN_LOCK_UNLOCKED(n.lock), \ | ||
78 | .desired_state = RFKILL_STATE_ON, \ | ||
79 | .current_state = RFKILL_STATE_ON, \ | ||
80 | } | ||
81 | |||
82 | static DEFINE_RFKILL_TASK(rfkill_wlan, RFKILL_TYPE_WLAN); | ||
83 | static DEFINE_RFKILL_TASK(rfkill_bt, RFKILL_TYPE_BLUETOOTH); | ||
84 | |||
85 | static void rfkill_event(struct input_handle *handle, unsigned int type, | ||
86 | unsigned int code, int down) | ||
87 | { | ||
88 | if (type == EV_KEY && down == 1) { | ||
89 | switch (code) { | ||
90 | case KEY_WLAN: | ||
91 | rfkill_schedule_toggle(&rfkill_wlan); | ||
92 | break; | ||
93 | case KEY_BLUETOOTH: | ||
94 | rfkill_schedule_toggle(&rfkill_bt); | ||
95 | break; | ||
96 | default: | ||
97 | break; | ||
98 | } | ||
99 | } | ||
100 | } | ||
101 | |||
102 | static int rfkill_connect(struct input_handler *handler, struct input_dev *dev, | ||
103 | const struct input_device_id *id) | ||
104 | { | ||
105 | struct input_handle *handle; | ||
106 | int error; | ||
107 | |||
108 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); | ||
109 | if (!handle) | ||
110 | return -ENOMEM; | ||
111 | |||
112 | handle->dev = dev; | ||
113 | handle->handler = handler; | ||
114 | handle->name = "rfkill"; | ||
115 | |||
116 | error = input_register_handle(handle); | ||
117 | if (error) | ||
118 | goto err_free_handle; | ||
119 | |||
120 | error = input_open_device(handle); | ||
121 | if (error) | ||
122 | goto err_unregister_handle; | ||
123 | |||
124 | return 0; | ||
125 | |||
126 | err_unregister_handle: | ||
127 | input_unregister_handle(handle); | ||
128 | err_free_handle: | ||
129 | kfree(handle); | ||
130 | return error; | ||
131 | } | ||
132 | |||
133 | static void rfkill_disconnect(struct input_handle *handle) | ||
134 | { | ||
135 | input_close_device(handle); | ||
136 | input_unregister_handle(handle); | ||
137 | kfree(handle); | ||
138 | } | ||
139 | |||
140 | static const struct input_device_id rfkill_ids[] = { | ||
141 | { | ||
142 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT, | ||
143 | .evbit = { BIT(EV_KEY) }, | ||
144 | .keybit = { [LONG(KEY_WLAN)] = BIT(KEY_WLAN) }, | ||
145 | }, | ||
146 | { | ||
147 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT | INPUT_DEVICE_ID_MATCH_KEYBIT, | ||
148 | .evbit = { BIT(EV_KEY) }, | ||
149 | .keybit = { [LONG(KEY_BLUETOOTH)] = BIT(KEY_BLUETOOTH) }, | ||
150 | }, | ||
151 | { } | ||
152 | }; | ||
153 | |||
154 | static struct input_handler rfkill_handler = { | ||
155 | .event = rfkill_event, | ||
156 | .connect = rfkill_connect, | ||
157 | .disconnect = rfkill_disconnect, | ||
158 | .name = "rfkill", | ||
159 | .id_table = rfkill_ids, | ||
160 | }; | ||
161 | |||
162 | static int __init rfkill_handler_init(void) | ||
163 | { | ||
164 | return input_register_handler(&rfkill_handler); | ||
165 | } | ||
166 | |||
167 | static void __exit rfkill_handler_exit(void) | ||
168 | { | ||
169 | input_unregister_handler(&rfkill_handler); | ||
170 | flush_scheduled_work(); | ||
171 | } | ||
172 | |||
173 | module_init(rfkill_handler_init); | ||
174 | module_exit(rfkill_handler_exit); | ||
diff --git a/net/rfkill/rfkill.c b/net/rfkill/rfkill.c new file mode 100644 index 000000000000..a973603e3880 --- /dev/null +++ b/net/rfkill/rfkill.c | |||
@@ -0,0 +1,407 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2006 Ivo van Doorn | ||
3 | * Copyright (C) 2007 Dmitry Torokhov | ||
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 | #include <linux/kernel.h> | ||
22 | #include <linux/module.h> | ||
23 | #include <linux/init.h> | ||
24 | #include <linux/workqueue.h> | ||
25 | #include <linux/capability.h> | ||
26 | #include <linux/list.h> | ||
27 | #include <linux/mutex.h> | ||
28 | #include <linux/rfkill.h> | ||
29 | |||
30 | MODULE_AUTHOR("Ivo van Doorn <IvDoorn@gmail.com>"); | ||
31 | MODULE_VERSION("1.0"); | ||
32 | MODULE_DESCRIPTION("RF switch support"); | ||
33 | MODULE_LICENSE("GPL"); | ||
34 | |||
35 | static LIST_HEAD(rfkill_list); /* list of registered rf switches */ | ||
36 | static DEFINE_MUTEX(rfkill_mutex); | ||
37 | |||
38 | static enum rfkill_state rfkill_states[RFKILL_TYPE_MAX]; | ||
39 | |||
40 | static int rfkill_toggle_radio(struct rfkill *rfkill, | ||
41 | enum rfkill_state state) | ||
42 | { | ||
43 | int retval; | ||
44 | |||
45 | retval = mutex_lock_interruptible(&rfkill->mutex); | ||
46 | if (retval) | ||
47 | return retval; | ||
48 | |||
49 | if (state != rfkill->state) { | ||
50 | retval = rfkill->toggle_radio(rfkill->data, state); | ||
51 | if (!retval) | ||
52 | rfkill->state = state; | ||
53 | } | ||
54 | |||
55 | mutex_unlock(&rfkill->mutex); | ||
56 | return retval; | ||
57 | } | ||
58 | |||
59 | /** | ||
60 | * rfkill_switch_all - Toggle state of all switches of given type | ||
61 | * @type: type of interfaces to be affeceted | ||
62 | * @state: the new state | ||
63 | * | ||
64 | * This function toggles state of all switches of given type unless | ||
65 | * a specific switch is claimed by userspace in which case it is | ||
66 | * left alone. | ||
67 | */ | ||
68 | |||
69 | void rfkill_switch_all(enum rfkill_type type, enum rfkill_state state) | ||
70 | { | ||
71 | struct rfkill *rfkill; | ||
72 | |||
73 | mutex_lock(&rfkill_mutex); | ||
74 | |||
75 | rfkill_states[type] = state; | ||
76 | |||
77 | list_for_each_entry(rfkill, &rfkill_list, node) { | ||
78 | if (!rfkill->user_claim) | ||
79 | rfkill_toggle_radio(rfkill, state); | ||
80 | } | ||
81 | |||
82 | mutex_unlock(&rfkill_mutex); | ||
83 | } | ||
84 | EXPORT_SYMBOL(rfkill_switch_all); | ||
85 | |||
86 | static ssize_t rfkill_name_show(struct device *dev, | ||
87 | struct device_attribute *attr, | ||
88 | char *buf) | ||
89 | { | ||
90 | struct rfkill *rfkill = to_rfkill(dev); | ||
91 | |||
92 | return sprintf(buf, "%s\n", rfkill->name); | ||
93 | } | ||
94 | |||
95 | static ssize_t rfkill_type_show(struct device *dev, | ||
96 | struct device_attribute *attr, | ||
97 | char *buf) | ||
98 | { | ||
99 | struct rfkill *rfkill = to_rfkill(dev); | ||
100 | const char *type; | ||
101 | |||
102 | switch (rfkill->type) { | ||
103 | case RFKILL_TYPE_WLAN: | ||
104 | type = "wlan"; | ||
105 | break; | ||
106 | case RFKILL_TYPE_BLUETOOTH: | ||
107 | type = "bluetooth"; | ||
108 | break; | ||
109 | case RFKILL_TYPE_IRDA: | ||
110 | type = "irda"; | ||
111 | break; | ||
112 | default: | ||
113 | BUG(); | ||
114 | } | ||
115 | |||
116 | return sprintf(buf, "%s\n", type); | ||
117 | } | ||
118 | |||
119 | static ssize_t rfkill_state_show(struct device *dev, | ||
120 | struct device_attribute *attr, | ||
121 | char *buf) | ||
122 | { | ||
123 | struct rfkill *rfkill = to_rfkill(dev); | ||
124 | |||
125 | return sprintf(buf, "%d\n", rfkill->state); | ||
126 | } | ||
127 | |||
128 | static ssize_t rfkill_state_store(struct device *dev, | ||
129 | struct device_attribute *attr, | ||
130 | const char *buf, size_t count) | ||
131 | { | ||
132 | struct rfkill *rfkill = to_rfkill(dev); | ||
133 | unsigned int state = simple_strtoul(buf, NULL, 0); | ||
134 | int error; | ||
135 | |||
136 | if (!capable(CAP_NET_ADMIN)) | ||
137 | return -EPERM; | ||
138 | |||
139 | error = rfkill_toggle_radio(rfkill, | ||
140 | state ? RFKILL_STATE_ON : RFKILL_STATE_OFF); | ||
141 | if (error) | ||
142 | return error; | ||
143 | |||
144 | return count; | ||
145 | } | ||
146 | |||
147 | static ssize_t rfkill_claim_show(struct device *dev, | ||
148 | struct device_attribute *attr, | ||
149 | char *buf) | ||
150 | { | ||
151 | struct rfkill *rfkill = to_rfkill(dev); | ||
152 | |||
153 | return sprintf(buf, "%d", rfkill->user_claim); | ||
154 | } | ||
155 | |||
156 | static ssize_t rfkill_claim_store(struct device *dev, | ||
157 | struct device_attribute *attr, | ||
158 | const char *buf, size_t count) | ||
159 | { | ||
160 | struct rfkill *rfkill = to_rfkill(dev); | ||
161 | bool claim = !!simple_strtoul(buf, NULL, 0); | ||
162 | int error; | ||
163 | |||
164 | if (!capable(CAP_NET_ADMIN)) | ||
165 | return -EPERM; | ||
166 | |||
167 | /* | ||
168 | * Take the global lock to make sure the kernel is not in | ||
169 | * the middle of rfkill_switch_all | ||
170 | */ | ||
171 | error = mutex_lock_interruptible(&rfkill_mutex); | ||
172 | if (error) | ||
173 | return error; | ||
174 | |||
175 | if (rfkill->user_claim != claim) { | ||
176 | if (!claim) | ||
177 | rfkill_toggle_radio(rfkill, | ||
178 | rfkill_states[rfkill->type]); | ||
179 | rfkill->user_claim = claim; | ||
180 | } | ||
181 | |||
182 | mutex_unlock(&rfkill_mutex); | ||
183 | |||
184 | return count; | ||
185 | } | ||
186 | |||
187 | static struct device_attribute rfkill_dev_attrs[] = { | ||
188 | __ATTR(name, S_IRUGO, rfkill_name_show, NULL), | ||
189 | __ATTR(type, S_IRUGO, rfkill_type_show, NULL), | ||
190 | __ATTR(state, S_IRUGO, rfkill_state_show, rfkill_state_store), | ||
191 | __ATTR(claim, S_IRUGO|S_IWUSR, rfkill_claim_show, rfkill_claim_store), | ||
192 | __ATTR_NULL | ||
193 | }; | ||
194 | |||
195 | static void rfkill_release(struct device *dev) | ||
196 | { | ||
197 | struct rfkill *rfkill = to_rfkill(dev); | ||
198 | |||
199 | kfree(rfkill); | ||
200 | module_put(THIS_MODULE); | ||
201 | } | ||
202 | |||
203 | #ifdef CONFIG_PM | ||
204 | static int rfkill_suspend(struct device *dev, pm_message_t state) | ||
205 | { | ||
206 | struct rfkill *rfkill = to_rfkill(dev); | ||
207 | |||
208 | if (dev->power.power_state.event != state.event) { | ||
209 | if (state.event == PM_EVENT_SUSPEND) { | ||
210 | mutex_lock(&rfkill->mutex); | ||
211 | |||
212 | if (rfkill->state == RFKILL_STATE_ON) | ||
213 | rfkill->toggle_radio(rfkill->data, | ||
214 | RFKILL_STATE_OFF); | ||
215 | |||
216 | mutex_unlock(&rfkill->mutex); | ||
217 | } | ||
218 | |||
219 | dev->power.power_state = state; | ||
220 | } | ||
221 | |||
222 | return 0; | ||
223 | } | ||
224 | |||
225 | static int rfkill_resume(struct device *dev) | ||
226 | { | ||
227 | struct rfkill *rfkill = to_rfkill(dev); | ||
228 | |||
229 | if (dev->power.power_state.event != PM_EVENT_ON) { | ||
230 | mutex_lock(&rfkill->mutex); | ||
231 | |||
232 | if (rfkill->state == RFKILL_STATE_ON) | ||
233 | rfkill->toggle_radio(rfkill->data, RFKILL_STATE_ON); | ||
234 | |||
235 | mutex_unlock(&rfkill->mutex); | ||
236 | } | ||
237 | |||
238 | dev->power.power_state = PMSG_ON; | ||
239 | return 0; | ||
240 | } | ||
241 | #else | ||
242 | #define rfkill_suspend NULL | ||
243 | #define rfkill_resume NULL | ||
244 | #endif | ||
245 | |||
246 | static struct class rfkill_class = { | ||
247 | .name = "rfkill", | ||
248 | .dev_release = rfkill_release, | ||
249 | .dev_attrs = rfkill_dev_attrs, | ||
250 | .suspend = rfkill_suspend, | ||
251 | .resume = rfkill_resume, | ||
252 | }; | ||
253 | |||
254 | static int rfkill_add_switch(struct rfkill *rfkill) | ||
255 | { | ||
256 | int retval; | ||
257 | |||
258 | retval = mutex_lock_interruptible(&rfkill_mutex); | ||
259 | if (retval) | ||
260 | return retval; | ||
261 | |||
262 | retval = rfkill_toggle_radio(rfkill, rfkill_states[rfkill->type]); | ||
263 | if (retval) | ||
264 | goto out; | ||
265 | |||
266 | list_add_tail(&rfkill->node, &rfkill_list); | ||
267 | |||
268 | out: | ||
269 | mutex_unlock(&rfkill_mutex); | ||
270 | return retval; | ||
271 | } | ||
272 | |||
273 | static void rfkill_remove_switch(struct rfkill *rfkill) | ||
274 | { | ||
275 | mutex_lock(&rfkill_mutex); | ||
276 | list_del_init(&rfkill->node); | ||
277 | rfkill_toggle_radio(rfkill, RFKILL_STATE_OFF); | ||
278 | mutex_unlock(&rfkill_mutex); | ||
279 | } | ||
280 | |||
281 | /** | ||
282 | * rfkill_allocate - allocate memory for rfkill structure. | ||
283 | * @parent: device that has rf switch on it | ||
284 | * @type: type of the switch (wlan, bluetooth, irda) | ||
285 | * | ||
286 | * This function should be called by the network driver when it needs | ||
287 | * rfkill structure. Once the structure is allocated the driver shoud | ||
288 | * finish its initialization by setting name, private data, enable_radio | ||
289 | * and disable_radio methods and then register it with rfkill_register(). | ||
290 | * NOTE: If registration fails the structure shoudl be freed by calling | ||
291 | * rfkill_free() otherwise rfkill_unregister() should be used. | ||
292 | */ | ||
293 | struct rfkill *rfkill_allocate(struct device *parent, enum rfkill_type type) | ||
294 | { | ||
295 | struct rfkill *rfkill; | ||
296 | struct device *dev; | ||
297 | |||
298 | rfkill = kzalloc(sizeof(struct rfkill), GFP_KERNEL); | ||
299 | if (rfkill) | ||
300 | return NULL; | ||
301 | |||
302 | mutex_init(&rfkill->mutex); | ||
303 | INIT_LIST_HEAD(&rfkill->node); | ||
304 | rfkill->type = type; | ||
305 | |||
306 | dev = &rfkill->dev; | ||
307 | dev->class = &rfkill_class; | ||
308 | dev->parent = parent; | ||
309 | device_initialize(dev); | ||
310 | |||
311 | __module_get(THIS_MODULE); | ||
312 | |||
313 | return rfkill; | ||
314 | } | ||
315 | EXPORT_SYMBOL(rfkill_allocate); | ||
316 | |||
317 | /** | ||
318 | * rfkill_free - Mark rfkill structure for deletion | ||
319 | * @rfkill: rfkill structure to be destroyed | ||
320 | * | ||
321 | * Decrements reference count of rfkill structure so it is destoryed. | ||
322 | * Note that rfkill_free() should _not_ be called after rfkill_unregister(). | ||
323 | */ | ||
324 | void rfkill_free(struct rfkill *rfkill) | ||
325 | { | ||
326 | if (rfkill) | ||
327 | put_device(&rfkill->dev); | ||
328 | } | ||
329 | EXPORT_SYMBOL(rfkill_free); | ||
330 | |||
331 | /** | ||
332 | * rfkill_register - Register a rfkill structure. | ||
333 | * @rfkill: rfkill structure to be registered | ||
334 | * | ||
335 | * This function should be called by the network driver when the rfkill | ||
336 | * structure needs to be registered. Immediately from registration the | ||
337 | * switch driver should be able to service calls to toggle_radio. | ||
338 | */ | ||
339 | int rfkill_register(struct rfkill *rfkill) | ||
340 | { | ||
341 | static atomic_t rfkill_no = ATOMIC_INIT(0); | ||
342 | struct device *dev = &rfkill->dev; | ||
343 | int error; | ||
344 | |||
345 | if (!rfkill->toggle_radio) | ||
346 | return -EINVAL; | ||
347 | |||
348 | error = rfkill_add_switch(rfkill); | ||
349 | if (error) | ||
350 | return error; | ||
351 | |||
352 | snprintf(dev->bus_id, sizeof(dev->bus_id), | ||
353 | "rfkill%ld", (long)atomic_inc_return(&rfkill_no) - 1); | ||
354 | |||
355 | error = device_add(dev); | ||
356 | if (error) { | ||
357 | rfkill_remove_switch(rfkill); | ||
358 | return error; | ||
359 | } | ||
360 | |||
361 | return 0; | ||
362 | } | ||
363 | EXPORT_SYMBOL(rfkill_register); | ||
364 | |||
365 | /** | ||
366 | * rfkill_unregister - Uegister a rfkill structure. | ||
367 | * @rfkill: rfkill structure to be unregistered | ||
368 | * | ||
369 | * This function should be called by the network driver during device | ||
370 | * teardown to destroy rfkill structure. Note that rfkill_free() should | ||
371 | * _not_ be called after rfkill_unregister(). | ||
372 | */ | ||
373 | void rfkill_unregister(struct rfkill *rfkill) | ||
374 | { | ||
375 | device_del(&rfkill->dev); | ||
376 | rfkill_remove_switch(rfkill); | ||
377 | put_device(&rfkill->dev); | ||
378 | } | ||
379 | EXPORT_SYMBOL(rfkill_unregister); | ||
380 | |||
381 | /* | ||
382 | * Rfkill module initialization/deinitialization. | ||
383 | */ | ||
384 | static int __init rfkill_init(void) | ||
385 | { | ||
386 | int error; | ||
387 | int i; | ||
388 | |||
389 | for (i = 0; i < ARRAY_SIZE(rfkill_states); i++) | ||
390 | rfkill_states[i] = RFKILL_STATE_ON; | ||
391 | |||
392 | error = class_register(&rfkill_class); | ||
393 | if (error) { | ||
394 | printk(KERN_ERR "rfkill: unable to register rfkill class\n"); | ||
395 | return error; | ||
396 | } | ||
397 | |||
398 | return 0; | ||
399 | } | ||
400 | |||
401 | static void __exit rfkill_exit(void) | ||
402 | { | ||
403 | class_unregister(&rfkill_class); | ||
404 | } | ||
405 | |||
406 | module_init(rfkill_init); | ||
407 | module_exit(rfkill_exit); | ||