Pileus Git - ~andy/linux/blob - 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
  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_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
  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
  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
  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 };
 127
 128 int __init ieee802154_nl_init(void)
 129 {
 130         int rc;
 131
 132         rc = genl_register_family_with_ops(&nl802154_family, ieee8021154_ops);
 133         if (rc)
 134                 return rc;
 135
 136         rc = genl_register_mc_group(&nl802154_family, &ieee802154_coord_mcgrp);
 137         if (rc)
 138                 goto fail;
 139
 140         rc = genl_register_mc_group(&nl802154_family, &ieee802154_beacon_mcgrp);
 141         if (rc)
 142                 goto fail;
 143         return 0;
 144 fail:
 145         genl_unregister_family(&nl802154_family);
 146         return rc;
 147 }
 148
 149 void __exit ieee802154_nl_exit(void)
 150 {
 151         genl_unregister_family(&nl802154_family);
 152 }