release/src-rt-6.x.4708/linux/linux-2.6.36/net/ieee802154/nl-mac.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/gfp.h>
  26 #include <linux/kernel.h>
  27 #include <linux/if_arp.h>
  28 #include <linux/netdevice.h>
  29 #include <net/netlink.h>
  30 #include <net/genetlink.h>
  31 #include <net/sock.h>
  32 #include <linux/nl802154.h>
  33 #include <net/af_ieee802154.h>
  34 #include <net/nl802154.h>
  35 #include <net/ieee802154.h>
  36 #include <net/ieee802154_netdev.h>
  37 #include <net/wpan-phy.h>
  38
  39 #include "ieee802154.h"
  40
  41 static struct genl_multicast_group ieee802154_coord_mcgrp = {
  42         .name           = IEEE802154_MCAST_COORD_NAME,
  43 };
  44
  45 static struct genl_multicast_group ieee802154_beacon_mcgrp = {
  46         .name           = IEEE802154_MCAST_BEACON_NAME,
  47 };
  48
  49 int ieee802154_nl_assoc_indic(struct net_device *dev,
  50                 struct ieee802154_addr *addr, u8 cap)
  51 {
  52         struct sk_buff *msg;
  53
  54         pr_debug("%s\n", __func__);
  55
  56         if (addr->addr_type != IEEE802154_ADDR_LONG) {
  57                 pr_err("%s: received non-long source address!\n", __func__);
  58                 return -EINVAL;
  59         }
  60
  61         msg = ieee802154_nl_create(0, IEEE802154_ASSOCIATE_INDIC);
  62         if (!msg)
  63                 return -ENOBUFS;
  64
  65         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
  66         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
  67         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
  68                         dev->dev_addr);
  69
  70         NLA_PUT(msg, IEEE802154_ATTR_SRC_HW_ADDR, IEEE802154_ADDR_LEN,
  71                         addr->hwaddr);
  72
  73         NLA_PUT_U8(msg, IEEE802154_ATTR_CAPABILITY, cap);
  74
  75         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
  76
  77 nla_put_failure:
  78         nlmsg_free(msg);
  79         return -ENOBUFS;
  80 }
  81 EXPORT_SYMBOL(ieee802154_nl_assoc_indic);
  82
  83 int ieee802154_nl_assoc_confirm(struct net_device *dev, u16 short_addr,
  84                 u8 status)
  85 {
  86         struct sk_buff *msg;
  87
  88         pr_debug("%s\n", __func__);
  89
  90         msg = ieee802154_nl_create(0, IEEE802154_ASSOCIATE_CONF);
  91         if (!msg)
  92                 return -ENOBUFS;
  93
  94         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
  95         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
  96         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
  97                         dev->dev_addr);
  98
  99         NLA_PUT_U16(msg, IEEE802154_ATTR_SHORT_ADDR, short_addr);
 100         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 101
 102         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 103
 104 nla_put_failure:
 105         nlmsg_free(msg);
 106         return -ENOBUFS;
 107 }
 108 EXPORT_SYMBOL(ieee802154_nl_assoc_confirm);
 109
 110 int ieee802154_nl_disassoc_indic(struct net_device *dev,
 111                 struct ieee802154_addr *addr, u8 reason)
 112 {
 113         struct sk_buff *msg;
 114
 115         pr_debug("%s\n", __func__);
 116
 117         msg = ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_INDIC);
 118         if (!msg)
 119                 return -ENOBUFS;
 120
 121         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 122         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 123         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 124                         dev->dev_addr);
 125
 126         if (addr->addr_type == IEEE802154_ADDR_LONG)
 127                 NLA_PUT(msg, IEEE802154_ATTR_SRC_HW_ADDR, IEEE802154_ADDR_LEN,
 128                                 addr->hwaddr);
 129         else
 130                 NLA_PUT_U16(msg, IEEE802154_ATTR_SRC_SHORT_ADDR,
 131                                 addr->short_addr);
 132
 133         NLA_PUT_U8(msg, IEEE802154_ATTR_REASON, reason);
 134
 135         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 136
 137 nla_put_failure:
 138         nlmsg_free(msg);
 139         return -ENOBUFS;
 140 }
 141 EXPORT_SYMBOL(ieee802154_nl_disassoc_indic);
 142
 143 int ieee802154_nl_disassoc_confirm(struct net_device *dev, u8 status)
 144 {
 145         struct sk_buff *msg;
 146
 147         pr_debug("%s\n", __func__);
 148
 149         msg = ieee802154_nl_create(0, IEEE802154_DISASSOCIATE_CONF);
 150         if (!msg)
 151                 return -ENOBUFS;
 152
 153         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 154         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 155         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 156                         dev->dev_addr);
 157
 158         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 159
 160         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 161
 162 nla_put_failure:
 163         nlmsg_free(msg);
 164         return -ENOBUFS;
 165 }
 166 EXPORT_SYMBOL(ieee802154_nl_disassoc_confirm);
 167
 168 int ieee802154_nl_beacon_indic(struct net_device *dev,
 169                 u16 panid, u16 coord_addr)
 170 {
 171         struct sk_buff *msg;
 172
 173         pr_debug("%s\n", __func__);
 174
 175         msg = ieee802154_nl_create(0, IEEE802154_BEACON_NOTIFY_INDIC);
 176         if (!msg)
 177                 return -ENOBUFS;
 178
 179         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 180         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 181         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 182                         dev->dev_addr);
 183         NLA_PUT_U16(msg, IEEE802154_ATTR_COORD_SHORT_ADDR, coord_addr);
 184         NLA_PUT_U16(msg, IEEE802154_ATTR_COORD_PAN_ID, panid);
 185
 186         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 187
 188 nla_put_failure:
 189         nlmsg_free(msg);
 190         return -ENOBUFS;
 191 }
 192 EXPORT_SYMBOL(ieee802154_nl_beacon_indic);
 193
 194 int ieee802154_nl_scan_confirm(struct net_device *dev,
 195                 u8 status, u8 scan_type, u32 unscanned, u8 page,
 196                 u8 *edl/* , struct list_head *pan_desc_list */)
 197 {
 198         struct sk_buff *msg;
 199
 200         pr_debug("%s\n", __func__);
 201
 202         msg = ieee802154_nl_create(0, IEEE802154_SCAN_CONF);
 203         if (!msg)
 204                 return -ENOBUFS;
 205
 206         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 207         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 208         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 209                         dev->dev_addr);
 210
 211         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 212         NLA_PUT_U8(msg, IEEE802154_ATTR_SCAN_TYPE, scan_type);
 213         NLA_PUT_U32(msg, IEEE802154_ATTR_CHANNELS, unscanned);
 214         NLA_PUT_U8(msg, IEEE802154_ATTR_PAGE, page);
 215
 216         if (edl)
 217                 NLA_PUT(msg, IEEE802154_ATTR_ED_LIST, 27, edl);
 218
 219         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 220
 221 nla_put_failure:
 222         nlmsg_free(msg);
 223         return -ENOBUFS;
 224 }
 225 EXPORT_SYMBOL(ieee802154_nl_scan_confirm);
 226
 227 int ieee802154_nl_start_confirm(struct net_device *dev, u8 status)
 228 {
 229         struct sk_buff *msg;
 230
 231         pr_debug("%s\n", __func__);
 232
 233         msg = ieee802154_nl_create(0, IEEE802154_START_CONF);
 234         if (!msg)
 235                 return -ENOBUFS;
 236
 237         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 238         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 239         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 240                         dev->dev_addr);
 241
 242         NLA_PUT_U8(msg, IEEE802154_ATTR_STATUS, status);
 243
 244         return ieee802154_nl_mcast(msg, ieee802154_coord_mcgrp.id);
 245
 246 nla_put_failure:
 247         nlmsg_free(msg);
 248         return -ENOBUFS;
 249 }
 250 EXPORT_SYMBOL(ieee802154_nl_start_confirm);
 251
 252 static int ieee802154_nl_fill_iface(struct sk_buff *msg, u32 pid,
 253         u32 seq, int flags, struct net_device *dev)
 254 {
 255         void *hdr;
 256         struct wpan_phy *phy;
 257
 258         pr_debug("%s\n", __func__);
 259
 260         hdr = genlmsg_put(msg, 0, seq, &nl802154_family, flags,
 261                 IEEE802154_LIST_IFACE);
 262         if (!hdr)
 263                 goto out;
 264
 265         phy = ieee802154_mlme_ops(dev)->get_phy(dev);
 266         BUG_ON(!phy);
 267
 268         NLA_PUT_STRING(msg, IEEE802154_ATTR_DEV_NAME, dev->name);
 269         NLA_PUT_STRING(msg, IEEE802154_ATTR_PHY_NAME, wpan_phy_name(phy));
 270         NLA_PUT_U32(msg, IEEE802154_ATTR_DEV_INDEX, dev->ifindex);
 271
 272         NLA_PUT(msg, IEEE802154_ATTR_HW_ADDR, IEEE802154_ADDR_LEN,
 273                 dev->dev_addr);
 274         NLA_PUT_U16(msg, IEEE802154_ATTR_SHORT_ADDR,
 275                 ieee802154_mlme_ops(dev)->get_short_addr(dev));
 276         NLA_PUT_U16(msg, IEEE802154_ATTR_PAN_ID,
 277                 ieee802154_mlme_ops(dev)->get_pan_id(dev));
 278         wpan_phy_put(phy);
 279         return genlmsg_end(msg, hdr);
 280
 281 nla_put_failure:
 282         wpan_phy_put(phy);
 283         genlmsg_cancel(msg, hdr);
 284 out:
 285         return -EMSGSIZE;
 286 }
 287
 288 /* Requests from userspace */
 289 static struct net_device *ieee802154_nl_get_dev(struct genl_info *info)
 290 {
 291         struct net_device *dev;
 292
 293         if (info->attrs[IEEE802154_ATTR_DEV_NAME]) {
 294                 char name[IFNAMSIZ + 1];
 295                 nla_strlcpy(name, info->attrs[IEEE802154_ATTR_DEV_NAME],
 296                                 sizeof(name));
 297                 dev = dev_get_by_name(&init_net, name);
 298         } else if (info->attrs[IEEE802154_ATTR_DEV_INDEX])
 299                 dev = dev_get_by_index(&init_net,
 300                         nla_get_u32(info->attrs[IEEE802154_ATTR_DEV_INDEX]));
 301         else
 302                 return NULL;
 303
 304         if (!dev)
 305                 return NULL;
 306
 307         if (dev->type != ARPHRD_IEEE802154) {
 308                 dev_put(dev);
 309                 return NULL;
 310         }
 311
 312         return dev;
 313 }
 314
 315 static int ieee802154_associate_req(struct sk_buff *skb,
 316                 struct genl_info *info)
 317 {
 318         struct net_device *dev;
 319         struct ieee802154_addr addr;
 320         u8 page;
 321         int ret = -EINVAL;
 322
 323         if (!info->attrs[IEEE802154_ATTR_CHANNEL] ||
 324             !info->attrs[IEEE802154_ATTR_COORD_PAN_ID] ||
 325             (!info->attrs[IEEE802154_ATTR_COORD_HW_ADDR] &&
 326                 !info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]) ||
 327             !info->attrs[IEEE802154_ATTR_CAPABILITY])
 328                 return -EINVAL;
 329
 330         dev = ieee802154_nl_get_dev(info);
 331         if (!dev)
 332                 return -ENODEV;
 333
 334         if (info->attrs[IEEE802154_ATTR_COORD_HW_ADDR]) {
 335                 addr.addr_type = IEEE802154_ADDR_LONG;
 336                 nla_memcpy(addr.hwaddr,
 337                                 info->attrs[IEEE802154_ATTR_COORD_HW_ADDR],
 338                                 IEEE802154_ADDR_LEN);
 339         } else {
 340                 addr.addr_type = IEEE802154_ADDR_SHORT;
 341                 addr.short_addr = nla_get_u16(
 342                                 info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]);
 343         }
 344         addr.pan_id = nla_get_u16(info->attrs[IEEE802154_ATTR_COORD_PAN_ID]);
 345
 346         if (info->attrs[IEEE802154_ATTR_PAGE])
 347                 page = nla_get_u8(info->attrs[IEEE802154_ATTR_PAGE]);
 348         else
 349                 page = 0;
 350
 351         ret = ieee802154_mlme_ops(dev)->assoc_req(dev, &addr,
 352                         nla_get_u8(info->attrs[IEEE802154_ATTR_CHANNEL]),
 353                         page,
 354                         nla_get_u8(info->attrs[IEEE802154_ATTR_CAPABILITY]));
 355
 356         dev_put(dev);
 357         return ret;
 358 }
 359
 360 static int ieee802154_associate_resp(struct sk_buff *skb,
 361                 struct genl_info *info)
 362 {
 363         struct net_device *dev;
 364         struct ieee802154_addr addr;
 365         int ret = -EINVAL;
 366
 367         if (!info->attrs[IEEE802154_ATTR_STATUS] ||
 368             !info->attrs[IEEE802154_ATTR_DEST_HW_ADDR] ||
 369             !info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR])
 370                 return -EINVAL;
 371
 372         dev = ieee802154_nl_get_dev(info);
 373         if (!dev)
 374                 return -ENODEV;
 375
 376         addr.addr_type = IEEE802154_ADDR_LONG;
 377         nla_memcpy(addr.hwaddr, info->attrs[IEEE802154_ATTR_DEST_HW_ADDR],
 378                         IEEE802154_ADDR_LEN);
 379         addr.pan_id = ieee802154_mlme_ops(dev)->get_pan_id(dev);
 380
 381
 382         ret = ieee802154_mlme_ops(dev)->assoc_resp(dev, &addr,
 383                 nla_get_u16(info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]),
 384                 nla_get_u8(info->attrs[IEEE802154_ATTR_STATUS]));
 385
 386         dev_put(dev);
 387         return ret;
 388 }
 389
 390 static int ieee802154_disassociate_req(struct sk_buff *skb,
 391                 struct genl_info *info)
 392 {
 393         struct net_device *dev;
 394         struct ieee802154_addr addr;
 395         int ret = -EINVAL;
 396
 397         if ((!info->attrs[IEEE802154_ATTR_DEST_HW_ADDR] &&
 398                 !info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]) ||
 399             !info->attrs[IEEE802154_ATTR_REASON])
 400                 return -EINVAL;
 401
 402         dev = ieee802154_nl_get_dev(info);
 403         if (!dev)
 404                 return -ENODEV;
 405
 406         if (info->attrs[IEEE802154_ATTR_DEST_HW_ADDR]) {
 407                 addr.addr_type = IEEE802154_ADDR_LONG;
 408                 nla_memcpy(addr.hwaddr,
 409                                 info->attrs[IEEE802154_ATTR_DEST_HW_ADDR],
 410                                 IEEE802154_ADDR_LEN);
 411         } else {
 412                 addr.addr_type = IEEE802154_ADDR_SHORT;
 413                 addr.short_addr = nla_get_u16(
 414                                 info->attrs[IEEE802154_ATTR_DEST_SHORT_ADDR]);
 415         }
 416         addr.pan_id = ieee802154_mlme_ops(dev)->get_pan_id(dev);
 417
 418         ret = ieee802154_mlme_ops(dev)->disassoc_req(dev, &addr,
 419                         nla_get_u8(info->attrs[IEEE802154_ATTR_REASON]));
 420
 421         dev_put(dev);
 422         return ret;
 423 }
 424
 425 /*
 426  * PANid, channel, beacon_order = 15, superframe_order = 15,
 427  * PAN_coordinator, battery_life_extension = 0,
 428  * coord_realignment = 0, security_enable = 0
 429 */
 430 static int ieee802154_start_req(struct sk_buff *skb, struct genl_info *info)
 431 {
 432         struct net_device *dev;
 433         struct ieee802154_addr addr;
 434
 435         u8 channel, bcn_ord, sf_ord;
 436         u8 page;
 437         int pan_coord, blx, coord_realign;
 438         int ret;
 439
 440         if (!info->attrs[IEEE802154_ATTR_COORD_PAN_ID] ||
 441             !info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR] ||
 442             !info->attrs[IEEE802154_ATTR_CHANNEL] ||
 443             !info->attrs[IEEE802154_ATTR_BCN_ORD] ||
 444             !info->attrs[IEEE802154_ATTR_SF_ORD] ||
 445             !info->attrs[IEEE802154_ATTR_PAN_COORD] ||
 446             !info->attrs[IEEE802154_ATTR_BAT_EXT] ||
 447             !info->attrs[IEEE802154_ATTR_COORD_REALIGN]
 448          )
 449                 return -EINVAL;
 450
 451         dev = ieee802154_nl_get_dev(info);
 452         if (!dev)
 453                 return -ENODEV;
 454
 455         addr.addr_type = IEEE802154_ADDR_SHORT;
 456         addr.short_addr = nla_get_u16(
 457                         info->attrs[IEEE802154_ATTR_COORD_SHORT_ADDR]);
 458         addr.pan_id = nla_get_u16(info->attrs[IEEE802154_ATTR_COORD_PAN_ID]);
 459
 460         channel = nla_get_u8(info->attrs[IEEE802154_ATTR_CHANNEL]);
 461         bcn_ord = nla_get_u8(info->attrs[IEEE802154_ATTR_BCN_ORD]);
 462         sf_ord = nla_get_u8(info->attrs[IEEE802154_ATTR_SF_ORD]);
 463         pan_coord = nla_get_u8(info->attrs[IEEE802154_ATTR_PAN_COORD]);
 464         blx = nla_get_u8(info->attrs[IEEE802154_ATTR_BAT_EXT]);
 465         coord_realign = nla_get_u8(info->attrs[IEEE802154_ATTR_COORD_REALIGN]);
 466
 467         if (info->attrs[IEEE802154_ATTR_PAGE])
 468                 page = nla_get_u8(info->attrs[IEEE802154_ATTR_PAGE]);
 469         else
 470                 page = 0;
 471
 472
 473         if (addr.short_addr == IEEE802154_ADDR_BROADCAST) {
 474                 ieee802154_nl_start_confirm(dev, IEEE802154_NO_SHORT_ADDRESS);
 475                 dev_put(dev);
 476                 return -EINVAL;
 477         }
 478
 479         ret = ieee802154_mlme_ops(dev)->start_req(dev, &addr, channel, page,
 480                 bcn_ord, sf_ord, pan_coord, blx, coord_realign);
 481
 482         dev_put(dev);
 483         return ret;
 484 }
 485
 486 static int ieee802154_scan_req(struct sk_buff *skb, struct genl_info *info)
 487 {
 488         struct net_device *dev;
 489         int ret;
 490         u8 type;
 491         u32 channels;
 492         u8 duration;
 493         u8 page;
 494
 495         if (!info->attrs[IEEE802154_ATTR_SCAN_TYPE] ||
 496             !info->attrs[IEEE802154_ATTR_CHANNELS] ||
 497             !info->attrs[IEEE802154_ATTR_DURATION])
 498                 return -EINVAL;
 499
 500         dev = ieee802154_nl_get_dev(info);
 501         if (!dev)
 502                 return -ENODEV;
 503
 504         type = nla_get_u8(info->attrs[IEEE802154_ATTR_SCAN_TYPE]);
 505         channels = nla_get_u32(info->attrs[IEEE802154_ATTR_CHANNELS]);
 506         duration = nla_get_u8(info->attrs[IEEE802154_ATTR_DURATION]);
 507
 508         if (info->attrs[IEEE802154_ATTR_PAGE])
 509                 page = nla_get_u8(info->attrs[IEEE802154_ATTR_PAGE]);
 510         else
 511                 page = 0;
 512
 513
 514         ret = ieee802154_mlme_ops(dev)->scan_req(dev, type, channels, page,
 515                         duration);
 516
 517         dev_put(dev);
 518         return ret;
 519 }
 520
 521 static int ieee802154_list_iface(struct sk_buff *skb,
 522         struct genl_info *info)
 523 {
 524         /* Request for interface name, index, type, IEEE address,
 525            PAN Id, short address */
 526         struct sk_buff *msg;
 527         struct net_device *dev = NULL;
 528         int rc = -ENOBUFS;
 529
 530         pr_debug("%s\n", __func__);
 531
 532         dev = ieee802154_nl_get_dev(info);
 533         if (!dev)
 534                 return -ENODEV;
 535
 536         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
 537         if (!msg)
 538                 goto out_dev;
 539
 540         rc = ieee802154_nl_fill_iface(msg, info->snd_pid, info->snd_seq,
 541                         0, dev);
 542         if (rc < 0)
 543                 goto out_free;
 544
 545         dev_put(dev);
 546
 547         return genlmsg_reply(msg, info);
 548 out_free:
 549         nlmsg_free(msg);
 550 out_dev:
 551         dev_put(dev);
 552         return rc;
 553
 554 }
 555
 556 static int ieee802154_dump_iface(struct sk_buff *skb,
 557         struct netlink_callback *cb)
 558 {
 559         struct net *net = sock_net(skb->sk);
 560         struct net_device *dev;
 561         int idx;
 562         int s_idx = cb->args[0];
 563
 564         pr_debug("%s\n", __func__);
 565
 566         idx = 0;
 567         for_each_netdev(net, dev) {
 568                 if (idx < s_idx || (dev->type != ARPHRD_IEEE802154))
 569                         goto cont;
 570
 571                 if (ieee802154_nl_fill_iface(skb, NETLINK_CB(cb->skb).pid,
 572                         cb->nlh->nlmsg_seq, NLM_F_MULTI, dev) < 0)
 573                         break;
 574 cont:
 575                 idx++;
 576         }
 577         cb->args[0] = idx;
 578
 579         return skb->len;
 580 }
 581
 582 static struct genl_ops ieee802154_coordinator_ops[] = {
 583         IEEE802154_OP(IEEE802154_ASSOCIATE_REQ, ieee802154_associate_req),
 584         IEEE802154_OP(IEEE802154_ASSOCIATE_RESP, ieee802154_associate_resp),
 585         IEEE802154_OP(IEEE802154_DISASSOCIATE_REQ, ieee802154_disassociate_req),
 586         IEEE802154_OP(IEEE802154_SCAN_REQ, ieee802154_scan_req),
 587         IEEE802154_OP(IEEE802154_START_REQ, ieee802154_start_req),
 588         IEEE802154_DUMP(IEEE802154_LIST_IFACE, ieee802154_list_iface,
 589                                                         ieee802154_dump_iface),
 590 };
 591
 592 /*
 593  * No need to unregister as family unregistration will do it.
 594  */
 595 int nl802154_mac_register(void)
 596 {
 597         int i;
 598         int rc;
 599
 600         rc = genl_register_mc_group(&nl802154_family,
 601                         &ieee802154_coord_mcgrp);
 602         if (rc)
 603                 return rc;
 604
 605         rc = genl_register_mc_group(&nl802154_family,
 606                         &ieee802154_beacon_mcgrp);
 607         if (rc)
 608                 return rc;
 609
 610         for (i = 0; i < ARRAY_SIZE(ieee802154_coordinator_ops); i++) {
 611                 rc = genl_register_ops(&nl802154_family,
 612                                 &ieee802154_coordinator_ops[i]);
 613                 if (rc)
 614                         return rc;
 615         }
 616
 617         return 0;
 618 }