Root/net/ieee802154/netlink.c

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    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(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    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);
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

Archive Download this file



interactive