netlink.c revision 573ce260b385a4d14a1ef046558fad9f1daeee42 
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
32static unsigned int ieee802154_seq_num;
33static DEFINE_SPINLOCK(ieee802154_seq_lock);
34
35struct 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 */
44struct 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
65int 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);
74out:
75	nlmsg_free(msg);
76	return -ENOBUFS;
77}
78
79struct 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
98int 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);
107out:
108	nlmsg_free(msg);
109	return -ENOBUFS;
110}
111
112int __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
130fail:
131	genl_unregister_family(&nl802154_family);
132	return rc;
133}
134
135void __exit ieee802154_nl_exit(void)
136{
137	genl_unregister_family(&nl802154_family);
138}
139
140