diff options
author | Linus Torvalds <torvalds@linux-foundation.org> | 2009-01-07 18:37:24 -0500 |
---|---|---|
committer | Linus Torvalds <torvalds@linux-foundation.org> | 2009-01-07 18:37:24 -0500 |
commit | 7c7758f99d39d529a64d4f60d22129bbf2f16d74 (patch) | |
tree | 8847b5e56812fe4c4c812cfffc78e391a91f4ebe /net/wimax | |
parent | 67acd8b4b7a3f1b183ae358e1dfdb8a80e170736 (diff) | |
parent | 8a70da82edc50aa7a4b54864babf2d72538ba1bb (diff) |
Merge git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb-2.6
* git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb-2.6: (123 commits)
wimax/i2400m: add CREDITS and MAINTAINERS entries
wimax: export linux/wimax.h and linux/wimax/i2400m.h with headers_install
i2400m: Makefile and Kconfig
i2400m/SDIO: TX and RX path backends
i2400m/SDIO: firmware upload backend
i2400m/SDIO: probe/disconnect, dev init/shutdown and reset backends
i2400m/SDIO: header for the SDIO subdriver
i2400m/USB: TX and RX path backends
i2400m/USB: firmware upload backend
i2400m/USB: probe/disconnect, dev init/shutdown and reset backends
i2400m/USB: header for the USB bus driver
i2400m: debugfs controls
i2400m: various functions for device management
i2400m: RX and TX data/control paths
i2400m: firmware loading and bootrom initialization
i2400m: linkage to the networking stack
i2400m: Generic probe/disconnect, reset and message passing
i2400m: host/device procotol and core driver definitions
i2400m: documentation and instructions for usage
wimax: Makefile, Kconfig and docbook linkage for the stack
...
Diffstat (limited to 'net/wimax')
-rw-r--r-- | net/wimax/Kconfig | 38 | ||||
-rw-r--r-- | net/wimax/Makefile | 13 | ||||
-rw-r--r-- | net/wimax/debug-levels.h | 42 | ||||
-rw-r--r-- | net/wimax/debugfs.c | 90 | ||||
-rw-r--r-- | net/wimax/id-table.c | 142 | ||||
-rw-r--r-- | net/wimax/op-msg.c | 421 | ||||
-rw-r--r-- | net/wimax/op-reset.c | 143 | ||||
-rw-r--r-- | net/wimax/op-rfkill.c | 532 | ||||
-rw-r--r-- | net/wimax/stack.c | 599 | ||||
-rw-r--r-- | net/wimax/wimax-internal.h | 91 |
10 files changed, 2111 insertions, 0 deletions
diff --git a/net/wimax/Kconfig b/net/wimax/Kconfig new file mode 100644 index 000000000000..0bdbb6928205 --- /dev/null +++ b/net/wimax/Kconfig | |||
@@ -0,0 +1,38 @@ | |||
1 | # | ||
2 | # WiMAX LAN device configuration | ||
3 | # | ||
4 | |||
5 | menuconfig WIMAX | ||
6 | tristate "WiMAX Wireless Broadband support" | ||
7 | help | ||
8 | |||
9 | Select to configure support for devices that provide | ||
10 | wireless broadband connectivity using the WiMAX protocol | ||
11 | (IEEE 802.16). | ||
12 | |||
13 | Please note that most of these devices require signing up | ||
14 | for a service plan with a provider. | ||
15 | |||
16 | The different WiMAX drivers can be enabled in the menu entry | ||
17 | |||
18 | Device Drivers > Network device support > WiMAX Wireless | ||
19 | Broadband devices | ||
20 | |||
21 | If unsure, it is safe to select M (module). | ||
22 | |||
23 | config WIMAX_DEBUG_LEVEL | ||
24 | int "WiMAX debug level" | ||
25 | depends on WIMAX | ||
26 | default 8 | ||
27 | help | ||
28 | |||
29 | Select the maximum debug verbosity level to be compiled into | ||
30 | the WiMAX stack code. | ||
31 | |||
32 | By default, debug messages are disabled at runtime and can | ||
33 | be selectively enabled for different parts of the code using | ||
34 | the sysfs debug-levels file. | ||
35 | |||
36 | If set at zero, this will compile out all the debug code. | ||
37 | |||
38 | It is recommended that it is left at 8. | ||
diff --git a/net/wimax/Makefile b/net/wimax/Makefile new file mode 100644 index 000000000000..5b80b941c2c9 --- /dev/null +++ b/net/wimax/Makefile | |||
@@ -0,0 +1,13 @@ | |||
1 | |||
2 | obj-$(CONFIG_WIMAX) += wimax.o | ||
3 | |||
4 | wimax-y := \ | ||
5 | id-table.o \ | ||
6 | op-msg.o \ | ||
7 | op-reset.o \ | ||
8 | op-rfkill.o \ | ||
9 | stack.o | ||
10 | |||
11 | wimax-$(CONFIG_DEBUG_FS) += debugfs.o | ||
12 | |||
13 | |||
diff --git a/net/wimax/debug-levels.h b/net/wimax/debug-levels.h new file mode 100644 index 000000000000..1c29123a3aa9 --- /dev/null +++ b/net/wimax/debug-levels.h | |||
@@ -0,0 +1,42 @@ | |||
1 | /* | ||
2 | * Linux WiMAX Stack | ||
3 | * Debug levels control file for the wimax module | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | */ | ||
23 | #ifndef __debug_levels__h__ | ||
24 | #define __debug_levels__h__ | ||
25 | |||
26 | /* Maximum compile and run time debug level for all submodules */ | ||
27 | #define D_MODULENAME wimax | ||
28 | #define D_MASTER CONFIG_WIMAX_DEBUG_LEVEL | ||
29 | |||
30 | #include <linux/wimax/debug.h> | ||
31 | |||
32 | /* List of all the enabled modules */ | ||
33 | enum d_module { | ||
34 | D_SUBMODULE_DECLARE(debugfs), | ||
35 | D_SUBMODULE_DECLARE(id_table), | ||
36 | D_SUBMODULE_DECLARE(op_msg), | ||
37 | D_SUBMODULE_DECLARE(op_reset), | ||
38 | D_SUBMODULE_DECLARE(op_rfkill), | ||
39 | D_SUBMODULE_DECLARE(stack), | ||
40 | }; | ||
41 | |||
42 | #endif /* #ifndef __debug_levels__h__ */ | ||
diff --git a/net/wimax/debugfs.c b/net/wimax/debugfs.c new file mode 100644 index 000000000000..87cf4430079c --- /dev/null +++ b/net/wimax/debugfs.c | |||
@@ -0,0 +1,90 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Debugfs support | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2005-2006 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | */ | ||
23 | #include <linux/debugfs.h> | ||
24 | #include <linux/wimax.h> | ||
25 | #include "wimax-internal.h" | ||
26 | |||
27 | #define D_SUBMODULE debugfs | ||
28 | #include "debug-levels.h" | ||
29 | |||
30 | |||
31 | /* Debug framework control of debug levels */ | ||
32 | struct d_level D_LEVEL[] = { | ||
33 | D_SUBMODULE_DEFINE(debugfs), | ||
34 | D_SUBMODULE_DEFINE(id_table), | ||
35 | D_SUBMODULE_DEFINE(op_msg), | ||
36 | D_SUBMODULE_DEFINE(op_reset), | ||
37 | D_SUBMODULE_DEFINE(op_rfkill), | ||
38 | D_SUBMODULE_DEFINE(stack), | ||
39 | }; | ||
40 | size_t D_LEVEL_SIZE = ARRAY_SIZE(D_LEVEL); | ||
41 | |||
42 | #define __debugfs_register(prefix, name, parent) \ | ||
43 | do { \ | ||
44 | result = d_level_register_debugfs(prefix, name, parent); \ | ||
45 | if (result < 0) \ | ||
46 | goto error; \ | ||
47 | } while (0) | ||
48 | |||
49 | |||
50 | int wimax_debugfs_add(struct wimax_dev *wimax_dev) | ||
51 | { | ||
52 | int result; | ||
53 | struct net_device *net_dev = wimax_dev->net_dev; | ||
54 | struct device *dev = net_dev->dev.parent; | ||
55 | struct dentry *dentry; | ||
56 | char buf[128]; | ||
57 | |||
58 | snprintf(buf, sizeof(buf), "wimax:%s", net_dev->name); | ||
59 | dentry = debugfs_create_dir(buf, NULL); | ||
60 | result = PTR_ERR(dentry); | ||
61 | if (IS_ERR(dentry)) { | ||
62 | if (result == -ENODEV) | ||
63 | result = 0; /* No debugfs support */ | ||
64 | else | ||
65 | dev_err(dev, "Can't create debugfs dentry: %d\n", | ||
66 | result); | ||
67 | goto out; | ||
68 | } | ||
69 | wimax_dev->debugfs_dentry = dentry; | ||
70 | __debugfs_register("wimax_dl_", debugfs, dentry); | ||
71 | __debugfs_register("wimax_dl_", id_table, dentry); | ||
72 | __debugfs_register("wimax_dl_", op_msg, dentry); | ||
73 | __debugfs_register("wimax_dl_", op_reset, dentry); | ||
74 | __debugfs_register("wimax_dl_", op_rfkill, dentry); | ||
75 | __debugfs_register("wimax_dl_", stack, dentry); | ||
76 | result = 0; | ||
77 | out: | ||
78 | return result; | ||
79 | |||
80 | error: | ||
81 | debugfs_remove_recursive(wimax_dev->debugfs_dentry); | ||
82 | return result; | ||
83 | } | ||
84 | |||
85 | void wimax_debugfs_rm(struct wimax_dev *wimax_dev) | ||
86 | { | ||
87 | debugfs_remove_recursive(wimax_dev->debugfs_dentry); | ||
88 | } | ||
89 | |||
90 | |||
diff --git a/net/wimax/id-table.c b/net/wimax/id-table.c new file mode 100644 index 000000000000..d3b88558682c --- /dev/null +++ b/net/wimax/id-table.c | |||
@@ -0,0 +1,142 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Mappping of generic netlink family IDs to net devices | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2005-2006 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * We assign a single generic netlink family ID to each device (to | ||
25 | * simplify lookup). | ||
26 | * | ||
27 | * We need a way to map family ID to a wimax_dev pointer. | ||
28 | * | ||
29 | * The idea is to use a very simple lookup. Using a netlink attribute | ||
30 | * with (for example) the interface name implies a heavier search over | ||
31 | * all the network devices; seemed kind of a waste given that we know | ||
32 | * we are looking for a WiMAX device and that most systems will have | ||
33 | * just a single WiMAX adapter. | ||
34 | * | ||
35 | * We put all the WiMAX devices in the system in a linked list and | ||
36 | * match the generic link family ID against the list. | ||
37 | * | ||
38 | * By using a linked list, the case of a single adapter in the system | ||
39 | * becomes (almost) no overhead, while still working for many more. If | ||
40 | * it ever goes beyond two, I'll be surprised. | ||
41 | */ | ||
42 | #include <linux/device.h> | ||
43 | #include <net/genetlink.h> | ||
44 | #include <linux/netdevice.h> | ||
45 | #include <linux/list.h> | ||
46 | #include <linux/wimax.h> | ||
47 | #include "wimax-internal.h" | ||
48 | |||
49 | |||
50 | #define D_SUBMODULE id_table | ||
51 | #include "debug-levels.h" | ||
52 | |||
53 | |||
54 | static DEFINE_SPINLOCK(wimax_id_table_lock); | ||
55 | static struct list_head wimax_id_table = LIST_HEAD_INIT(wimax_id_table); | ||
56 | |||
57 | |||
58 | /* | ||
59 | * wimax_id_table_add - add a gennetlink familiy ID / wimax_dev mapping | ||
60 | * | ||
61 | * @wimax_dev: WiMAX device descriptor to associate to the Generic | ||
62 | * Netlink family ID. | ||
63 | * | ||
64 | * Look for an empty spot in the ID table; if none found, double the | ||
65 | * table's size and get the first spot. | ||
66 | */ | ||
67 | void wimax_id_table_add(struct wimax_dev *wimax_dev) | ||
68 | { | ||
69 | d_fnstart(3, NULL, "(wimax_dev %p)\n", wimax_dev); | ||
70 | spin_lock(&wimax_id_table_lock); | ||
71 | list_add(&wimax_dev->id_table_node, &wimax_id_table); | ||
72 | spin_unlock(&wimax_id_table_lock); | ||
73 | d_fnend(3, NULL, "(wimax_dev %p)\n", wimax_dev); | ||
74 | } | ||
75 | |||
76 | |||
77 | /* | ||
78 | * wimax_get_netdev_by_info - lookup a wimax_dev from the gennetlink info | ||
79 | * | ||
80 | * The generic netlink family ID has been filled out in the | ||
81 | * nlmsghdr->nlmsg_type field, so we pull it from there, look it up in | ||
82 | * the mapping table and reference the wimax_dev. | ||
83 | * | ||
84 | * When done, the reference should be dropped with | ||
85 | * 'dev_put(wimax_dev->net_dev)'. | ||
86 | */ | ||
87 | struct wimax_dev *wimax_dev_get_by_genl_info( | ||
88 | struct genl_info *info, int ifindex) | ||
89 | { | ||
90 | struct wimax_dev *wimax_dev = NULL; | ||
91 | |||
92 | d_fnstart(3, NULL, "(info %p ifindex %d)\n", info, ifindex); | ||
93 | spin_lock(&wimax_id_table_lock); | ||
94 | list_for_each_entry(wimax_dev, &wimax_id_table, id_table_node) { | ||
95 | if (wimax_dev->net_dev->ifindex == ifindex) { | ||
96 | dev_hold(wimax_dev->net_dev); | ||
97 | break; | ||
98 | } | ||
99 | } | ||
100 | if (wimax_dev == NULL) | ||
101 | d_printf(1, NULL, "wimax: no devices found with ifindex %d\n", | ||
102 | ifindex); | ||
103 | spin_unlock(&wimax_id_table_lock); | ||
104 | d_fnend(3, NULL, "(info %p ifindex %d) = %p\n", | ||
105 | info, ifindex, wimax_dev); | ||
106 | return wimax_dev; | ||
107 | } | ||
108 | |||
109 | |||
110 | /* | ||
111 | * wimax_id_table_rm - Remove a gennetlink familiy ID / wimax_dev mapping | ||
112 | * | ||
113 | * @id: family ID to remove from the table | ||
114 | */ | ||
115 | void wimax_id_table_rm(struct wimax_dev *wimax_dev) | ||
116 | { | ||
117 | spin_lock(&wimax_id_table_lock); | ||
118 | list_del_init(&wimax_dev->id_table_node); | ||
119 | spin_unlock(&wimax_id_table_lock); | ||
120 | } | ||
121 | |||
122 | |||
123 | /* | ||
124 | * Release the gennetlink family id / mapping table | ||
125 | * | ||
126 | * On debug, verify that the table is empty upon removal. | ||
127 | */ | ||
128 | void wimax_id_table_release(void) | ||
129 | { | ||
130 | #ifndef CONFIG_BUG | ||
131 | return; | ||
132 | #endif | ||
133 | struct wimax_dev *wimax_dev; | ||
134 | |||
135 | spin_lock(&wimax_id_table_lock); | ||
136 | list_for_each_entry(wimax_dev, &wimax_id_table, id_table_node) { | ||
137 | printk(KERN_ERR "BUG: %s wimax_dev %p ifindex %d not cleared\n", | ||
138 | __func__, wimax_dev, wimax_dev->net_dev->ifindex); | ||
139 | WARN_ON(1); | ||
140 | } | ||
141 | spin_unlock(&wimax_id_table_lock); | ||
142 | } | ||
diff --git a/net/wimax/op-msg.c b/net/wimax/op-msg.c new file mode 100644 index 000000000000..cb3b4ad53683 --- /dev/null +++ b/net/wimax/op-msg.c | |||
@@ -0,0 +1,421 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Generic messaging interface between userspace and driver/device | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2007-2008 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * This implements a direct communication channel between user space and | ||
25 | * the driver/device, by which free form messages can be sent back and | ||
26 | * forth. | ||
27 | * | ||
28 | * This is intended for device-specific features, vendor quirks, etc. | ||
29 | * | ||
30 | * See include/net/wimax.h | ||
31 | * | ||
32 | * GENERIC NETLINK ENCODING AND CAPACITY | ||
33 | * | ||
34 | * A destination "pipe name" is added to each message; it is up to the | ||
35 | * drivers to assign or use those names (if using them at all). | ||
36 | * | ||
37 | * Messages are encoded as a binary netlink attribute using nla_put() | ||
38 | * using type NLA_UNSPEC (as some versions of libnl still in | ||
39 | * deployment don't yet understand NLA_BINARY). | ||
40 | * | ||
41 | * The maximum capacity of this transport is PAGESIZE per message (so | ||
42 | * the actual payload will be bit smaller depending on the | ||
43 | * netlink/generic netlink attributes and headers). | ||
44 | * | ||
45 | * RECEPTION OF MESSAGES | ||
46 | * | ||
47 | * When a message is received from user space, it is passed verbatim | ||
48 | * to the driver calling wimax_dev->op_msg_from_user(). The return | ||
49 | * value from this function is passed back to user space as an ack | ||
50 | * over the generic netlink protocol. | ||
51 | * | ||
52 | * The stack doesn't do any processing or interpretation of these | ||
53 | * messages. | ||
54 | * | ||
55 | * SENDING MESSAGES | ||
56 | * | ||
57 | * Messages can be sent with wimax_msg(). | ||
58 | * | ||
59 | * If the message delivery needs to happen on a different context to | ||
60 | * that of its creation, wimax_msg_alloc() can be used to get a | ||
61 | * pointer to the message that can be delivered later on with | ||
62 | * wimax_msg_send(). | ||
63 | * | ||
64 | * ROADMAP | ||
65 | * | ||
66 | * wimax_gnl_doit_msg_from_user() Process a message from user space | ||
67 | * wimax_dev_get_by_genl_info() | ||
68 | * wimax_dev->op_msg_from_user() Delivery of message to the driver | ||
69 | * | ||
70 | * wimax_msg() Send a message to user space | ||
71 | * wimax_msg_alloc() | ||
72 | * wimax_msg_send() | ||
73 | */ | ||
74 | #include <linux/device.h> | ||
75 | #include <net/genetlink.h> | ||
76 | #include <linux/netdevice.h> | ||
77 | #include <linux/wimax.h> | ||
78 | #include <linux/security.h> | ||
79 | #include "wimax-internal.h" | ||
80 | |||
81 | |||
82 | #define D_SUBMODULE op_msg | ||
83 | #include "debug-levels.h" | ||
84 | |||
85 | |||
86 | /** | ||
87 | * wimax_msg_alloc - Create a new skb for sending a message to userspace | ||
88 | * | ||
89 | * @wimax_dev: WiMAX device descriptor | ||
90 | * @pipe_name: "named pipe" the message will be sent to | ||
91 | * @msg: pointer to the message data to send | ||
92 | * @size: size of the message to send (in bytes), including the header. | ||
93 | * @gfp_flags: flags for memory allocation. | ||
94 | * | ||
95 | * Returns: %0 if ok, negative errno code on error | ||
96 | * | ||
97 | * Description: | ||
98 | * | ||
99 | * Allocates an skb that will contain the message to send to user | ||
100 | * space over the messaging pipe and initializes it, copying the | ||
101 | * payload. | ||
102 | * | ||
103 | * Once this call is done, you can deliver it with | ||
104 | * wimax_msg_send(). | ||
105 | * | ||
106 | * IMPORTANT: | ||
107 | * | ||
108 | * Don't use skb_push()/skb_pull()/skb_reserve() on the skb, as | ||
109 | * wimax_msg_send() depends on skb->data being placed at the | ||
110 | * beginning of the user message. | ||
111 | */ | ||
112 | struct sk_buff *wimax_msg_alloc(struct wimax_dev *wimax_dev, | ||
113 | const char *pipe_name, | ||
114 | const void *msg, size_t size, | ||
115 | gfp_t gfp_flags) | ||
116 | { | ||
117 | int result; | ||
118 | struct device *dev = wimax_dev->net_dev->dev.parent; | ||
119 | size_t msg_size; | ||
120 | void *genl_msg; | ||
121 | struct sk_buff *skb; | ||
122 | |||
123 | msg_size = nla_total_size(size) | ||
124 | + nla_total_size(sizeof(u32)) | ||
125 | + (pipe_name ? nla_total_size(strlen(pipe_name)) : 0); | ||
126 | result = -ENOMEM; | ||
127 | skb = genlmsg_new(msg_size, gfp_flags); | ||
128 | if (skb == NULL) | ||
129 | goto error_new; | ||
130 | genl_msg = genlmsg_put(skb, 0, 0, &wimax_gnl_family, | ||
131 | 0, WIMAX_GNL_OP_MSG_TO_USER); | ||
132 | if (genl_msg == NULL) { | ||
133 | dev_err(dev, "no memory to create generic netlink message\n"); | ||
134 | goto error_genlmsg_put; | ||
135 | } | ||
136 | result = nla_put_u32(skb, WIMAX_GNL_MSG_IFIDX, | ||
137 | wimax_dev->net_dev->ifindex); | ||
138 | if (result < 0) { | ||
139 | dev_err(dev, "no memory to add ifindex attribute\n"); | ||
140 | goto error_nla_put; | ||
141 | } | ||
142 | if (pipe_name) { | ||
143 | result = nla_put_string(skb, WIMAX_GNL_MSG_PIPE_NAME, | ||
144 | pipe_name); | ||
145 | if (result < 0) { | ||
146 | dev_err(dev, "no memory to add pipe_name attribute\n"); | ||
147 | goto error_nla_put; | ||
148 | } | ||
149 | } | ||
150 | result = nla_put(skb, WIMAX_GNL_MSG_DATA, size, msg); | ||
151 | if (result < 0) { | ||
152 | dev_err(dev, "no memory to add payload in attribute\n"); | ||
153 | goto error_nla_put; | ||
154 | } | ||
155 | genlmsg_end(skb, genl_msg); | ||
156 | return skb; | ||
157 | |||
158 | error_nla_put: | ||
159 | error_genlmsg_put: | ||
160 | error_new: | ||
161 | nlmsg_free(skb); | ||
162 | return ERR_PTR(result); | ||
163 | |||
164 | } | ||
165 | EXPORT_SYMBOL_GPL(wimax_msg_alloc); | ||
166 | |||
167 | |||
168 | /** | ||
169 | * wimax_msg_data_len - Return a pointer and size of a message's payload | ||
170 | * | ||
171 | * @msg: Pointer to a message created with wimax_msg_alloc() | ||
172 | * @size: Pointer to where to store the message's size | ||
173 | * | ||
174 | * Returns the pointer to the message data. | ||
175 | */ | ||
176 | const void *wimax_msg_data_len(struct sk_buff *msg, size_t *size) | ||
177 | { | ||
178 | struct nlmsghdr *nlh = (void *) msg->head; | ||
179 | struct nlattr *nla; | ||
180 | |||
181 | nla = nlmsg_find_attr(nlh, sizeof(struct genlmsghdr), | ||
182 | WIMAX_GNL_MSG_DATA); | ||
183 | if (nla == NULL) { | ||
184 | printk(KERN_ERR "Cannot find attribute WIMAX_GNL_MSG_DATA\n"); | ||
185 | return NULL; | ||
186 | } | ||
187 | *size = nla_len(nla); | ||
188 | return nla_data(nla); | ||
189 | } | ||
190 | EXPORT_SYMBOL_GPL(wimax_msg_data_len); | ||
191 | |||
192 | |||
193 | /** | ||
194 | * wimax_msg_data - Return a pointer to a message's payload | ||
195 | * | ||
196 | * @msg: Pointer to a message created with wimax_msg_alloc() | ||
197 | */ | ||
198 | const void *wimax_msg_data(struct sk_buff *msg) | ||
199 | { | ||
200 | struct nlmsghdr *nlh = (void *) msg->head; | ||
201 | struct nlattr *nla; | ||
202 | |||
203 | nla = nlmsg_find_attr(nlh, sizeof(struct genlmsghdr), | ||
204 | WIMAX_GNL_MSG_DATA); | ||
205 | if (nla == NULL) { | ||
206 | printk(KERN_ERR "Cannot find attribute WIMAX_GNL_MSG_DATA\n"); | ||
207 | return NULL; | ||
208 | } | ||
209 | return nla_data(nla); | ||
210 | } | ||
211 | EXPORT_SYMBOL_GPL(wimax_msg_data); | ||
212 | |||
213 | |||
214 | /** | ||
215 | * wimax_msg_len - Return a message's payload length | ||
216 | * | ||
217 | * @msg: Pointer to a message created with wimax_msg_alloc() | ||
218 | */ | ||
219 | ssize_t wimax_msg_len(struct sk_buff *msg) | ||
220 | { | ||
221 | struct nlmsghdr *nlh = (void *) msg->head; | ||
222 | struct nlattr *nla; | ||
223 | |||
224 | nla = nlmsg_find_attr(nlh, sizeof(struct genlmsghdr), | ||
225 | WIMAX_GNL_MSG_DATA); | ||
226 | if (nla == NULL) { | ||
227 | printk(KERN_ERR "Cannot find attribute WIMAX_GNL_MSG_DATA\n"); | ||
228 | return -EINVAL; | ||
229 | } | ||
230 | return nla_len(nla); | ||
231 | } | ||
232 | EXPORT_SYMBOL_GPL(wimax_msg_len); | ||
233 | |||
234 | |||
235 | /** | ||
236 | * wimax_msg_send - Send a pre-allocated message to user space | ||
237 | * | ||
238 | * @wimax_dev: WiMAX device descriptor | ||
239 | * | ||
240 | * @skb: &struct sk_buff returned by wimax_msg_alloc(). Note the | ||
241 | * ownership of @skb is transferred to this function. | ||
242 | * | ||
243 | * Returns: 0 if ok, < 0 errno code on error | ||
244 | * | ||
245 | * Description: | ||
246 | * | ||
247 | * Sends a free-form message that was preallocated with | ||
248 | * wimax_msg_alloc() and filled up. | ||
249 | * | ||
250 | * Assumes that once you pass an skb to this function for sending, it | ||
251 | * owns it and will release it when done (on success). | ||
252 | * | ||
253 | * IMPORTANT: | ||
254 | * | ||
255 | * Don't use skb_push()/skb_pull()/skb_reserve() on the skb, as | ||
256 | * wimax_msg_send() depends on skb->data being placed at the | ||
257 | * beginning of the user message. | ||
258 | */ | ||
259 | int wimax_msg_send(struct wimax_dev *wimax_dev, struct sk_buff *skb) | ||
260 | { | ||
261 | int result; | ||
262 | struct device *dev = wimax_dev->net_dev->dev.parent; | ||
263 | void *msg = skb->data; | ||
264 | size_t size = skb->len; | ||
265 | might_sleep(); | ||
266 | |||
267 | d_printf(1, dev, "CTX: wimax msg, %zu bytes\n", size); | ||
268 | d_dump(2, dev, msg, size); | ||
269 | result = genlmsg_multicast(skb, 0, wimax_gnl_mcg.id, GFP_KERNEL); | ||
270 | d_printf(1, dev, "CTX: genl multicast result %d\n", result); | ||
271 | if (result == -ESRCH) /* Nobody connected, ignore it */ | ||
272 | result = 0; /* btw, the skb is freed already */ | ||
273 | return result; | ||
274 | } | ||
275 | EXPORT_SYMBOL_GPL(wimax_msg_send); | ||
276 | |||
277 | |||
278 | /** | ||
279 | * wimax_msg - Send a message to user space | ||
280 | * | ||
281 | * @wimax_dev: WiMAX device descriptor (properly referenced) | ||
282 | * @pipe_name: "named pipe" the message will be sent to | ||
283 | * @buf: pointer to the message to send. | ||
284 | * @size: size of the buffer pointed to by @buf (in bytes). | ||
285 | * @gfp_flags: flags for memory allocation. | ||
286 | * | ||
287 | * Returns: %0 if ok, negative errno code on error. | ||
288 | * | ||
289 | * Description: | ||
290 | * | ||
291 | * Sends a free-form message to user space on the device @wimax_dev. | ||
292 | * | ||
293 | * NOTES: | ||
294 | * | ||
295 | * Once the @skb is given to this function, who will own it and will | ||
296 | * release it when done (unless it returns error). | ||
297 | */ | ||
298 | int wimax_msg(struct wimax_dev *wimax_dev, const char *pipe_name, | ||
299 | const void *buf, size_t size, gfp_t gfp_flags) | ||
300 | { | ||
301 | int result = -ENOMEM; | ||
302 | struct sk_buff *skb; | ||
303 | |||
304 | skb = wimax_msg_alloc(wimax_dev, pipe_name, buf, size, gfp_flags); | ||
305 | if (skb == NULL) | ||
306 | goto error_msg_new; | ||
307 | result = wimax_msg_send(wimax_dev, skb); | ||
308 | error_msg_new: | ||
309 | return result; | ||
310 | } | ||
311 | EXPORT_SYMBOL_GPL(wimax_msg); | ||
312 | |||
313 | |||
314 | static const | ||
315 | struct nla_policy wimax_gnl_msg_policy[WIMAX_GNL_ATTR_MAX + 1] = { | ||
316 | [WIMAX_GNL_MSG_IFIDX] = { | ||
317 | .type = NLA_U32, | ||
318 | }, | ||
319 | [WIMAX_GNL_MSG_DATA] = { | ||
320 | .type = NLA_UNSPEC, /* libnl doesn't grok BINARY yet */ | ||
321 | }, | ||
322 | }; | ||
323 | |||
324 | |||
325 | /* | ||
326 | * Relays a message from user space to the driver | ||
327 | * | ||
328 | * The skb is passed to the driver-specific function with the netlink | ||
329 | * and generic netlink headers already stripped. | ||
330 | * | ||
331 | * This call will block while handling/relaying the message. | ||
332 | */ | ||
333 | static | ||
334 | int wimax_gnl_doit_msg_from_user(struct sk_buff *skb, struct genl_info *info) | ||
335 | { | ||
336 | int result, ifindex; | ||
337 | struct wimax_dev *wimax_dev; | ||
338 | struct device *dev; | ||
339 | struct nlmsghdr *nlh = info->nlhdr; | ||
340 | char *pipe_name; | ||
341 | void *msg_buf; | ||
342 | size_t msg_len; | ||
343 | |||
344 | might_sleep(); | ||
345 | d_fnstart(3, NULL, "(skb %p info %p)\n", skb, info); | ||
346 | result = -ENODEV; | ||
347 | if (info->attrs[WIMAX_GNL_MSG_IFIDX] == NULL) { | ||
348 | printk(KERN_ERR "WIMAX_GNL_MSG_FROM_USER: can't find IFIDX " | ||
349 | "attribute\n"); | ||
350 | goto error_no_wimax_dev; | ||
351 | } | ||
352 | ifindex = nla_get_u32(info->attrs[WIMAX_GNL_MSG_IFIDX]); | ||
353 | wimax_dev = wimax_dev_get_by_genl_info(info, ifindex); | ||
354 | if (wimax_dev == NULL) | ||
355 | goto error_no_wimax_dev; | ||
356 | dev = wimax_dev_to_dev(wimax_dev); | ||
357 | |||
358 | /* Unpack arguments */ | ||
359 | result = -EINVAL; | ||
360 | if (info->attrs[WIMAX_GNL_MSG_DATA] == NULL) { | ||
361 | dev_err(dev, "WIMAX_GNL_MSG_FROM_USER: can't find MSG_DATA " | ||
362 | "attribute\n"); | ||
363 | goto error_no_data; | ||
364 | } | ||
365 | msg_buf = nla_data(info->attrs[WIMAX_GNL_MSG_DATA]); | ||
366 | msg_len = nla_len(info->attrs[WIMAX_GNL_MSG_DATA]); | ||
367 | |||
368 | if (info->attrs[WIMAX_GNL_MSG_PIPE_NAME] == NULL) | ||
369 | pipe_name = NULL; | ||
370 | else { | ||
371 | struct nlattr *attr = info->attrs[WIMAX_GNL_MSG_PIPE_NAME]; | ||
372 | size_t attr_len = nla_len(attr); | ||
373 | /* libnl-1.1 does not yet support NLA_NUL_STRING */ | ||
374 | result = -ENOMEM; | ||
375 | pipe_name = kstrndup(nla_data(attr), attr_len + 1, GFP_KERNEL); | ||
376 | if (pipe_name == NULL) | ||
377 | goto error_alloc; | ||
378 | pipe_name[attr_len] = 0; | ||
379 | } | ||
380 | mutex_lock(&wimax_dev->mutex); | ||
381 | result = wimax_dev_is_ready(wimax_dev); | ||
382 | if (result < 0) | ||
383 | goto error_not_ready; | ||
384 | result = -ENOSYS; | ||
385 | if (wimax_dev->op_msg_from_user == NULL) | ||
386 | goto error_noop; | ||
387 | |||
388 | d_printf(1, dev, | ||
389 | "CRX: nlmsghdr len %u type %u flags 0x%04x seq 0x%x pid %u\n", | ||
390 | nlh->nlmsg_len, nlh->nlmsg_type, nlh->nlmsg_flags, | ||
391 | nlh->nlmsg_seq, nlh->nlmsg_pid); | ||
392 | d_printf(1, dev, "CRX: wimax message %zu bytes\n", msg_len); | ||
393 | d_dump(2, dev, msg_buf, msg_len); | ||
394 | |||
395 | result = wimax_dev->op_msg_from_user(wimax_dev, pipe_name, | ||
396 | msg_buf, msg_len, info); | ||
397 | error_noop: | ||
398 | error_not_ready: | ||
399 | mutex_unlock(&wimax_dev->mutex); | ||
400 | error_alloc: | ||
401 | kfree(pipe_name); | ||
402 | error_no_data: | ||
403 | dev_put(wimax_dev->net_dev); | ||
404 | error_no_wimax_dev: | ||
405 | d_fnend(3, NULL, "(skb %p info %p) = %d\n", skb, info, result); | ||
406 | return result; | ||
407 | } | ||
408 | |||
409 | |||
410 | /* | ||
411 | * Generic Netlink glue | ||
412 | */ | ||
413 | |||
414 | struct genl_ops wimax_gnl_msg_from_user = { | ||
415 | .cmd = WIMAX_GNL_OP_MSG_FROM_USER, | ||
416 | .flags = GENL_ADMIN_PERM, | ||
417 | .policy = wimax_gnl_msg_policy, | ||
418 | .doit = wimax_gnl_doit_msg_from_user, | ||
419 | .dumpit = NULL, | ||
420 | }; | ||
421 | |||
diff --git a/net/wimax/op-reset.c b/net/wimax/op-reset.c new file mode 100644 index 000000000000..ca269178c4d4 --- /dev/null +++ b/net/wimax/op-reset.c | |||
@@ -0,0 +1,143 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Implement and export a method for resetting a WiMAX device | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2008 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * This implements a simple synchronous call to reset a WiMAX device. | ||
25 | * | ||
26 | * Resets aim at being warm, keeping the device handles active; | ||
27 | * however, when that fails, it falls back to a cold reset (that will | ||
28 | * disconnect and reconnect the device). | ||
29 | */ | ||
30 | |||
31 | #include <net/wimax.h> | ||
32 | #include <net/genetlink.h> | ||
33 | #include <linux/wimax.h> | ||
34 | #include <linux/security.h> | ||
35 | #include "wimax-internal.h" | ||
36 | |||
37 | #define D_SUBMODULE op_reset | ||
38 | #include "debug-levels.h" | ||
39 | |||
40 | |||
41 | /** | ||
42 | * wimax_reset - Reset a WiMAX device | ||
43 | * | ||
44 | * @wimax_dev: WiMAX device descriptor | ||
45 | * | ||
46 | * Returns: | ||
47 | * | ||
48 | * %0 if ok and a warm reset was done (the device still exists in | ||
49 | * the system). | ||
50 | * | ||
51 | * -%ENODEV if a cold/bus reset had to be done (device has | ||
52 | * disconnected and reconnected, so current handle is not valid | ||
53 | * any more). | ||
54 | * | ||
55 | * -%EINVAL if the device is not even registered. | ||
56 | * | ||
57 | * Any other negative error code shall be considered as | ||
58 | * non-recoverable. | ||
59 | * | ||
60 | * Description: | ||
61 | * | ||
62 | * Called when wanting to reset the device for any reason. Device is | ||
63 | * taken back to power on status. | ||
64 | * | ||
65 | * This call blocks; on succesful return, the device has completed the | ||
66 | * reset process and is ready to operate. | ||
67 | */ | ||
68 | int wimax_reset(struct wimax_dev *wimax_dev) | ||
69 | { | ||
70 | int result = -EINVAL; | ||
71 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
72 | enum wimax_st state; | ||
73 | |||
74 | might_sleep(); | ||
75 | d_fnstart(3, dev, "(wimax_dev %p)\n", wimax_dev); | ||
76 | mutex_lock(&wimax_dev->mutex); | ||
77 | dev_hold(wimax_dev->net_dev); | ||
78 | state = wimax_dev->state; | ||
79 | mutex_unlock(&wimax_dev->mutex); | ||
80 | |||
81 | if (state >= WIMAX_ST_DOWN) { | ||
82 | mutex_lock(&wimax_dev->mutex_reset); | ||
83 | result = wimax_dev->op_reset(wimax_dev); | ||
84 | mutex_unlock(&wimax_dev->mutex_reset); | ||
85 | } | ||
86 | dev_put(wimax_dev->net_dev); | ||
87 | |||
88 | d_fnend(3, dev, "(wimax_dev %p) = %d\n", wimax_dev, result); | ||
89 | return result; | ||
90 | } | ||
91 | EXPORT_SYMBOL(wimax_reset); | ||
92 | |||
93 | |||
94 | static const | ||
95 | struct nla_policy wimax_gnl_reset_policy[WIMAX_GNL_ATTR_MAX + 1] = { | ||
96 | [WIMAX_GNL_RESET_IFIDX] = { | ||
97 | .type = NLA_U32, | ||
98 | }, | ||
99 | }; | ||
100 | |||
101 | |||
102 | /* | ||
103 | * Exporting to user space over generic netlink | ||
104 | * | ||
105 | * Parse the reset command from user space, return error code. | ||
106 | * | ||
107 | * No attributes. | ||
108 | */ | ||
109 | static | ||
110 | int wimax_gnl_doit_reset(struct sk_buff *skb, struct genl_info *info) | ||
111 | { | ||
112 | int result, ifindex; | ||
113 | struct wimax_dev *wimax_dev; | ||
114 | struct device *dev; | ||
115 | |||
116 | d_fnstart(3, NULL, "(skb %p info %p)\n", skb, info); | ||
117 | result = -ENODEV; | ||
118 | if (info->attrs[WIMAX_GNL_RESET_IFIDX] == NULL) { | ||
119 | printk(KERN_ERR "WIMAX_GNL_OP_RFKILL: can't find IFIDX " | ||
120 | "attribute\n"); | ||
121 | goto error_no_wimax_dev; | ||
122 | } | ||
123 | ifindex = nla_get_u32(info->attrs[WIMAX_GNL_RESET_IFIDX]); | ||
124 | wimax_dev = wimax_dev_get_by_genl_info(info, ifindex); | ||
125 | if (wimax_dev == NULL) | ||
126 | goto error_no_wimax_dev; | ||
127 | dev = wimax_dev_to_dev(wimax_dev); | ||
128 | /* Execute the operation and send the result back to user space */ | ||
129 | result = wimax_reset(wimax_dev); | ||
130 | dev_put(wimax_dev->net_dev); | ||
131 | error_no_wimax_dev: | ||
132 | d_fnend(3, NULL, "(skb %p info %p) = %d\n", skb, info, result); | ||
133 | return result; | ||
134 | } | ||
135 | |||
136 | |||
137 | struct genl_ops wimax_gnl_reset = { | ||
138 | .cmd = WIMAX_GNL_OP_RESET, | ||
139 | .flags = GENL_ADMIN_PERM, | ||
140 | .policy = wimax_gnl_reset_policy, | ||
141 | .doit = wimax_gnl_doit_reset, | ||
142 | .dumpit = NULL, | ||
143 | }; | ||
diff --git a/net/wimax/op-rfkill.c b/net/wimax/op-rfkill.c new file mode 100644 index 000000000000..8745bac173f1 --- /dev/null +++ b/net/wimax/op-rfkill.c | |||
@@ -0,0 +1,532 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * RF-kill framework integration | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2008 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * This integrates into the Linux Kernel rfkill susbystem so that the | ||
25 | * drivers just have to do the bare minimal work, which is providing a | ||
26 | * method to set the software RF-Kill switch and to report changes in | ||
27 | * the software and hardware switch status. | ||
28 | * | ||
29 | * A non-polled generic rfkill device is embedded into the WiMAX | ||
30 | * subsystem's representation of a device. | ||
31 | * | ||
32 | * FIXME: Need polled support? use a timer or add the implementation | ||
33 | * to the stack. | ||
34 | * | ||
35 | * All device drivers have to do is after wimax_dev_init(), call | ||
36 | * wimax_report_rfkill_hw() and wimax_report_rfkill_sw() to update | ||
37 | * initial state and then every time it changes. See wimax.h:struct | ||
38 | * wimax_dev for more information. | ||
39 | * | ||
40 | * ROADMAP | ||
41 | * | ||
42 | * wimax_gnl_doit_rfkill() User space calling wimax_rfkill() | ||
43 | * wimax_rfkill() Kernel calling wimax_rfkill() | ||
44 | * __wimax_rf_toggle_radio() | ||
45 | * | ||
46 | * wimax_rfkill_toggle_radio() RF-Kill subsytem calling | ||
47 | * __wimax_rf_toggle_radio() | ||
48 | * | ||
49 | * __wimax_rf_toggle_radio() | ||
50 | * wimax_dev->op_rfkill_sw_toggle() Driver backend | ||
51 | * __wimax_state_change() | ||
52 | * | ||
53 | * wimax_report_rfkill_sw() Driver reports state change | ||
54 | * __wimax_state_change() | ||
55 | * | ||
56 | * wimax_report_rfkill_hw() Driver reports state change | ||
57 | * __wimax_state_change() | ||
58 | * | ||
59 | * wimax_rfkill_add() Initialize/shutdown rfkill support | ||
60 | * wimax_rfkill_rm() [called by wimax_dev_add/rm()] | ||
61 | */ | ||
62 | |||
63 | #include <net/wimax.h> | ||
64 | #include <net/genetlink.h> | ||
65 | #include <linux/wimax.h> | ||
66 | #include <linux/security.h> | ||
67 | #include <linux/rfkill.h> | ||
68 | #include <linux/input.h> | ||
69 | #include "wimax-internal.h" | ||
70 | |||
71 | #define D_SUBMODULE op_rfkill | ||
72 | #include "debug-levels.h" | ||
73 | |||
74 | #ifdef CONFIG_RFKILL | ||
75 | |||
76 | |||
77 | /** | ||
78 | * wimax_report_rfkill_hw - Reports changes in the hardware RF switch | ||
79 | * | ||
80 | * @wimax_dev: WiMAX device descriptor | ||
81 | * | ||
82 | * @state: New state of the RF Kill switch. %WIMAX_RF_ON radio on, | ||
83 | * %WIMAX_RF_OFF radio off. | ||
84 | * | ||
85 | * When the device detects a change in the state of thehardware RF | ||
86 | * switch, it must call this function to let the WiMAX kernel stack | ||
87 | * know that the state has changed so it can be properly propagated. | ||
88 | * | ||
89 | * The WiMAX stack caches the state (the driver doesn't need to). As | ||
90 | * well, as the change is propagated it will come back as a request to | ||
91 | * change the software state to mirror the hardware state. | ||
92 | * | ||
93 | * If the device doesn't have a hardware kill switch, just report | ||
94 | * it on initialization as always on (%WIMAX_RF_ON, radio on). | ||
95 | */ | ||
96 | void wimax_report_rfkill_hw(struct wimax_dev *wimax_dev, | ||
97 | enum wimax_rf_state state) | ||
98 | { | ||
99 | int result; | ||
100 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
101 | enum wimax_st wimax_state; | ||
102 | enum rfkill_state rfkill_state; | ||
103 | |||
104 | d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state); | ||
105 | BUG_ON(state == WIMAX_RF_QUERY); | ||
106 | BUG_ON(state != WIMAX_RF_ON && state != WIMAX_RF_OFF); | ||
107 | |||
108 | mutex_lock(&wimax_dev->mutex); | ||
109 | result = wimax_dev_is_ready(wimax_dev); | ||
110 | if (result < 0) | ||
111 | goto error_not_ready; | ||
112 | |||
113 | if (state != wimax_dev->rf_hw) { | ||
114 | wimax_dev->rf_hw = state; | ||
115 | rfkill_state = state == WIMAX_RF_ON ? | ||
116 | RFKILL_STATE_OFF : RFKILL_STATE_ON; | ||
117 | if (wimax_dev->rf_hw == WIMAX_RF_ON | ||
118 | && wimax_dev->rf_sw == WIMAX_RF_ON) | ||
119 | wimax_state = WIMAX_ST_READY; | ||
120 | else | ||
121 | wimax_state = WIMAX_ST_RADIO_OFF; | ||
122 | __wimax_state_change(wimax_dev, wimax_state); | ||
123 | input_report_key(wimax_dev->rfkill_input, KEY_WIMAX, | ||
124 | rfkill_state); | ||
125 | } | ||
126 | error_not_ready: | ||
127 | mutex_unlock(&wimax_dev->mutex); | ||
128 | d_fnend(3, dev, "(wimax_dev %p state %u) = void [%d]\n", | ||
129 | wimax_dev, state, result); | ||
130 | } | ||
131 | EXPORT_SYMBOL_GPL(wimax_report_rfkill_hw); | ||
132 | |||
133 | |||
134 | /** | ||
135 | * wimax_report_rfkill_sw - Reports changes in the software RF switch | ||
136 | * | ||
137 | * @wimax_dev: WiMAX device descriptor | ||
138 | * | ||
139 | * @state: New state of the RF kill switch. %WIMAX_RF_ON radio on, | ||
140 | * %WIMAX_RF_OFF radio off. | ||
141 | * | ||
142 | * Reports changes in the software RF switch state to the the WiMAX | ||
143 | * stack. | ||
144 | * | ||
145 | * The main use is during initialization, so the driver can query the | ||
146 | * device for its current software radio kill switch state and feed it | ||
147 | * to the system. | ||
148 | * | ||
149 | * On the side, the device does not change the software state by | ||
150 | * itself. In practice, this can happen, as the device might decide to | ||
151 | * switch (in software) the radio off for different reasons. | ||
152 | */ | ||
153 | void wimax_report_rfkill_sw(struct wimax_dev *wimax_dev, | ||
154 | enum wimax_rf_state state) | ||
155 | { | ||
156 | int result; | ||
157 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
158 | enum wimax_st wimax_state; | ||
159 | |||
160 | d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state); | ||
161 | BUG_ON(state == WIMAX_RF_QUERY); | ||
162 | BUG_ON(state != WIMAX_RF_ON && state != WIMAX_RF_OFF); | ||
163 | |||
164 | mutex_lock(&wimax_dev->mutex); | ||
165 | result = wimax_dev_is_ready(wimax_dev); | ||
166 | if (result < 0) | ||
167 | goto error_not_ready; | ||
168 | |||
169 | if (state != wimax_dev->rf_sw) { | ||
170 | wimax_dev->rf_sw = state; | ||
171 | if (wimax_dev->rf_hw == WIMAX_RF_ON | ||
172 | && wimax_dev->rf_sw == WIMAX_RF_ON) | ||
173 | wimax_state = WIMAX_ST_READY; | ||
174 | else | ||
175 | wimax_state = WIMAX_ST_RADIO_OFF; | ||
176 | __wimax_state_change(wimax_dev, wimax_state); | ||
177 | } | ||
178 | error_not_ready: | ||
179 | mutex_unlock(&wimax_dev->mutex); | ||
180 | d_fnend(3, dev, "(wimax_dev %p state %u) = void [%d]\n", | ||
181 | wimax_dev, state, result); | ||
182 | } | ||
183 | EXPORT_SYMBOL_GPL(wimax_report_rfkill_sw); | ||
184 | |||
185 | |||
186 | /* | ||
187 | * Callback for the RF Kill toggle operation | ||
188 | * | ||
189 | * This function is called by: | ||
190 | * | ||
191 | * - The rfkill subsystem when the RF-Kill key is pressed in the | ||
192 | * hardware and the driver notifies through | ||
193 | * wimax_report_rfkill_hw(). The rfkill subsystem ends up calling back | ||
194 | * here so the software RF Kill switch state is changed to reflect | ||
195 | * the hardware switch state. | ||
196 | * | ||
197 | * - When the user sets the state through sysfs' rfkill/state file | ||
198 | * | ||
199 | * - When the user calls wimax_rfkill(). | ||
200 | * | ||
201 | * This call blocks! | ||
202 | * | ||
203 | * WARNING! When we call rfkill_unregister(), this will be called with | ||
204 | * state 0! | ||
205 | * | ||
206 | * WARNING: wimax_dev must be locked | ||
207 | */ | ||
208 | static | ||
209 | int __wimax_rf_toggle_radio(struct wimax_dev *wimax_dev, | ||
210 | enum wimax_rf_state state) | ||
211 | { | ||
212 | int result = 0; | ||
213 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
214 | enum wimax_st wimax_state; | ||
215 | |||
216 | might_sleep(); | ||
217 | d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state); | ||
218 | if (wimax_dev->rf_sw == state) | ||
219 | goto out_no_change; | ||
220 | if (wimax_dev->op_rfkill_sw_toggle != NULL) | ||
221 | result = wimax_dev->op_rfkill_sw_toggle(wimax_dev, state); | ||
222 | else if (state == WIMAX_RF_OFF) /* No op? can't turn off */ | ||
223 | result = -ENXIO; | ||
224 | else /* No op? can turn on */ | ||
225 | result = 0; /* should never happen tho */ | ||
226 | if (result >= 0) { | ||
227 | result = 0; | ||
228 | wimax_dev->rf_sw = state; | ||
229 | wimax_state = state == WIMAX_RF_ON ? | ||
230 | WIMAX_ST_READY : WIMAX_ST_RADIO_OFF; | ||
231 | __wimax_state_change(wimax_dev, wimax_state); | ||
232 | } | ||
233 | out_no_change: | ||
234 | d_fnend(3, dev, "(wimax_dev %p state %u) = %d\n", | ||
235 | wimax_dev, state, result); | ||
236 | return result; | ||
237 | } | ||
238 | |||
239 | |||
240 | /* | ||
241 | * Translate from rfkill state to wimax state | ||
242 | * | ||
243 | * NOTE: Special state handling rules here | ||
244 | * | ||
245 | * Just pretend the call didn't happen if we are in a state where | ||
246 | * we know for sure it cannot be handled (WIMAX_ST_DOWN or | ||
247 | * __WIMAX_ST_QUIESCING). rfkill() needs it to register and | ||
248 | * unregister, as it will run this path. | ||
249 | * | ||
250 | * NOTE: This call will block until the operation is completed. | ||
251 | */ | ||
252 | static | ||
253 | int wimax_rfkill_toggle_radio(void *data, enum rfkill_state state) | ||
254 | { | ||
255 | int result; | ||
256 | struct wimax_dev *wimax_dev = data; | ||
257 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
258 | enum wimax_rf_state rf_state; | ||
259 | |||
260 | d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state); | ||
261 | switch (state) { | ||
262 | case RFKILL_STATE_ON: | ||
263 | rf_state = WIMAX_RF_OFF; | ||
264 | break; | ||
265 | case RFKILL_STATE_OFF: | ||
266 | rf_state = WIMAX_RF_ON; | ||
267 | break; | ||
268 | default: | ||
269 | BUG(); | ||
270 | } | ||
271 | mutex_lock(&wimax_dev->mutex); | ||
272 | if (wimax_dev->state <= __WIMAX_ST_QUIESCING) | ||
273 | result = 0; /* just pretend it didn't happen */ | ||
274 | else | ||
275 | result = __wimax_rf_toggle_radio(wimax_dev, rf_state); | ||
276 | mutex_unlock(&wimax_dev->mutex); | ||
277 | d_fnend(3, dev, "(wimax_dev %p state %u) = %d\n", | ||
278 | wimax_dev, state, result); | ||
279 | return result; | ||
280 | } | ||
281 | |||
282 | |||
283 | /** | ||
284 | * wimax_rfkill - Set the software RF switch state for a WiMAX device | ||
285 | * | ||
286 | * @wimax_dev: WiMAX device descriptor | ||
287 | * | ||
288 | * @state: New RF state. | ||
289 | * | ||
290 | * Returns: | ||
291 | * | ||
292 | * >= 0 toggle state if ok, < 0 errno code on error. The toggle state | ||
293 | * is returned as a bitmap, bit 0 being the hardware RF state, bit 1 | ||
294 | * the software RF state. | ||
295 | * | ||
296 | * 0 means disabled (%WIMAX_RF_ON, radio on), 1 means enabled radio | ||
297 | * off (%WIMAX_RF_OFF). | ||
298 | * | ||
299 | * Description: | ||
300 | * | ||
301 | * Called by the user when he wants to request the WiMAX radio to be | ||
302 | * switched on (%WIMAX_RF_ON) or off (%WIMAX_RF_OFF). With | ||
303 | * %WIMAX_RF_QUERY, just the current state is returned. | ||
304 | * | ||
305 | * NOTE: | ||
306 | * | ||
307 | * This call will block until the operation is complete. | ||
308 | */ | ||
309 | int wimax_rfkill(struct wimax_dev *wimax_dev, enum wimax_rf_state state) | ||
310 | { | ||
311 | int result; | ||
312 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
313 | |||
314 | d_fnstart(3, dev, "(wimax_dev %p state %u)\n", wimax_dev, state); | ||
315 | mutex_lock(&wimax_dev->mutex); | ||
316 | result = wimax_dev_is_ready(wimax_dev); | ||
317 | if (result < 0) | ||
318 | goto error_not_ready; | ||
319 | switch (state) { | ||
320 | case WIMAX_RF_ON: | ||
321 | case WIMAX_RF_OFF: | ||
322 | result = __wimax_rf_toggle_radio(wimax_dev, state); | ||
323 | if (result < 0) | ||
324 | goto error; | ||
325 | break; | ||
326 | case WIMAX_RF_QUERY: | ||
327 | break; | ||
328 | default: | ||
329 | result = -EINVAL; | ||
330 | goto error; | ||
331 | } | ||
332 | result = wimax_dev->rf_sw << 1 | wimax_dev->rf_hw; | ||
333 | error: | ||
334 | error_not_ready: | ||
335 | mutex_unlock(&wimax_dev->mutex); | ||
336 | d_fnend(3, dev, "(wimax_dev %p state %u) = %d\n", | ||
337 | wimax_dev, state, result); | ||
338 | return result; | ||
339 | } | ||
340 | EXPORT_SYMBOL(wimax_rfkill); | ||
341 | |||
342 | |||
343 | /* | ||
344 | * Register a new WiMAX device's RF Kill support | ||
345 | * | ||
346 | * WARNING: wimax_dev->mutex must be unlocked | ||
347 | */ | ||
348 | int wimax_rfkill_add(struct wimax_dev *wimax_dev) | ||
349 | { | ||
350 | int result; | ||
351 | struct rfkill *rfkill; | ||
352 | struct input_dev *input_dev; | ||
353 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
354 | |||
355 | d_fnstart(3, dev, "(wimax_dev %p)\n", wimax_dev); | ||
356 | /* Initialize RF Kill */ | ||
357 | result = -ENOMEM; | ||
358 | rfkill = rfkill_allocate(dev, RFKILL_TYPE_WIMAX); | ||
359 | if (rfkill == NULL) | ||
360 | goto error_rfkill_allocate; | ||
361 | wimax_dev->rfkill = rfkill; | ||
362 | |||
363 | rfkill->name = wimax_dev->name; | ||
364 | rfkill->state = RFKILL_STATE_OFF; | ||
365 | rfkill->data = wimax_dev; | ||
366 | rfkill->toggle_radio = wimax_rfkill_toggle_radio; | ||
367 | rfkill->user_claim_unsupported = 1; | ||
368 | |||
369 | /* Initialize the input device for the hw key */ | ||
370 | input_dev = input_allocate_device(); | ||
371 | if (input_dev == NULL) | ||
372 | goto error_input_allocate; | ||
373 | wimax_dev->rfkill_input = input_dev; | ||
374 | d_printf(1, dev, "rfkill %p input %p\n", rfkill, input_dev); | ||
375 | |||
376 | input_dev->name = wimax_dev->name; | ||
377 | /* FIXME: get a real device bus ID and stuff? do we care? */ | ||
378 | input_dev->id.bustype = BUS_HOST; | ||
379 | input_dev->id.vendor = 0xffff; | ||
380 | input_dev->evbit[0] = BIT(EV_KEY); | ||
381 | set_bit(KEY_WIMAX, input_dev->keybit); | ||
382 | |||
383 | /* Register both */ | ||
384 | result = input_register_device(wimax_dev->rfkill_input); | ||
385 | if (result < 0) | ||
386 | goto error_input_register; | ||
387 | result = rfkill_register(wimax_dev->rfkill); | ||
388 | if (result < 0) | ||
389 | goto error_rfkill_register; | ||
390 | |||
391 | /* If there is no SW toggle op, SW RFKill is always on */ | ||
392 | if (wimax_dev->op_rfkill_sw_toggle == NULL) | ||
393 | wimax_dev->rf_sw = WIMAX_RF_ON; | ||
394 | |||
395 | d_fnend(3, dev, "(wimax_dev %p) = 0\n", wimax_dev); | ||
396 | return 0; | ||
397 | |||
398 | /* if rfkill_register() suceeds, can't use rfkill_free() any | ||
399 | * more, only rfkill_unregister() [it owns the refcount]; with | ||
400 | * the input device we have the same issue--hence the if. */ | ||
401 | error_rfkill_register: | ||
402 | input_unregister_device(wimax_dev->rfkill_input); | ||
403 | wimax_dev->rfkill_input = NULL; | ||
404 | error_input_register: | ||
405 | if (wimax_dev->rfkill_input) | ||
406 | input_free_device(wimax_dev->rfkill_input); | ||
407 | error_input_allocate: | ||
408 | rfkill_free(wimax_dev->rfkill); | ||
409 | error_rfkill_allocate: | ||
410 | d_fnend(3, dev, "(wimax_dev %p) = %d\n", wimax_dev, result); | ||
411 | return result; | ||
412 | } | ||
413 | |||
414 | |||
415 | /* | ||
416 | * Deregister a WiMAX device's RF Kill support | ||
417 | * | ||
418 | * Ick, we can't call rfkill_free() after rfkill_unregister()...oh | ||
419 | * well. | ||
420 | * | ||
421 | * WARNING: wimax_dev->mutex must be unlocked | ||
422 | */ | ||
423 | void wimax_rfkill_rm(struct wimax_dev *wimax_dev) | ||
424 | { | ||
425 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
426 | d_fnstart(3, dev, "(wimax_dev %p)\n", wimax_dev); | ||
427 | rfkill_unregister(wimax_dev->rfkill); /* frees */ | ||
428 | input_unregister_device(wimax_dev->rfkill_input); | ||
429 | d_fnend(3, dev, "(wimax_dev %p)\n", wimax_dev); | ||
430 | } | ||
431 | |||
432 | |||
433 | #else /* #ifdef CONFIG_RFKILL */ | ||
434 | |||
435 | void wimax_report_rfkill_hw(struct wimax_dev *wimax_dev, | ||
436 | enum wimax_rf_state state) | ||
437 | { | ||
438 | } | ||
439 | EXPORT_SYMBOL_GPL(wimax_report_rfkill_hw); | ||
440 | |||
441 | void wimax_report_rfkill_sw(struct wimax_dev *wimax_dev, | ||
442 | enum wimax_rf_state state) | ||
443 | { | ||
444 | } | ||
445 | EXPORT_SYMBOL_GPL(wimax_report_rfkill_sw); | ||
446 | |||
447 | int wimax_rfkill(struct wimax_dev *wimax_dev, | ||
448 | enum wimax_rf_state state) | ||
449 | { | ||
450 | return WIMAX_RF_ON << 1 | WIMAX_RF_ON; | ||
451 | } | ||
452 | EXPORT_SYMBOL_GPL(wimax_rfkill); | ||
453 | |||
454 | int wimax_rfkill_add(struct wimax_dev *wimax_dev) | ||
455 | { | ||
456 | return 0; | ||
457 | } | ||
458 | |||
459 | void wimax_rfkill_rm(struct wimax_dev *wimax_dev) | ||
460 | { | ||
461 | } | ||
462 | |||
463 | #endif /* #ifdef CONFIG_RFKILL */ | ||
464 | |||
465 | |||
466 | /* | ||
467 | * Exporting to user space over generic netlink | ||
468 | * | ||
469 | * Parse the rfkill command from user space, return a combination | ||
470 | * value that describe the states of the different toggles. | ||
471 | * | ||
472 | * Only one attribute: the new state requested (on, off or no change, | ||
473 | * just query). | ||
474 | */ | ||
475 | |||
476 | static const | ||
477 | struct nla_policy wimax_gnl_rfkill_policy[WIMAX_GNL_ATTR_MAX + 1] = { | ||
478 | [WIMAX_GNL_RFKILL_IFIDX] = { | ||
479 | .type = NLA_U32, | ||
480 | }, | ||
481 | [WIMAX_GNL_RFKILL_STATE] = { | ||
482 | .type = NLA_U32 /* enum wimax_rf_state */ | ||
483 | }, | ||
484 | }; | ||
485 | |||
486 | |||
487 | static | ||
488 | int wimax_gnl_doit_rfkill(struct sk_buff *skb, struct genl_info *info) | ||
489 | { | ||
490 | int result, ifindex; | ||
491 | struct wimax_dev *wimax_dev; | ||
492 | struct device *dev; | ||
493 | enum wimax_rf_state new_state; | ||
494 | |||
495 | d_fnstart(3, NULL, "(skb %p info %p)\n", skb, info); | ||
496 | result = -ENODEV; | ||
497 | if (info->attrs[WIMAX_GNL_RFKILL_IFIDX] == NULL) { | ||
498 | printk(KERN_ERR "WIMAX_GNL_OP_RFKILL: can't find IFIDX " | ||
499 | "attribute\n"); | ||
500 | goto error_no_wimax_dev; | ||
501 | } | ||
502 | ifindex = nla_get_u32(info->attrs[WIMAX_GNL_RFKILL_IFIDX]); | ||
503 | wimax_dev = wimax_dev_get_by_genl_info(info, ifindex); | ||
504 | if (wimax_dev == NULL) | ||
505 | goto error_no_wimax_dev; | ||
506 | dev = wimax_dev_to_dev(wimax_dev); | ||
507 | result = -EINVAL; | ||
508 | if (info->attrs[WIMAX_GNL_RFKILL_STATE] == NULL) { | ||
509 | dev_err(dev, "WIMAX_GNL_RFKILL: can't find RFKILL_STATE " | ||
510 | "attribute\n"); | ||
511 | goto error_no_pid; | ||
512 | } | ||
513 | new_state = nla_get_u32(info->attrs[WIMAX_GNL_RFKILL_STATE]); | ||
514 | |||
515 | /* Execute the operation and send the result back to user space */ | ||
516 | result = wimax_rfkill(wimax_dev, new_state); | ||
517 | error_no_pid: | ||
518 | dev_put(wimax_dev->net_dev); | ||
519 | error_no_wimax_dev: | ||
520 | d_fnend(3, NULL, "(skb %p info %p) = %d\n", skb, info, result); | ||
521 | return result; | ||
522 | } | ||
523 | |||
524 | |||
525 | struct genl_ops wimax_gnl_rfkill = { | ||
526 | .cmd = WIMAX_GNL_OP_RFKILL, | ||
527 | .flags = GENL_ADMIN_PERM, | ||
528 | .policy = wimax_gnl_rfkill_policy, | ||
529 | .doit = wimax_gnl_doit_rfkill, | ||
530 | .dumpit = NULL, | ||
531 | }; | ||
532 | |||
diff --git a/net/wimax/stack.c b/net/wimax/stack.c new file mode 100644 index 000000000000..d4da92f8981a --- /dev/null +++ b/net/wimax/stack.c | |||
@@ -0,0 +1,599 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Initialization, addition and removal of wimax devices | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2005-2006 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * This implements: | ||
25 | * | ||
26 | * - basic life cycle of 'struct wimax_dev' [wimax_dev_*()]; on | ||
27 | * addition/registration initialize all subfields and allocate | ||
28 | * generic netlink resources for user space communication. On | ||
29 | * removal/unregistration, undo all that. | ||
30 | * | ||
31 | * - device state machine [wimax_state_change()] and support to send | ||
32 | * reports to user space when the state changes | ||
33 | * [wimax_gnl_re_state_change*()]. | ||
34 | * | ||
35 | * See include/net/wimax.h for rationales and design. | ||
36 | * | ||
37 | * ROADMAP | ||
38 | * | ||
39 | * [__]wimax_state_change() Called by drivers to update device's state | ||
40 | * wimax_gnl_re_state_change_alloc() | ||
41 | * wimax_gnl_re_state_change_send() | ||
42 | * | ||
43 | * wimax_dev_init() Init a device | ||
44 | * wimax_dev_add() Register | ||
45 | * wimax_rfkill_add() | ||
46 | * wimax_gnl_add() Register all the generic netlink resources. | ||
47 | * wimax_id_table_add() | ||
48 | * wimax_dev_rm() Unregister | ||
49 | * wimax_id_table_rm() | ||
50 | * wimax_gnl_rm() | ||
51 | * wimax_rfkill_rm() | ||
52 | */ | ||
53 | #include <linux/device.h> | ||
54 | #include <net/genetlink.h> | ||
55 | #include <linux/netdevice.h> | ||
56 | #include <linux/wimax.h> | ||
57 | #include "wimax-internal.h" | ||
58 | |||
59 | |||
60 | #define D_SUBMODULE stack | ||
61 | #include "debug-levels.h" | ||
62 | |||
63 | /* | ||
64 | * Authoritative source for the RE_STATE_CHANGE attribute policy | ||
65 | * | ||
66 | * We don't really use it here, but /me likes to keep the definition | ||
67 | * close to where the data is generated. | ||
68 | */ | ||
69 | /* | ||
70 | static const | ||
71 | struct nla_policy wimax_gnl_re_status_change[WIMAX_GNL_ATTR_MAX + 1] = { | ||
72 | [WIMAX_GNL_STCH_STATE_OLD] = { .type = NLA_U8 }, | ||
73 | [WIMAX_GNL_STCH_STATE_NEW] = { .type = NLA_U8 }, | ||
74 | }; | ||
75 | */ | ||
76 | |||
77 | |||
78 | /* | ||
79 | * Allocate a Report State Change message | ||
80 | * | ||
81 | * @header: save it, you need it for _send() | ||
82 | * | ||
83 | * Creates and fills a basic state change message; different code | ||
84 | * paths can then add more attributes to the message as needed. | ||
85 | * | ||
86 | * Use wimax_gnl_re_state_change_send() to send the returned skb. | ||
87 | * | ||
88 | * Returns: skb with the genl message if ok, IS_ERR() ptr on error | ||
89 | * with an errno code. | ||
90 | */ | ||
91 | static | ||
92 | struct sk_buff *wimax_gnl_re_state_change_alloc( | ||
93 | struct wimax_dev *wimax_dev, | ||
94 | enum wimax_st new_state, enum wimax_st old_state, | ||
95 | void **header) | ||
96 | { | ||
97 | int result; | ||
98 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
99 | void *data; | ||
100 | struct sk_buff *report_skb; | ||
101 | |||
102 | d_fnstart(3, dev, "(wimax_dev %p new_state %u old_state %u)\n", | ||
103 | wimax_dev, new_state, old_state); | ||
104 | result = -ENOMEM; | ||
105 | report_skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); | ||
106 | if (report_skb == NULL) { | ||
107 | dev_err(dev, "RE_STCH: can't create message\n"); | ||
108 | goto error_new; | ||
109 | } | ||
110 | data = genlmsg_put(report_skb, 0, wimax_gnl_mcg.id, &wimax_gnl_family, | ||
111 | 0, WIMAX_GNL_RE_STATE_CHANGE); | ||
112 | if (data == NULL) { | ||
113 | dev_err(dev, "RE_STCH: can't put data into message\n"); | ||
114 | goto error_put; | ||
115 | } | ||
116 | *header = data; | ||
117 | |||
118 | result = nla_put_u8(report_skb, WIMAX_GNL_STCH_STATE_OLD, old_state); | ||
119 | if (result < 0) { | ||
120 | dev_err(dev, "RE_STCH: Error adding OLD attr: %d\n", result); | ||
121 | goto error_put; | ||
122 | } | ||
123 | result = nla_put_u8(report_skb, WIMAX_GNL_STCH_STATE_NEW, new_state); | ||
124 | if (result < 0) { | ||
125 | dev_err(dev, "RE_STCH: Error adding NEW attr: %d\n", result); | ||
126 | goto error_put; | ||
127 | } | ||
128 | result = nla_put_u32(report_skb, WIMAX_GNL_STCH_IFIDX, | ||
129 | wimax_dev->net_dev->ifindex); | ||
130 | if (result < 0) { | ||
131 | dev_err(dev, "RE_STCH: Error adding IFINDEX attribute\n"); | ||
132 | goto error_put; | ||
133 | } | ||
134 | d_fnend(3, dev, "(wimax_dev %p new_state %u old_state %u) = %p\n", | ||
135 | wimax_dev, new_state, old_state, report_skb); | ||
136 | return report_skb; | ||
137 | |||
138 | error_put: | ||
139 | nlmsg_free(report_skb); | ||
140 | error_new: | ||
141 | d_fnend(3, dev, "(wimax_dev %p new_state %u old_state %u) = %d\n", | ||
142 | wimax_dev, new_state, old_state, result); | ||
143 | return ERR_PTR(result); | ||
144 | } | ||
145 | |||
146 | |||
147 | /* | ||
148 | * Send a Report State Change message (as created with _alloc). | ||
149 | * | ||
150 | * @report_skb: as returned by wimax_gnl_re_state_change_alloc() | ||
151 | * @header: as returned by wimax_gnl_re_state_change_alloc() | ||
152 | * | ||
153 | * Returns: 0 if ok, < 0 errno code on error. | ||
154 | * | ||
155 | * If the message is NULL, pretend it didn't happen. | ||
156 | */ | ||
157 | static | ||
158 | int wimax_gnl_re_state_change_send( | ||
159 | struct wimax_dev *wimax_dev, struct sk_buff *report_skb, | ||
160 | void *header) | ||
161 | { | ||
162 | int result = 0; | ||
163 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
164 | d_fnstart(3, dev, "(wimax_dev %p report_skb %p)\n", | ||
165 | wimax_dev, report_skb); | ||
166 | if (report_skb == NULL) | ||
167 | goto out; | ||
168 | genlmsg_end(report_skb, header); | ||
169 | result = genlmsg_multicast(report_skb, 0, wimax_gnl_mcg.id, GFP_KERNEL); | ||
170 | if (result == -ESRCH) /* Nobody connected, ignore it */ | ||
171 | result = 0; /* btw, the skb is freed already */ | ||
172 | if (result < 0) { | ||
173 | dev_err(dev, "RE_STCH: Error sending: %d\n", result); | ||
174 | nlmsg_free(report_skb); | ||
175 | } | ||
176 | out: | ||
177 | d_fnend(3, dev, "(wimax_dev %p report_skb %p) = %d\n", | ||
178 | wimax_dev, report_skb, result); | ||
179 | return result; | ||
180 | } | ||
181 | |||
182 | |||
183 | static | ||
184 | void __check_new_state(enum wimax_st old_state, enum wimax_st new_state, | ||
185 | unsigned allowed_states_bm) | ||
186 | { | ||
187 | if (WARN_ON(((1 << new_state) & allowed_states_bm) == 0)) { | ||
188 | printk(KERN_ERR "SW BUG! Forbidden state change %u -> %u\n", | ||
189 | old_state, new_state); | ||
190 | } | ||
191 | } | ||
192 | |||
193 | |||
194 | /* | ||
195 | * Set the current state of a WiMAX device [unlocking version of | ||
196 | * wimax_state_change(). | ||
197 | */ | ||
198 | void __wimax_state_change(struct wimax_dev *wimax_dev, enum wimax_st new_state) | ||
199 | { | ||
200 | struct device *dev = wimax_dev_to_dev(wimax_dev); | ||
201 | enum wimax_st old_state = wimax_dev->state; | ||
202 | struct sk_buff *stch_skb; | ||
203 | void *header; | ||
204 | |||
205 | d_fnstart(3, dev, "(wimax_dev %p new_state %u [old %u])\n", | ||
206 | wimax_dev, new_state, old_state); | ||
207 | |||
208 | if (WARN_ON(new_state >= __WIMAX_ST_INVALID)) { | ||
209 | dev_err(dev, "SW BUG: requesting invalid state %u\n", | ||
210 | new_state); | ||
211 | goto out; | ||
212 | } | ||
213 | if (old_state == new_state) | ||
214 | goto out; | ||
215 | header = NULL; /* gcc complains? can't grok why */ | ||
216 | stch_skb = wimax_gnl_re_state_change_alloc( | ||
217 | wimax_dev, new_state, old_state, &header); | ||
218 | |||
219 | /* Verify the state transition and do exit-from-state actions */ | ||
220 | switch (old_state) { | ||
221 | case __WIMAX_ST_NULL: | ||
222 | __check_new_state(old_state, new_state, | ||
223 | 1 << WIMAX_ST_DOWN); | ||
224 | break; | ||
225 | case WIMAX_ST_DOWN: | ||
226 | __check_new_state(old_state, new_state, | ||
227 | 1 << __WIMAX_ST_QUIESCING | ||
228 | | 1 << WIMAX_ST_UNINITIALIZED | ||
229 | | 1 << WIMAX_ST_RADIO_OFF); | ||
230 | break; | ||
231 | case __WIMAX_ST_QUIESCING: | ||
232 | __check_new_state(old_state, new_state, 1 << WIMAX_ST_DOWN); | ||
233 | break; | ||
234 | case WIMAX_ST_UNINITIALIZED: | ||
235 | __check_new_state(old_state, new_state, | ||
236 | 1 << __WIMAX_ST_QUIESCING | ||
237 | | 1 << WIMAX_ST_RADIO_OFF); | ||
238 | break; | ||
239 | case WIMAX_ST_RADIO_OFF: | ||
240 | __check_new_state(old_state, new_state, | ||
241 | 1 << __WIMAX_ST_QUIESCING | ||
242 | | 1 << WIMAX_ST_READY); | ||
243 | break; | ||
244 | case WIMAX_ST_READY: | ||
245 | __check_new_state(old_state, new_state, | ||
246 | 1 << __WIMAX_ST_QUIESCING | ||
247 | | 1 << WIMAX_ST_RADIO_OFF | ||
248 | | 1 << WIMAX_ST_SCANNING | ||
249 | | 1 << WIMAX_ST_CONNECTING | ||
250 | | 1 << WIMAX_ST_CONNECTED); | ||
251 | break; | ||
252 | case WIMAX_ST_SCANNING: | ||
253 | __check_new_state(old_state, new_state, | ||
254 | 1 << __WIMAX_ST_QUIESCING | ||
255 | | 1 << WIMAX_ST_RADIO_OFF | ||
256 | | 1 << WIMAX_ST_READY | ||
257 | | 1 << WIMAX_ST_CONNECTING | ||
258 | | 1 << WIMAX_ST_CONNECTED); | ||
259 | break; | ||
260 | case WIMAX_ST_CONNECTING: | ||
261 | __check_new_state(old_state, new_state, | ||
262 | 1 << __WIMAX_ST_QUIESCING | ||
263 | | 1 << WIMAX_ST_RADIO_OFF | ||
264 | | 1 << WIMAX_ST_READY | ||
265 | | 1 << WIMAX_ST_SCANNING | ||
266 | | 1 << WIMAX_ST_CONNECTED); | ||
267 | break; | ||
268 | case WIMAX_ST_CONNECTED: | ||
269 | __check_new_state(old_state, new_state, | ||
270 | 1 << __WIMAX_ST_QUIESCING | ||
271 | | 1 << WIMAX_ST_RADIO_OFF | ||
272 | | 1 << WIMAX_ST_READY); | ||
273 | netif_tx_disable(wimax_dev->net_dev); | ||
274 | netif_carrier_off(wimax_dev->net_dev); | ||
275 | break; | ||
276 | case __WIMAX_ST_INVALID: | ||
277 | default: | ||
278 | dev_err(dev, "SW BUG: wimax_dev %p is in unknown state %u\n", | ||
279 | wimax_dev, wimax_dev->state); | ||
280 | WARN_ON(1); | ||
281 | goto out; | ||
282 | } | ||
283 | |||
284 | /* Execute the actions of entry to the new state */ | ||
285 | switch (new_state) { | ||
286 | case __WIMAX_ST_NULL: | ||
287 | dev_err(dev, "SW BUG: wimax_dev %p entering NULL state " | ||
288 | "from %u\n", wimax_dev, wimax_dev->state); | ||
289 | WARN_ON(1); /* Nobody can enter this state */ | ||
290 | break; | ||
291 | case WIMAX_ST_DOWN: | ||
292 | break; | ||
293 | case __WIMAX_ST_QUIESCING: | ||
294 | break; | ||
295 | case WIMAX_ST_UNINITIALIZED: | ||
296 | break; | ||
297 | case WIMAX_ST_RADIO_OFF: | ||
298 | break; | ||
299 | case WIMAX_ST_READY: | ||
300 | break; | ||
301 | case WIMAX_ST_SCANNING: | ||
302 | break; | ||
303 | case WIMAX_ST_CONNECTING: | ||
304 | break; | ||
305 | case WIMAX_ST_CONNECTED: | ||
306 | netif_carrier_on(wimax_dev->net_dev); | ||
307 | netif_wake_queue(wimax_dev->net_dev); | ||
308 | break; | ||
309 | case __WIMAX_ST_INVALID: | ||
310 | default: | ||
311 | BUG(); | ||
312 | } | ||
313 | __wimax_state_set(wimax_dev, new_state); | ||
314 | if (stch_skb) | ||
315 | wimax_gnl_re_state_change_send(wimax_dev, stch_skb, header); | ||
316 | out: | ||
317 | d_fnend(3, dev, "(wimax_dev %p new_state %u [old %u]) = void\n", | ||
318 | wimax_dev, new_state, old_state); | ||
319 | return; | ||
320 | } | ||
321 | |||
322 | |||
323 | /** | ||
324 | * wimax_state_change - Set the current state of a WiMAX device | ||
325 | * | ||
326 | * @wimax_dev: WiMAX device descriptor (properly referenced) | ||
327 | * @new_state: New state to switch to | ||
328 | * | ||
329 | * This implements the state changes for the wimax devices. It will | ||
330 | * | ||
331 | * - verify that the state transition is legal (for now it'll just | ||
332 | * print a warning if not) according to the table in | ||
333 | * linux/wimax.h's documentation for 'enum wimax_st'. | ||
334 | * | ||
335 | * - perform the actions needed for leaving the current state and | ||
336 | * whichever are needed for entering the new state. | ||
337 | * | ||
338 | * - issue a report to user space indicating the new state (and an | ||
339 | * optional payload with information about the new state). | ||
340 | * | ||
341 | * NOTE: @wimax_dev must be locked | ||
342 | */ | ||
343 | void wimax_state_change(struct wimax_dev *wimax_dev, enum wimax_st new_state) | ||
344 | { | ||
345 | mutex_lock(&wimax_dev->mutex); | ||
346 | __wimax_state_change(wimax_dev, new_state); | ||
347 | mutex_unlock(&wimax_dev->mutex); | ||
348 | return; | ||
349 | } | ||
350 | EXPORT_SYMBOL_GPL(wimax_state_change); | ||
351 | |||
352 | |||
353 | /** | ||
354 | * wimax_state_get() - Return the current state of a WiMAX device | ||
355 | * | ||
356 | * @wimax_dev: WiMAX device descriptor | ||
357 | * | ||
358 | * Returns: Current state of the device according to its driver. | ||
359 | */ | ||
360 | enum wimax_st wimax_state_get(struct wimax_dev *wimax_dev) | ||
361 | { | ||
362 | enum wimax_st state; | ||
363 | mutex_lock(&wimax_dev->mutex); | ||
364 | state = wimax_dev->state; | ||
365 | mutex_unlock(&wimax_dev->mutex); | ||
366 | return state; | ||
367 | } | ||
368 | EXPORT_SYMBOL_GPL(wimax_state_get); | ||
369 | |||
370 | |||
371 | /** | ||
372 | * wimax_dev_init - initialize a newly allocated instance | ||
373 | * | ||
374 | * @wimax_dev: WiMAX device descriptor to initialize. | ||
375 | * | ||
376 | * Initializes fields of a freshly allocated @wimax_dev instance. This | ||
377 | * function assumes that after allocation, the memory occupied by | ||
378 | * @wimax_dev was zeroed. | ||
379 | */ | ||
380 | void wimax_dev_init(struct wimax_dev *wimax_dev) | ||
381 | { | ||
382 | INIT_LIST_HEAD(&wimax_dev->id_table_node); | ||
383 | __wimax_state_set(wimax_dev, WIMAX_ST_UNINITIALIZED); | ||
384 | mutex_init(&wimax_dev->mutex); | ||
385 | mutex_init(&wimax_dev->mutex_reset); | ||
386 | } | ||
387 | EXPORT_SYMBOL_GPL(wimax_dev_init); | ||
388 | |||
389 | /* | ||
390 | * This extern is declared here because it's easier to keep track -- | ||
391 | * both declarations are a list of the same | ||
392 | */ | ||
393 | extern struct genl_ops | ||
394 | wimax_gnl_msg_from_user, | ||
395 | wimax_gnl_reset, | ||
396 | wimax_gnl_rfkill; | ||
397 | |||
398 | static | ||
399 | struct genl_ops *wimax_gnl_ops[] = { | ||
400 | &wimax_gnl_msg_from_user, | ||
401 | &wimax_gnl_reset, | ||
402 | &wimax_gnl_rfkill, | ||
403 | }; | ||
404 | |||
405 | |||
406 | static | ||
407 | size_t wimax_addr_scnprint(char *addr_str, size_t addr_str_size, | ||
408 | unsigned char *addr, size_t addr_len) | ||
409 | { | ||
410 | unsigned cnt, total; | ||
411 | for (total = cnt = 0; cnt < addr_len; cnt++) | ||
412 | total += scnprintf(addr_str + total, addr_str_size - total, | ||
413 | "%02x%c", addr[cnt], | ||
414 | cnt == addr_len - 1 ? '\0' : ':'); | ||
415 | return total; | ||
416 | } | ||
417 | |||
418 | |||
419 | /** | ||
420 | * wimax_dev_add - Register a new WiMAX device | ||
421 | * | ||
422 | * @wimax_dev: WiMAX device descriptor (as embedded in your @net_dev's | ||
423 | * priv data). You must have called wimax_dev_init() on it before. | ||
424 | * | ||
425 | * @net_dev: net device the @wimax_dev is associated with. The | ||
426 | * function expects SET_NETDEV_DEV() and register_netdev() were | ||
427 | * already called on it. | ||
428 | * | ||
429 | * Registers the new WiMAX device, sets up the user-kernel control | ||
430 | * interface (generic netlink) and common WiMAX infrastructure. | ||
431 | * | ||
432 | * Note that the parts that will allow interaction with user space are | ||
433 | * setup at the very end, when the rest is in place, as once that | ||
434 | * happens, the driver might get user space control requests via | ||
435 | * netlink or from debugfs that might translate into calls into | ||
436 | * wimax_dev->op_*(). | ||
437 | */ | ||
438 | int wimax_dev_add(struct wimax_dev *wimax_dev, struct net_device *net_dev) | ||
439 | { | ||
440 | int result; | ||
441 | struct device *dev = net_dev->dev.parent; | ||
442 | char addr_str[32]; | ||
443 | |||
444 | d_fnstart(3, dev, "(wimax_dev %p net_dev %p)\n", wimax_dev, net_dev); | ||
445 | |||
446 | /* Do the RFKILL setup before locking, as RFKILL will call | ||
447 | * into our functions. */ | ||
448 | wimax_dev->net_dev = net_dev; | ||
449 | result = wimax_rfkill_add(wimax_dev); | ||
450 | if (result < 0) | ||
451 | goto error_rfkill_add; | ||
452 | |||
453 | /* Set up user-space interaction */ | ||
454 | mutex_lock(&wimax_dev->mutex); | ||
455 | wimax_id_table_add(wimax_dev); | ||
456 | result = wimax_debugfs_add(wimax_dev); | ||
457 | if (result < 0) { | ||
458 | dev_err(dev, "cannot initialize debugfs: %d\n", | ||
459 | result); | ||
460 | goto error_debugfs_add; | ||
461 | } | ||
462 | |||
463 | __wimax_state_set(wimax_dev, WIMAX_ST_DOWN); | ||
464 | mutex_unlock(&wimax_dev->mutex); | ||
465 | |||
466 | wimax_addr_scnprint(addr_str, sizeof(addr_str), | ||
467 | net_dev->dev_addr, net_dev->addr_len); | ||
468 | dev_err(dev, "WiMAX interface %s (%s) ready\n", | ||
469 | net_dev->name, addr_str); | ||
470 | d_fnend(3, dev, "(wimax_dev %p net_dev %p) = 0\n", wimax_dev, net_dev); | ||
471 | return 0; | ||
472 | |||
473 | error_debugfs_add: | ||
474 | wimax_id_table_rm(wimax_dev); | ||
475 | mutex_unlock(&wimax_dev->mutex); | ||
476 | wimax_rfkill_rm(wimax_dev); | ||
477 | error_rfkill_add: | ||
478 | d_fnend(3, dev, "(wimax_dev %p net_dev %p) = %d\n", | ||
479 | wimax_dev, net_dev, result); | ||
480 | return result; | ||
481 | } | ||
482 | EXPORT_SYMBOL_GPL(wimax_dev_add); | ||
483 | |||
484 | |||
485 | /** | ||
486 | * wimax_dev_rm - Unregister an existing WiMAX device | ||
487 | * | ||
488 | * @wimax_dev: WiMAX device descriptor | ||
489 | * | ||
490 | * Unregisters a WiMAX device previously registered for use with | ||
491 | * wimax_add_rm(). | ||
492 | * | ||
493 | * IMPORTANT! Must call before calling unregister_netdev(). | ||
494 | * | ||
495 | * After this function returns, you will not get any more user space | ||
496 | * control requests (via netlink or debugfs) and thus to wimax_dev->ops. | ||
497 | * | ||
498 | * Reentrancy control is ensured by setting the state to | ||
499 | * %__WIMAX_ST_QUIESCING. rfkill operations coming through | ||
500 | * wimax_*rfkill*() will be stopped by the quiescing state; ops coming | ||
501 | * from the rfkill subsystem will be stopped by the support being | ||
502 | * removed by wimax_rfkill_rm(). | ||
503 | */ | ||
504 | void wimax_dev_rm(struct wimax_dev *wimax_dev) | ||
505 | { | ||
506 | d_fnstart(3, NULL, "(wimax_dev %p)\n", wimax_dev); | ||
507 | |||
508 | mutex_lock(&wimax_dev->mutex); | ||
509 | __wimax_state_change(wimax_dev, __WIMAX_ST_QUIESCING); | ||
510 | wimax_debugfs_rm(wimax_dev); | ||
511 | wimax_id_table_rm(wimax_dev); | ||
512 | __wimax_state_change(wimax_dev, WIMAX_ST_DOWN); | ||
513 | mutex_unlock(&wimax_dev->mutex); | ||
514 | wimax_rfkill_rm(wimax_dev); | ||
515 | d_fnend(3, NULL, "(wimax_dev %p) = void\n", wimax_dev); | ||
516 | } | ||
517 | EXPORT_SYMBOL_GPL(wimax_dev_rm); | ||
518 | |||
519 | struct genl_family wimax_gnl_family = { | ||
520 | .id = GENL_ID_GENERATE, | ||
521 | .name = "WiMAX", | ||
522 | .version = WIMAX_GNL_VERSION, | ||
523 | .hdrsize = 0, | ||
524 | .maxattr = WIMAX_GNL_ATTR_MAX, | ||
525 | }; | ||
526 | |||
527 | struct genl_multicast_group wimax_gnl_mcg = { | ||
528 | .name = "msg", | ||
529 | }; | ||
530 | |||
531 | |||
532 | |||
533 | /* Shutdown the wimax stack */ | ||
534 | static | ||
535 | int __init wimax_subsys_init(void) | ||
536 | { | ||
537 | int result, cnt; | ||
538 | |||
539 | d_fnstart(4, NULL, "()\n"); | ||
540 | snprintf(wimax_gnl_family.name, sizeof(wimax_gnl_family.name), | ||
541 | "WiMAX"); | ||
542 | result = genl_register_family(&wimax_gnl_family); | ||
543 | if (unlikely(result < 0)) { | ||
544 | printk(KERN_ERR "cannot register generic netlink family: %d\n", | ||
545 | result); | ||
546 | goto error_register_family; | ||
547 | } | ||
548 | |||
549 | for (cnt = 0; cnt < ARRAY_SIZE(wimax_gnl_ops); cnt++) { | ||
550 | result = genl_register_ops(&wimax_gnl_family, | ||
551 | wimax_gnl_ops[cnt]); | ||
552 | d_printf(4, NULL, "registering generic netlink op code " | ||
553 | "%u: %d\n", wimax_gnl_ops[cnt]->cmd, result); | ||
554 | if (unlikely(result < 0)) { | ||
555 | printk(KERN_ERR "cannot register generic netlink op " | ||
556 | "code %u: %d\n", | ||
557 | wimax_gnl_ops[cnt]->cmd, result); | ||
558 | goto error_register_ops; | ||
559 | } | ||
560 | } | ||
561 | |||
562 | result = genl_register_mc_group(&wimax_gnl_family, &wimax_gnl_mcg); | ||
563 | if (result < 0) | ||
564 | goto error_mc_group; | ||
565 | d_fnend(4, NULL, "() = 0\n"); | ||
566 | return 0; | ||
567 | |||
568 | error_mc_group: | ||
569 | error_register_ops: | ||
570 | for (cnt--; cnt >= 0; cnt--) | ||
571 | genl_unregister_ops(&wimax_gnl_family, | ||
572 | wimax_gnl_ops[cnt]); | ||
573 | genl_unregister_family(&wimax_gnl_family); | ||
574 | error_register_family: | ||
575 | d_fnend(4, NULL, "() = %d\n", result); | ||
576 | return result; | ||
577 | |||
578 | } | ||
579 | module_init(wimax_subsys_init); | ||
580 | |||
581 | |||
582 | /* Shutdown the wimax stack */ | ||
583 | static | ||
584 | void __exit wimax_subsys_exit(void) | ||
585 | { | ||
586 | int cnt; | ||
587 | wimax_id_table_release(); | ||
588 | genl_unregister_mc_group(&wimax_gnl_family, &wimax_gnl_mcg); | ||
589 | for (cnt = ARRAY_SIZE(wimax_gnl_ops) - 1; cnt >= 0; cnt--) | ||
590 | genl_unregister_ops(&wimax_gnl_family, | ||
591 | wimax_gnl_ops[cnt]); | ||
592 | genl_unregister_family(&wimax_gnl_family); | ||
593 | } | ||
594 | module_exit(wimax_subsys_exit); | ||
595 | |||
596 | MODULE_AUTHOR("Intel Corporation <linux-wimax@intel.com>"); | ||
597 | MODULE_DESCRIPTION("Linux WiMAX stack"); | ||
598 | MODULE_LICENSE("GPL"); | ||
599 | |||
diff --git a/net/wimax/wimax-internal.h b/net/wimax/wimax-internal.h new file mode 100644 index 000000000000..1e743d214856 --- /dev/null +++ b/net/wimax/wimax-internal.h | |||
@@ -0,0 +1,91 @@ | |||
1 | /* | ||
2 | * Linux WiMAX | ||
3 | * Internal API for kernel space WiMAX stack | ||
4 | * | ||
5 | * | ||
6 | * Copyright (C) 2007 Intel Corporation <linux-wimax@intel.com> | ||
7 | * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com> | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License version | ||
11 | * 2 as published by the Free Software Foundation. | ||
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 Free Software | ||
20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
21 | * 02110-1301, USA. | ||
22 | * | ||
23 | * | ||
24 | * This header file is for declarations and definitions internal to | ||
25 | * the WiMAX stack. For public APIs and documentation, see | ||
26 | * include/net/wimax.h and include/linux/wimax.h. | ||
27 | */ | ||
28 | |||
29 | #ifndef __WIMAX_INTERNAL_H__ | ||
30 | #define __WIMAX_INTERNAL_H__ | ||
31 | #ifdef __KERNEL__ | ||
32 | |||
33 | #include <linux/device.h> | ||
34 | #include <net/wimax.h> | ||
35 | |||
36 | |||
37 | /* | ||
38 | * Decide if a (locked) device is ready for use | ||
39 | * | ||
40 | * Before using the device structure, it must be locked | ||
41 | * (wimax_dev->mutex). As well, most operations need to call this | ||
42 | * function to check if the state is the right one. | ||
43 | * | ||
44 | * An error value will be returned if the state is not the right | ||
45 | * one. In that case, the caller should not attempt to use the device | ||
46 | * and just unlock it. | ||
47 | */ | ||
48 | static inline __must_check | ||
49 | int wimax_dev_is_ready(struct wimax_dev *wimax_dev) | ||
50 | { | ||
51 | if (wimax_dev->state == __WIMAX_ST_NULL) | ||
52 | return -EINVAL; /* Device is not even registered! */ | ||
53 | if (wimax_dev->state == WIMAX_ST_DOWN) | ||
54 | return -ENOMEDIUM; | ||
55 | if (wimax_dev->state == __WIMAX_ST_QUIESCING) | ||
56 | return -ESHUTDOWN; | ||
57 | return 0; | ||
58 | } | ||
59 | |||
60 | |||
61 | static inline | ||
62 | void __wimax_state_set(struct wimax_dev *wimax_dev, enum wimax_st state) | ||
63 | { | ||
64 | wimax_dev->state = state; | ||
65 | } | ||
66 | extern void __wimax_state_change(struct wimax_dev *, enum wimax_st); | ||
67 | |||
68 | #ifdef CONFIG_DEBUG_FS | ||
69 | extern int wimax_debugfs_add(struct wimax_dev *); | ||
70 | extern void wimax_debugfs_rm(struct wimax_dev *); | ||
71 | #else | ||
72 | static inline int wimax_debugfs_add(struct wimax_dev *wimax_dev) | ||
73 | { | ||
74 | return 0; | ||
75 | } | ||
76 | static inline void wimax_debugfs_rm(struct wimax_dev *wimax_dev) {} | ||
77 | #endif | ||
78 | |||
79 | extern void wimax_id_table_add(struct wimax_dev *); | ||
80 | extern struct wimax_dev *wimax_dev_get_by_genl_info(struct genl_info *, int); | ||
81 | extern void wimax_id_table_rm(struct wimax_dev *); | ||
82 | extern void wimax_id_table_release(void); | ||
83 | |||
84 | extern int wimax_rfkill_add(struct wimax_dev *); | ||
85 | extern void wimax_rfkill_rm(struct wimax_dev *); | ||
86 | |||
87 | extern struct genl_family wimax_gnl_family; | ||
88 | extern struct genl_multicast_group wimax_gnl_mcg; | ||
89 | |||
90 | #endif /* #ifdef __KERNEL__ */ | ||
91 | #endif /* #ifndef __WIMAX_INTERNAL_H__ */ | ||