LXR linux/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