xref: /openbmc/linux/net/ieee802154/netlink.c (revision 4800cd83)
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 */
44 struct sk_buff *ieee802154_nl_create(int flags, u8 req)
45 {
46 	void *hdr;
47 	struct sk_buff *msg = nlmsg_new(NLMSG_GOODSIZE, 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 
65 int ieee802154_nl_mcast(struct sk_buff *msg, unsigned int group)
66 {
67 	/* XXX: nlh is right at the start of msg */
68 	void *hdr = genlmsg_data(NLMSG_DATA(msg->data));
69 
70 	if (genlmsg_end(msg, hdr) < 0)
71 		goto out;
72 
73 	return genlmsg_multicast(msg, 0, group, GFP_ATOMIC);
74 out:
75 	nlmsg_free(msg);
76 	return -ENOBUFS;
77 }
78 
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_GOODSIZE, 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 
98 int ieee802154_nl_reply(struct sk_buff *msg, struct genl_info *info)
99 {
100 	/* XXX: nlh is right at the start of msg */
101 	void *hdr = genlmsg_data(NLMSG_DATA(msg->data));
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 int __init ieee802154_nl_init(void)
113 {
114 	int rc;
115 
116 	rc = genl_register_family(&nl802154_family);
117 	if (rc)
118 		goto fail;
119 
120 	rc = nl802154_mac_register();
121 	if (rc)
122 		goto fail;
123 
124 	rc = nl802154_phy_register();
125 	if (rc)
126 		goto fail;
127 
128 	return 0;
129 
130 fail:
131 	genl_unregister_family(&nl802154_family);
132 	return rc;
133 }
134 
135 void __exit ieee802154_nl_exit(void)
136 {
137 	genl_unregister_family(&nl802154_family);
138 }
139 
140