1 /*
2 * Netlink inteface for IEEE 802.15.4 stack
3 *
4 * Copyright 2007, 2008 Siemens AG
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
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 along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * Written by:
20 * Sergey Lapin <slapin@ossfans.org>
21 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
22 * Maxim Osipov <maxim.osipov@siemens.com>
23 */
24
25 #include <linux/kernel.h>
26 #include <linux/gfp.h>
27 #include <net/genetlink.h>
28 #include <linux/nl802154.h>
29
30 #include "ieee802154.h"
31
32 static unsigned int ieee802154_seq_num;
33 static DEFINE_SPINLOCK(ieee802154_seq_lock);
34
35 struct genl_family nl802154_family = {
36 .id = GENL_ID_GENERATE,
37 .hdrsize = 0,
38 .name = IEEE802154_NL_NAME,
39 .version = 1,
40 .maxattr = IEEE802154_ATTR_MAX,
41 };
42
43 /* Requests to userspace */
ieee802154_nl_create(int flags,u8 req)44 struct sk_buff *ieee802154_nl_create(int flags, u8 req)
45 {
46 void *hdr;
47 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
48 unsigned long f;
49
50 if (!msg)
51 return NULL;
52
53 spin_lock_irqsave(&ieee802154_seq_lock, f);
54 hdr = genlmsg_put(msg, 0, ieee802154_seq_num++,
55 &nl802154_family, flags, req);
56 spin_unlock_irqrestore(&ieee802154_seq_lock, f);
57 if (!hdr) {
58 nlmsg_free(msg);
59 return NULL;
60 }
61
62 return msg;
63 }
64
ieee802154_nl_mcast(struct sk_buff * msg,unsigned int group)65 int ieee802154_nl_mcast(struct sk_buff *msg, unsigned int group)
66 {
67 struct nlmsghdr *nlh = nlmsg_hdr(msg);
68 void *hdr = genlmsg_data(nlmsg_data(nlh));
69
70 if (genlmsg_end(msg, hdr) < 0)
71 goto out;
72
73 return genlmsg_multicast(&nl802154_family, msg, 0, group, GFP_ATOMIC);
74 out:
75 nlmsg_free(msg);
76 return -ENOBUFS;
77 }
78
ieee802154_nl_new_reply(struct genl_info * info,int flags,u8 req)79 struct sk_buff *ieee802154_nl_new_reply(struct genl_info *info,
80 int flags, u8 req)
81 {
82 void *hdr;
83 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
84
85 if (!msg)
86 return NULL;
87
88 hdr = genlmsg_put_reply(msg, info,
89 &nl802154_family, flags, req);
90 if (!hdr) {
91 nlmsg_free(msg);
92 return NULL;
93 }
94
95 return msg;
96 }
97
ieee802154_nl_reply(struct sk_buff * msg,struct genl_info * info)98 int ieee802154_nl_reply(struct sk_buff *msg, struct genl_info *info)
99 {
100 struct nlmsghdr *nlh = nlmsg_hdr(msg);
101 void *hdr = genlmsg_data(nlmsg_data(nlh));
102
103 if (genlmsg_end(msg, hdr) < 0)
104 goto out;
105
106 return genlmsg_reply(msg, info);
107 out:
108 nlmsg_free(msg);
109 return -ENOBUFS;
110 }
111
112 static const struct genl_ops ieee8021154_ops[] = {
113 /* see nl-phy.c */
114 IEEE802154_DUMP(IEEE802154_LIST_PHY, ieee802154_list_phy,
115 ieee802154_dump_phy),
116 IEEE802154_OP(IEEE802154_ADD_IFACE, ieee802154_add_iface),
117 IEEE802154_OP(IEEE802154_DEL_IFACE, ieee802154_del_iface),
118 /* see nl-mac.c */
119 IEEE802154_OP(IEEE802154_ASSOCIATE_REQ, ieee802154_associate_req),
120 IEEE802154_OP(IEEE802154_ASSOCIATE_RESP, ieee802154_associate_resp),
121 IEEE802154_OP(IEEE802154_DISASSOCIATE_REQ, ieee802154_disassociate_req),
122 IEEE802154_OP(IEEE802154_SCAN_REQ, ieee802154_scan_req),
123 IEEE802154_OP(IEEE802154_START_REQ, ieee802154_start_req),
124 IEEE802154_DUMP(IEEE802154_LIST_IFACE, ieee802154_list_iface,
125 ieee802154_dump_iface),
126 IEEE802154_OP(IEEE802154_SET_MACPARAMS, ieee802154_set_macparams),
127 IEEE802154_OP(IEEE802154_LLSEC_GETPARAMS, ieee802154_llsec_getparams),
128 IEEE802154_OP(IEEE802154_LLSEC_SETPARAMS, ieee802154_llsec_setparams),
129 IEEE802154_DUMP(IEEE802154_LLSEC_LIST_KEY, NULL,
130 ieee802154_llsec_dump_keys),
131 IEEE802154_OP(IEEE802154_LLSEC_ADD_KEY, ieee802154_llsec_add_key),
132 IEEE802154_OP(IEEE802154_LLSEC_DEL_KEY, ieee802154_llsec_del_key),
133 IEEE802154_DUMP(IEEE802154_LLSEC_LIST_DEV, NULL,
134 ieee802154_llsec_dump_devs),
135 IEEE802154_OP(IEEE802154_LLSEC_ADD_DEV, ieee802154_llsec_add_dev),
136 IEEE802154_OP(IEEE802154_LLSEC_DEL_DEV, ieee802154_llsec_del_dev),
137 IEEE802154_DUMP(IEEE802154_LLSEC_LIST_DEVKEY, NULL,
138 ieee802154_llsec_dump_devkeys),
139 IEEE802154_OP(IEEE802154_LLSEC_ADD_DEVKEY, ieee802154_llsec_add_devkey),
140 IEEE802154_OP(IEEE802154_LLSEC_DEL_DEVKEY, ieee802154_llsec_del_devkey),
141 IEEE802154_DUMP(IEEE802154_LLSEC_LIST_SECLEVEL, NULL,
142 ieee802154_llsec_dump_seclevels),
143 IEEE802154_OP(IEEE802154_LLSEC_ADD_SECLEVEL,
144 ieee802154_llsec_add_seclevel),
145 IEEE802154_OP(IEEE802154_LLSEC_DEL_SECLEVEL,
146 ieee802154_llsec_del_seclevel),
147 };
148
149 static const struct genl_multicast_group ieee802154_mcgrps[] = {
150 [IEEE802154_COORD_MCGRP] = { .name = IEEE802154_MCAST_COORD_NAME, },
151 [IEEE802154_BEACON_MCGRP] = { .name = IEEE802154_MCAST_BEACON_NAME, },
152 };
153
154
ieee802154_nl_init(void)155 int __init ieee802154_nl_init(void)
156 {
157 return genl_register_family_with_ops_groups(&nl802154_family,
158 ieee8021154_ops,
159 ieee802154_mcgrps);
160 }
161
ieee802154_nl_exit(void)162 void __exit ieee802154_nl_exit(void)
163 {
164 genl_unregister_family(&nl802154_family);
165 }
166