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  */
  23
  24 #include <linux/kernel.h>
  25 #include <linux/if_arp.h>
  26 #include <linux/netdevice.h>
  27 #include <net/netlink.h>
  28 #include <net/genetlink.h>
  29 #include <linux/nl802154.h>
  30 #include <net/ieee802154/af_ieee802154.h>
  31 #include <net/ieee802154/nl802154.h>
  32 #include <net/ieee802154/netdevice.h>
  33
  34 static unsigned int ieee802154_seq_num;
  35
  36 static struct genl_family ieee802154_coordinator_family = {
  37         .id             = GENL_ID_GENERATE,
  38         .hdrsize        = 0,
  39         .name           = IEEE802154_NL_NAME,
  40         .version        = 1,
  41         .maxattr        = IEEE802154_ATTR_MAX,
  42 };
  43
  44 static struct genl_multicast_group ieee802154_coord_mcgrp = {
  45         .name           = IEEE802154_MCAST_COORD_NAME,
  46 };
  47
  48 static struct genl_multicast_group ieee802154_beacon_mcgrp = {
  49         .name           = IEEE802154_MCAST_BEACON_NAME,
  50 };
  51
  52 /* Requests to userspace */
  53 static struct sk_buff *ieee802154_nl_create(int flags, u8 req)
  54 {
  55         void *hdr;
  56         struct sk_buff *msg = nlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
  57
  58         if (!msg)
  59                 return NULL;
  60
  61         hdr = genlmsg_put(msg, 0, ieee802154_seq_num++,
  62                         &ieee802154_coordinator_family, flags, req);
  63         if (!hdr) {
  64                 nlmsg_free(msg);
  65                 return NULL;
  66         }
  67
  68         return msg;
  69 }
  70
  71 static int ieee802154_nl_finish(struct sk_buff *msg)
  72 {
  73         /* XXX: nlh is right at the start of msg */
  74         void *hdr = genlmsg_data(NLMSG_DATA(msg->data));
  75
  76         if (!genlmsg_end(msg, hdr))
  77                 goto out;
  78
  79         return genlmsg_multicast(msg, 0, ieee802154_coord_mcgrp.id,
  80                         GFP_ATOMIC);
  81 out:
  82         nlmsg_free(msg);
  83         return -ENOBUFS;
  84 }
  85
  86 int ieee802154_nl_assoc_indic(struct net_device *dev,
  87                 struct ieee802154_addr *addr, u8 cap)
  88 {
  89         struct sk_buff *msg;
  90
  91         pr_debug("%s\n", __func__);
  92
  93         if (addr->addr_type != IEEE802154_ADDR_LONG) {
  94                 pr_err("%s: received non-long source address!\n", __func__);
  95                 return -EINVAL;
  96         }
  97
  98         msg = ieee802154_nl_create(0, IEEE802154_ASSOCIATE_INDIC);
  99         if (!msg)
 100                 return -ENOBUFS;
 101
 102         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 103         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 104         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 105                         dev->dev_addr);
 106
 107         NLA_PUT(msg, IEEE802154_ATTR_SRC_HW_ADDR, IEEE802154_ADDR_LEN,
 108                         addr->hwaddr);
 109
 110         NLA_PUT_U8(msg, IEEE802154_ATTR_CAPABILITY, cap);
 111
 112         return ieee802154_nl_finish(msg);
 113
 114 nla_put_failure:
 115         nlmsg_free(msg);
 116         return -ENOBUFS;
 117 }
 118 EXPORT_SYMBOL(ieee802154_nl_assoc_indic);
 119
 120 int ieee802154_nl_assoc_confirm(struct net_device *dev, u16 short_addr,
 121                 u8 status)
 122 {
 123         struct sk_buff *msg;
 124
 125         pr_debug("%s\n", __func__);
 126
 127         msg = ieee802154_nl_create(0, IEEE802154_ASSOCIATE_CONF);
 128         if (!msg)
 129                 return -ENOBUFS;
 130
 131         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 132         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 133         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 134                         dev->dev_addr);
 135
 136         NLA_PUT_U16(msg, IEEE802154_ATTR_SHORT_ADDR, short_addr);
 137         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 138
 139         return ieee802154_nl_finish(msg);
 140
 141 nla_put_failure:
 142         nlmsg_free(msg);
 143         return -ENOBUFS;
 144 }
 145 EXPORT_SYMBOL(ieee802154_nl_assoc_confirm);
 146
 147 int ieee802154_nl_disassoc_indic(struct net_device *dev,
 148                 struct ieee802154_addr *addr, u8 reason)
 149 {
 150         struct sk_buff *msg;
 151
 152         pr_debug("%s\n", __func__);
 153
 154         msg = ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_INDIC);
 155         if (!msg)
 156                 return -ENOBUFS;
 157
 158         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 159         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 160         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 161                         dev->dev_addr);
 162
 163         if (addr->addr_type == IEEE802154_ADDR_LONG)
 164                 NLA_PUT(msg, IEEE802154_ATTR_SRC_HW_ADDR, IEEE802154_ADDR_LEN,
 165                                 addr->hwaddr);
 166         else
 167                 NLA_PUT_U16(msg, IEEE802154_ATTR_SRC_SHORT_ADDR,
 168                                 addr->short_addr);
 169
 170         NLA_PUT_U8(msg, IEEE802154_ATTR_REASON, reason);
 171
 172         return ieee802154_nl_finish(msg);
 173
 174 nla_put_failure:
 175         nlmsg_free(msg);
 176         return -ENOBUFS;
 177 }
 178 EXPORT_SYMBOL(ieee802154_nl_disassoc_indic);
 179
 180 int ieee802154_nl_disassoc_confirm(struct net_device *dev, u8 status)
 181 {
 182         struct sk_buff *msg;
 183
 184         pr_debug("%s\n", __func__);
 185
 186         msg = ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_CONF);
 187         if (!msg)
 188                 return -ENOBUFS;
 189
 190         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 191         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 192         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 193                         dev->dev_addr);
 194
 195         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 196
 197         return ieee802154_nl_finish(msg);
 198
 199 nla_put_failure:
 200         nlmsg_free(msg);
 201         return -ENOBUFS;
 202 }
 203 EXPORT_SYMBOL(ieee802154_nl_disassoc_confirm);
 204
 205 int ieee802154_nl_beacon_indic(struct net_device *dev,
 206                 u16 panid, u16 coord_addr)
 207 {
 208         struct sk_buff *msg;
 209
 210         pr_debug("%s\n", __func__);
 211
 212         msg = ieee802154_nl_create(0, IEEE802154_BEACON_NOTIFY_INDIC);
 213         if (!msg)
 214                 return -ENOBUFS;
 215
 216         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 217         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 218         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 219                         dev->dev_addr);
 220         NLA_PUT_U16(msg, IEEE802154_ATTR_COORD_SHORT_ADDR, coord_addr);
 221         NLA_PUT_U16(msg, IEEE802154_ATTR_COORD_PAN_ID, panid);
 222
 223         return ieee802154_nl_finish(msg);
 224
 225 nla_put_failure:
 226         nlmsg_free(msg);
 227         return -ENOBUFS;
 228 }
 229 EXPORT_SYMBOL(ieee802154_nl_beacon_indic);
 230
 231 int ieee802154_nl_scan_confirm(struct net_device *dev,
 232                 u8 status, u8 scan_type, u32 unscanned,
 233                 u8 *edl/* , struct list_head *pan_desc_list */)
 234 {
 235         struct sk_buff *msg;
 236
 237         pr_debug("%s\n", __func__);
 238
 239         msg = ieee802154_nl_create(0, IEEE802154_SCAN_CONF);
 240         if (!msg)
 241                 return -ENOBUFS;
 242
 243         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 244         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 245         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 246                         dev->dev_addr);
 247
 248         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 249         NLA_PUT_U8(msg, IEEE802154_ATTR_SCAN_TYPE, scan_type);
 250         NLA_PUT_U32(msg, IEEE802154_ATTR_CHANNELS, unscanned);
 251
 252         if (edl)
 253                 NLA_PUT(msg, IEEE802154_ATTR_ED_LIST, 27, edl);
 254
 255         return ieee802154_nl_finish(msg);
 256
 257 nla_put_failure:
 258         nlmsg_free(msg);
 259         return -ENOBUFS;
 260 }
 261 EXPORT_SYMBOL(ieee802154_nl_scan_confirm);
 262
 263 /* Requests from userspace */
 264 static struct net_device *ieee802154_nl_get_dev(struct genl_info *info)
 265 {
 266         struct net_device *dev;
 267
 268         if (info->attrs[IEEE802154_ATTR_DEV_NAME]) {
 269                 char name[IFNAMSIZ + 1];
 270                 nla_strlcpy(name, info->attrs[IEEE802154_ATTR_DEV_NAME],
 271                                 sizeof(name));
 272                 dev = dev_get_by_name(&init_net, name);
 273         } else if (info->attrs[IEEE802154_ATTR_DEV_INDEX])
 274                 dev = dev_get_by_index(&init_net,
 275                                 nla_get_u32(info->attrs[IEEE802154_ATTR_DEV_INDEX]));
 276         else
 277                 return NULL;
 278
 279         if (!dev)
 280                 return NULL;
 281
 282         if (dev->type != ARPHRD_IEEE802154) {
 283                 dev_put(dev);
 284                 return NULL;
 285         }
 286
 287         return dev;
 288 }
 289
 290 static int ieee802154_associate_req(struct sk_buff *skb,
 291                 struct genl_info *info)
 292 {
 293         struct net_device *dev;
 294         struct ieee802154_addr addr;
 295         int ret = -EINVAL;
 296
 297         if (!info->attrs[IEEE802154_ATTR_CHANNEL] ||
 298             !info->attrs[IEEE802154_ATTR_COORD_PAN_ID] ||
 299             (!info->attrs[IEEE802154_ATTR_COORD_HW_ADDR] &&
 300                 !info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]) ||
 301             !info->attrs[IEEE802154_ATTR_CAPABILITY])
 302                 return -EINVAL;
 303
 304         dev = ieee802154_nl_get_dev(info);
 305         if (!dev)
 306                 return -ENODEV;
 307
 308         if (info->attrs[IEEE802154_ATTR_COORD_HW_ADDR]) {
 309                 addr.addr_type = IEEE802154_ADDR_LONG;
 310                 nla_memcpy(addr.hwaddr,
 311                                 info->attrs[IEEE802154_ATTR_COORD_HW_ADDR],
 312                                 IEEE802154_ADDR_LEN);
 313         } else {
 314                 addr.addr_type = IEEE802154_ADDR_SHORT;
 315                 addr.short_addr = nla_get_u16(
 316                                 info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]);
 317         }
 318         addr.pan_id = nla_get_u16(info->attrs[IEEE802154_ATTR_COORD_PAN_ID]);
 319
 320         ret = ieee802154_mlme_ops(dev)->assoc_req(dev, &addr,
 321                         nla_get_u8(info->attrs[IEEE802154_ATTR_CHANNEL]),
 322                         nla_get_u8(info->attrs[IEEE802154_ATTR_CAPABILITY]));
 323
 324         dev_put(dev);
 325         return ret;
 326 }
 327
 328 static int ieee802154_associate_resp(struct sk_buff *skb,
 329                 struct genl_info *info)
 330 {
 331         struct net_device *dev;
 332         struct ieee802154_addr addr;
 333         int ret = -EINVAL;
 334
 335         if (!info->attrs[IEEE802154_ATTR_STATUS] ||
 336             !info->attrs[IEEE802154_ATTR_DEST_HW_ADDR] ||
 337             !info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR])
 338                 return -EINVAL;
 339
 340         dev = ieee802154_nl_get_dev(info);
 341         if (!dev)
 342                 return -ENODEV;
 343
 344         addr.addr_type = IEEE802154_ADDR_LONG;
 345         nla_memcpy(addr.hwaddr, info->attrs[IEEE802154_ATTR_DEST_HW_ADDR],
 346                         IEEE802154_ADDR_LEN);
 347         addr.pan_id = ieee802154_mlme_ops(dev)->get_pan_id(dev);
 348
 349
 350         ret = ieee802154_mlme_ops(dev)->assoc_resp(dev, &addr,
 351                 nla_get_u16(info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]),
 352                 nla_get_u8(info->attrs[IEEE802154_ATTR_STATUS]));
 353
 354         dev_put(dev);
 355         return ret;
 356 }
 357
 358 static int ieee802154_disassociate_req(struct sk_buff *skb,
 359                 struct genl_info *info)
 360 {
 361         struct net_device *dev;
 362         struct ieee802154_addr addr;
 363         int ret = -EINVAL;
 364
 365         if ((!info->attrs[IEEE802154_ATTR_DEST_HW_ADDR] &&
 366                 !info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]) ||
 367             !info->attrs[IEEE802154_ATTR_REASON])
 368                 return -EINVAL;
 369
 370         dev = ieee802154_nl_get_dev(info);
 371         if (!dev)
 372                 return -ENODEV;
 373
 374         if (info->attrs[IEEE802154_ATTR_DEST_HW_ADDR]) {
 375                 addr.addr_type = IEEE802154_ADDR_LONG;
 376                 nla_memcpy(addr.hwaddr,
 377                                 info->attrs[IEEE802154_ATTR_DEST_HW_ADDR],
 378                                 IEEE802154_ADDR_LEN);
 379         } else {
 380                 addr.addr_type = IEEE802154_ADDR_SHORT;
 381                 addr.short_addr = nla_get_u16(
 382                                 info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]);
 383         }
 384         addr.pan_id = ieee802154_mlme_ops(dev)->get_pan_id(dev);
 385
 386         ret = ieee802154_mlme_ops(dev)->disassoc_req(dev, &addr,
 387                         nla_get_u8(info->attrs[IEEE802154_ATTR_REASON]));
 388
 389         dev_put(dev);
 390         return ret;
 391 }
 392
 393 /*
 394  * PANid, channel, beacon_order = 15, superframe_order = 15,
 395  * PAN_coordinator, battery_life_extension = 0,
 396  * coord_realignment = 0, security_enable = 0
 397 */
 398 static int ieee802154_start_req(struct sk_buff *skb, struct genl_info *info)
 399 {
 400         struct net_device *dev;
 401         struct ieee802154_addr addr;
 402
 403         u8 channel, bcn_ord, sf_ord;
 404         int pan_coord, blx, coord_realign;
 405         int ret;
 406
 407         if (!info->attrs[IEEE802154_ATTR_COORD_PAN_ID] ||
 408             !info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR] ||
 409             !info->attrs[IEEE802154_ATTR_CHANNEL] ||
 410             !info->attrs[IEEE802154_ATTR_BCN_ORD] ||
 411             !info->attrs[IEEE802154_ATTR_SF_ORD] ||
 412             !info->attrs[IEEE802154_ATTR_PAN_COORD] ||
 413             !info->attrs[IEEE802154_ATTR_BAT_EXT] ||
 414             !info->attrs[IEEE802154_ATTR_COORD_REALIGN]
 415          )
 416                 return -EINVAL;
 417
 418         dev = ieee802154_nl_get_dev(info);
 419         if (!dev)
 420                 return -ENODEV;
 421
 422         addr.addr_type = IEEE802154_ADDR_SHORT;
 423         addr.short_addr = nla_get_u16(
 424                         info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]);
 425         addr.pan_id = nla_get_u16(info->attrs[IEEE802154_ATTR_COORD_PAN_ID]);
 426
 427         channel = nla_get_u8(info->attrs[IEEE802154_ATTR_CHANNEL]);
 428         bcn_ord = nla_get_u8(info->attrs[IEEE802154_ATTR_BCN_ORD]);
 429         sf_ord = nla_get_u8(info->attrs[IEEE802154_ATTR_SF_ORD]);
 430         pan_coord = nla_get_u8(info->attrs[IEEE802154_ATTR_PAN_COORD]);
 431         blx = nla_get_u8(info->attrs[IEEE802154_ATTR_BAT_EXT]);
 432         coord_realign = nla_get_u8(info->attrs[IEEE802154_ATTR_COORD_REALIGN]);
 433
 434         ret = ieee802154_mlme_ops(dev)->start_req(dev, &addr, channel,
 435                 bcn_ord, sf_ord, pan_coord, blx, coord_realign);
 436
 437         dev_put(dev);
 438         return ret;
 439 }
 440
 441 static int ieee802154_scan_req(struct sk_buff *skb, struct genl_info *info)
 442 {
 443         struct net_device *dev;
 444         int ret;
 445         u8 type;
 446         u32 channels;
 447         u8 duration;
 448
 449         if (!info->attrs[IEEE802154_ATTR_SCAN_TYPE] ||
 450             !info->attrs[IEEE802154_ATTR_CHANNELS] ||
 451             !info->attrs[IEEE802154_ATTR_DURATION])
 452                 return -EINVAL;
 453
 454         dev = ieee802154_nl_get_dev(info);
 455         if (!dev)
 456                 return -ENODEV;
 457
 458         type = nla_get_u8(info->attrs[IEEE802154_ATTR_SCAN_TYPE]);
 459         channels = nla_get_u32(info->attrs[IEEE802154_ATTR_CHANNELS]);
 460         duration = nla_get_u8(info->attrs[IEEE802154_ATTR_DURATION]);
 461
 462         ret = ieee802154_mlme_ops(dev)->scan_req(dev, type, channels,
 463                         duration);
 464
 465         dev_put(dev);
 466         return ret;
 467 }
 468
 469 #define IEEE802154_OP(_cmd, _func)                      \
 470         {                                               \
 471                 .cmd    = _cmd,                         \
 472                 .policy = ieee802154_policy,            \
 473                 .doit   = _func,                        \
 474                 .dumpit = NULL,                         \
 475                 .flags  = GENL_ADMIN_PERM,              \
 476         }
 477
 478 static struct genl_ops ieee802154_coordinator_ops[] = {
 479         IEEE802154_OP(IEEE802154_ASSOCIATE_REQ, ieee802154_associate_req),
 480         IEEE802154_OP(IEEE802154_ASSOCIATE_RESP, ieee802154_associate_resp),
 481         IEEE802154_OP(IEEE802154_DISASSOCIATE_REQ, ieee802154_disassociate_req),
 482         IEEE802154_OP(IEEE802154_SCAN_REQ, ieee802154_scan_req),
 483         IEEE802154_OP(IEEE802154_START_REQ, ieee802154_start_req),
 484 };
 485
 486 static int __init ieee802154_nl_init(void)
 487 {
 488         int rc;
 489         int i;
 490
 491         rc = genl_register_family(&ieee802154_coordinator_family);
 492         if (rc)
 493                 goto fail;
 494
 495         rc = genl_register_mc_group(&ieee802154_coordinator_family,
 496                         &ieee802154_coord_mcgrp);
 497         if (rc)
 498                 goto fail;
 499
 500         rc = genl_register_mc_group(&ieee802154_coordinator_family,
 501                         &ieee802154_beacon_mcgrp);
 502         if (rc)
 503                 goto fail;
 504
 505
 506         for (i = 0; i < ARRAY_SIZE(ieee802154_coordinator_ops); i++) {
 507                 rc = genl_register_ops(&ieee802154_coordinator_family,
 508                                 &ieee802154_coordinator_ops[i]);
 509                 if (rc)
 510                         goto fail;
 511         }
 512
 513         return 0;
 514
 515 fail:
 516         genl_unregister_family(&ieee802154_coordinator_family);
 517         return rc;
 518 }
 519 module_init(ieee802154_nl_init);
 520
 521 static void __exit ieee802154_nl_exit(void)
 522 {
 523         genl_unregister_family(&ieee802154_coordinator_family);
 524 }
 525 module_exit(ieee802154_nl_exit);
 526
 527 MODULE_LICENSE("GPL v2");
 528 MODULE_DESCRIPTION("ieee 802.15.4 configuration interface");
 529