git.maemo.org Git - h-e-n/blob - net/wireless/nl80211.c

   1 /*
   2  * This is the new netlink-based wireless configuration interface.
   3  *
   4  * Copyright 2006, 2007 Johannes Berg <johannes@sipsolutions.net>
   5  */
   6
   7 #include <linux/if.h>
   8 #include <linux/module.h>
   9 #include <linux/err.h>
  10 #include <linux/mutex.h>
  11 #include <linux/list.h>
  12 #include <linux/if_ether.h>
  13 #include <linux/ieee80211.h>
  14 #include <linux/nl80211.h>
  15 #include <linux/rtnetlink.h>
  16 #include <linux/netlink.h>
  17 #include <net/genetlink.h>
  18 #include <net/cfg80211.h>
  19 #include "core.h"
  20 #include "nl80211.h"
  21 #include "reg.h"
  22
  23 /* the netlink family */
  24 static struct genl_family nl80211_fam = {
  25         .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
  26         .name = "nl80211",      /* have users key off the name instead */
  27         .hdrsize = 0,           /* no private header */
  28         .version = 1,           /* no particular meaning now */
  29         .maxattr = NL80211_ATTR_MAX,
  30 };
  31
  32 /* internal helper: get drv and dev */
  33 static int get_drv_dev_by_info_ifindex(struct nlattr **attrs,
  34                                        struct cfg80211_registered_device **drv,
  35                                        struct net_device **dev)
  36 {
  37         int ifindex;
  38
  39         if (!attrs[NL80211_ATTR_IFINDEX])
  40                 return -EINVAL;
  41
  42         ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  43         *dev = dev_get_by_index(&init_net, ifindex);
  44         if (!*dev)
  45                 return -ENODEV;
  46
  47         *drv = cfg80211_get_dev_from_ifindex(ifindex);
  48         if (IS_ERR(*drv)) {
  49                 dev_put(*dev);
  50                 return PTR_ERR(*drv);
  51         }
  52
  53         return 0;
  54 }
  55
  56 /* policy for the attributes */
  57 static struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] __read_mostly = {
  58         [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  59         [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  60                                       .len = BUS_ID_SIZE-1 },
  61
  62         [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
  63         [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  64         [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  65
  66         [NL80211_ATTR_MAC] = { .type = NLA_BINARY, .len = ETH_ALEN },
  67
  68         [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  69                                     .len = WLAN_MAX_KEY_LEN },
  70         [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
  71         [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  72         [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  73
  74         [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  75         [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  76         [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
  77                                        .len = IEEE80211_MAX_DATA_LEN },
  78         [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
  79                                        .len = IEEE80211_MAX_DATA_LEN },
  80         [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
  81         [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  82         [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  83         [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  84                                                .len = NL80211_MAX_SUPP_RATES },
  85         [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
  86         [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  87         [NL80211_ATTR_MNTR_FLAGS] = { .type = NLA_NESTED },
  88         [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  89                                 .len = IEEE80211_MAX_MESH_ID_LEN },
  90         [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
  91
  92         [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
  93         [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  94
  95         [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  96         [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  97         [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  98
  99         [NL80211_ATTR_HT_CAPABILITY] = { .type = NLA_BINARY,
 100                                          .len = NL80211_HT_CAPABILITY_LEN },
 101 };
 102
 103 /* message building helper */
 104 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 pid, u32 seq,
 105                                    int flags, u8 cmd)
 106 {
 107         /* since there is no private header just add the generic one */
 108         return genlmsg_put(skb, pid, seq, &nl80211_fam, flags, cmd);
 109 }
 110
 111 /* netlink command implementations */
 112
 113 static int nl80211_send_wiphy(struct sk_buff *msg, u32 pid, u32 seq, int flags,
 114                               struct cfg80211_registered_device *dev)
 115 {
 116         void *hdr;
 117         struct nlattr *nl_bands, *nl_band;
 118         struct nlattr *nl_freqs, *nl_freq;
 119         struct nlattr *nl_rates, *nl_rate;
 120         struct nlattr *nl_modes;
 121         enum ieee80211_band band;
 122         struct ieee80211_channel *chan;
 123         struct ieee80211_rate *rate;
 124         int i;
 125         u16 ifmodes = dev->wiphy.interface_modes;
 126
 127         hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_WIPHY);
 128         if (!hdr)
 129                 return -1;
 130
 131         NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, dev->idx);
 132         NLA_PUT_STRING(msg, NL80211_ATTR_WIPHY_NAME, wiphy_name(&dev->wiphy));
 133
 134         nl_modes = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_IFTYPES);
 135         if (!nl_modes)
 136                 goto nla_put_failure;
 137
 138         i = 0;
 139         while (ifmodes) {
 140                 if (ifmodes & 1)
 141                         NLA_PUT_FLAG(msg, i);
 142                 ifmodes >>= 1;
 143                 i++;
 144         }
 145
 146         nla_nest_end(msg, nl_modes);
 147
 148         nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
 149         if (!nl_bands)
 150                 goto nla_put_failure;
 151
 152         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
 153                 if (!dev->wiphy.bands[band])
 154                         continue;
 155
 156                 nl_band = nla_nest_start(msg, band);
 157                 if (!nl_band)
 158                         goto nla_put_failure;
 159
 160                 /* add frequencies */
 161                 nl_freqs = nla_nest_start(msg, NL80211_BAND_ATTR_FREQS);
 162                 if (!nl_freqs)
 163                         goto nla_put_failure;
 164
 165                 for (i = 0; i < dev->wiphy.bands[band]->n_channels; i++) {
 166                         nl_freq = nla_nest_start(msg, i);
 167                         if (!nl_freq)
 168                                 goto nla_put_failure;
 169
 170                         chan = &dev->wiphy.bands[band]->channels[i];
 171                         NLA_PUT_U32(msg, NL80211_FREQUENCY_ATTR_FREQ,
 172                                     chan->center_freq);
 173
 174                         if (chan->flags & IEEE80211_CHAN_DISABLED)
 175                                 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_DISABLED);
 176                         if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
 177                                 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN);
 178                         if (chan->flags & IEEE80211_CHAN_NO_IBSS)
 179                                 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_NO_IBSS);
 180                         if (chan->flags & IEEE80211_CHAN_RADAR)
 181                                 NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_RADAR);
 182
 183                         nla_nest_end(msg, nl_freq);
 184                 }
 185
 186                 nla_nest_end(msg, nl_freqs);
 187
 188                 /* add bitrates */
 189                 nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
 190                 if (!nl_rates)
 191                         goto nla_put_failure;
 192
 193                 for (i = 0; i < dev->wiphy.bands[band]->n_bitrates; i++) {
 194                         nl_rate = nla_nest_start(msg, i);
 195                         if (!nl_rate)
 196                                 goto nla_put_failure;
 197
 198                         rate = &dev->wiphy.bands[band]->bitrates[i];
 199                         NLA_PUT_U32(msg, NL80211_BITRATE_ATTR_RATE,
 200                                     rate->bitrate);
 201                         if (rate->flags & IEEE80211_RATE_SHORT_PREAMBLE)
 202                                 NLA_PUT_FLAG(msg,
 203                                         NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE);
 204
 205                         nla_nest_end(msg, nl_rate);
 206                 }
 207
 208                 nla_nest_end(msg, nl_rates);
 209
 210                 nla_nest_end(msg, nl_band);
 211         }
 212         nla_nest_end(msg, nl_bands);
 213
 214         return genlmsg_end(msg, hdr);
 215
 216  nla_put_failure:
 217         genlmsg_cancel(msg, hdr);
 218         return -EMSGSIZE;
 219 }
 220
 221 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
 222 {
 223         int idx = 0;
 224         int start = cb->args[0];
 225         struct cfg80211_registered_device *dev;
 226
 227         mutex_lock(&cfg80211_drv_mutex);
 228         list_for_each_entry(dev, &cfg80211_drv_list, list) {
 229                 if (++idx <= start)
 230                         continue;
 231                 if (nl80211_send_wiphy(skb, NETLINK_CB(cb->skb).pid,
 232                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
 233                                        dev) < 0) {
 234                         idx--;
 235                         break;
 236                 }
 237         }
 238         mutex_unlock(&cfg80211_drv_mutex);
 239
 240         cb->args[0] = idx;
 241
 242         return skb->len;
 243 }
 244
 245 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
 246 {
 247         struct sk_buff *msg;
 248         struct cfg80211_registered_device *dev;
 249
 250         dev = cfg80211_get_dev_from_info(info);
 251         if (IS_ERR(dev))
 252                 return PTR_ERR(dev);
 253
 254         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
 255         if (!msg)
 256                 goto out_err;
 257
 258         if (nl80211_send_wiphy(msg, info->snd_pid, info->snd_seq, 0, dev) < 0)
 259                 goto out_free;
 260
 261         cfg80211_put_dev(dev);
 262
 263         return genlmsg_unicast(msg, info->snd_pid);
 264
 265  out_free:
 266         nlmsg_free(msg);
 267  out_err:
 268         cfg80211_put_dev(dev);
 269         return -ENOBUFS;
 270 }
 271
 272 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
 273 {
 274         struct cfg80211_registered_device *rdev;
 275         int result;
 276
 277         if (!info->attrs[NL80211_ATTR_WIPHY_NAME])
 278                 return -EINVAL;
 279
 280         rdev = cfg80211_get_dev_from_info(info);
 281         if (IS_ERR(rdev))
 282                 return PTR_ERR(rdev);
 283
 284         result = cfg80211_dev_rename(rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
 285
 286         cfg80211_put_dev(rdev);
 287         return result;
 288 }
 289
 290
 291 static int nl80211_send_iface(struct sk_buff *msg, u32 pid, u32 seq, int flags,
 292                               struct net_device *dev)
 293 {
 294         void *hdr;
 295
 296         hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_INTERFACE);
 297         if (!hdr)
 298                 return -1;
 299
 300         NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
 301         NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, dev->name);
 302         NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, dev->ieee80211_ptr->iftype);
 303         return genlmsg_end(msg, hdr);
 304
 305  nla_put_failure:
 306         genlmsg_cancel(msg, hdr);
 307         return -EMSGSIZE;
 308 }
 309
 310 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
 311 {
 312         int wp_idx = 0;
 313         int if_idx = 0;
 314         int wp_start = cb->args[0];
 315         int if_start = cb->args[1];
 316         struct cfg80211_registered_device *dev;
 317         struct wireless_dev *wdev;
 318
 319         mutex_lock(&cfg80211_drv_mutex);
 320         list_for_each_entry(dev, &cfg80211_drv_list, list) {
 321                 if (wp_idx < wp_start) {
 322                         wp_idx++;
 323                         continue;
 324                 }
 325                 if_idx = 0;
 326
 327                 mutex_lock(&dev->devlist_mtx);
 328                 list_for_each_entry(wdev, &dev->netdev_list, list) {
 329                         if (if_idx < if_start) {
 330                                 if_idx++;
 331                                 continue;
 332                         }
 333                         if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).pid,
 334                                                cb->nlh->nlmsg_seq, NLM_F_MULTI,
 335                                                wdev->netdev) < 0) {
 336                                 mutex_unlock(&dev->devlist_mtx);
 337                                 goto out;
 338                         }
 339                         if_idx++;
 340                 }
 341                 mutex_unlock(&dev->devlist_mtx);
 342
 343                 wp_idx++;
 344         }
 345  out:
 346         mutex_unlock(&cfg80211_drv_mutex);
 347
 348         cb->args[0] = wp_idx;
 349         cb->args[1] = if_idx;
 350
 351         return skb->len;
 352 }
 353
 354 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
 355 {
 356         struct sk_buff *msg;
 357         struct cfg80211_registered_device *dev;
 358         struct net_device *netdev;
 359         int err;
 360
 361         err = get_drv_dev_by_info_ifindex(info->attrs, &dev, &netdev);
 362         if (err)
 363                 return err;
 364
 365         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
 366         if (!msg)
 367                 goto out_err;
 368
 369         if (nl80211_send_iface(msg, info->snd_pid, info->snd_seq, 0, netdev) < 0)
 370                 goto out_free;
 371
 372         dev_put(netdev);
 373         cfg80211_put_dev(dev);
 374
 375         return genlmsg_unicast(msg, info->snd_pid);
 376
 377  out_free:
 378         nlmsg_free(msg);
 379  out_err:
 380         dev_put(netdev);
 381         cfg80211_put_dev(dev);
 382         return -ENOBUFS;
 383 }
 384
 385 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
 386         [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
 387         [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
 388         [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
 389         [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
 390         [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
 391 };
 392
 393 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
 394 {
 395         struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
 396         int flag;
 397
 398         *mntrflags = 0;
 399
 400         if (!nla)
 401                 return -EINVAL;
 402
 403         if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
 404                              nla, mntr_flags_policy))
 405                 return -EINVAL;
 406
 407         for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
 408                 if (flags[flag])
 409                         *mntrflags |= (1<<flag);
 410
 411         return 0;
 412 }
 413
 414 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
 415 {
 416         struct cfg80211_registered_device *drv;
 417         struct vif_params params;
 418         int err, ifindex;
 419         enum nl80211_iftype type;
 420         struct net_device *dev;
 421         u32 _flags, *flags = NULL;
 422
 423         memset(&params, 0, sizeof(params));
 424
 425         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 426         if (err)
 427                 return err;
 428         ifindex = dev->ifindex;
 429         type = dev->ieee80211_ptr->iftype;
 430         dev_put(dev);
 431
 432         err = -EINVAL;
 433         if (info->attrs[NL80211_ATTR_IFTYPE]) {
 434                 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
 435                 if (type > NL80211_IFTYPE_MAX)
 436                         goto unlock;
 437         }
 438
 439         if (!drv->ops->change_virtual_intf ||
 440             !(drv->wiphy.interface_modes & (1 << type))) {
 441                 err = -EOPNOTSUPP;
 442                 goto unlock;
 443         }
 444
 445         if (info->attrs[NL80211_ATTR_MESH_ID]) {
 446                 if (type != NL80211_IFTYPE_MESH_POINT) {
 447                         err = -EINVAL;
 448                         goto unlock;
 449                 }
 450                 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
 451                 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
 452         }
 453
 454         if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
 455                 if (type != NL80211_IFTYPE_MONITOR) {
 456                         err = -EINVAL;
 457                         goto unlock;
 458                 }
 459                 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
 460                                           &_flags);
 461                 if (!err)
 462                         flags = &_flags;
 463         }
 464         rtnl_lock();
 465         err = drv->ops->change_virtual_intf(&drv->wiphy, ifindex,
 466                                             type, flags, &params);
 467
 468         dev = __dev_get_by_index(&init_net, ifindex);
 469         WARN_ON(!dev || (!err && dev->ieee80211_ptr->iftype != type));
 470
 471         rtnl_unlock();
 472
 473  unlock:
 474         cfg80211_put_dev(drv);
 475         return err;
 476 }
 477
 478 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
 479 {
 480         struct cfg80211_registered_device *drv;
 481         struct vif_params params;
 482         int err;
 483         enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
 484         u32 flags;
 485
 486         memset(&params, 0, sizeof(params));
 487
 488         if (!info->attrs[NL80211_ATTR_IFNAME])
 489                 return -EINVAL;
 490
 491         if (info->attrs[NL80211_ATTR_IFTYPE]) {
 492                 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
 493                 if (type > NL80211_IFTYPE_MAX)
 494                         return -EINVAL;
 495         }
 496
 497         drv = cfg80211_get_dev_from_info(info);
 498         if (IS_ERR(drv))
 499                 return PTR_ERR(drv);
 500
 501         if (!drv->ops->add_virtual_intf ||
 502             !(drv->wiphy.interface_modes & (1 << type))) {
 503                 err = -EOPNOTSUPP;
 504                 goto unlock;
 505         }
 506
 507         if (type == NL80211_IFTYPE_MESH_POINT &&
 508             info->attrs[NL80211_ATTR_MESH_ID]) {
 509                 params.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
 510                 params.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
 511         }
 512
 513         rtnl_lock();
 514         err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
 515                                   info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
 516                                   &flags);
 517         err = drv->ops->add_virtual_intf(&drv->wiphy,
 518                 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
 519                 type, err ? NULL : &flags, &params);
 520         rtnl_unlock();
 521
 522
 523  unlock:
 524         cfg80211_put_dev(drv);
 525         return err;
 526 }
 527
 528 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
 529 {
 530         struct cfg80211_registered_device *drv;
 531         int ifindex, err;
 532         struct net_device *dev;
 533
 534         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 535         if (err)
 536                 return err;
 537         ifindex = dev->ifindex;
 538         dev_put(dev);
 539
 540         if (!drv->ops->del_virtual_intf) {
 541                 err = -EOPNOTSUPP;
 542                 goto out;
 543         }
 544
 545         rtnl_lock();
 546         err = drv->ops->del_virtual_intf(&drv->wiphy, ifindex);
 547         rtnl_unlock();
 548
 549  out:
 550         cfg80211_put_dev(drv);
 551         return err;
 552 }
 553
 554 struct get_key_cookie {
 555         struct sk_buff *msg;
 556         int error;
 557 };
 558
 559 static void get_key_callback(void *c, struct key_params *params)
 560 {
 561         struct get_key_cookie *cookie = c;
 562
 563         if (params->key)
 564                 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_DATA,
 565                         params->key_len, params->key);
 566
 567         if (params->seq)
 568                 NLA_PUT(cookie->msg, NL80211_ATTR_KEY_SEQ,
 569                         params->seq_len, params->seq);
 570
 571         if (params->cipher)
 572                 NLA_PUT_U32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
 573                             params->cipher);
 574
 575         return;
 576  nla_put_failure:
 577         cookie->error = 1;
 578 }
 579
 580 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
 581 {
 582         struct cfg80211_registered_device *drv;
 583         int err;
 584         struct net_device *dev;
 585         u8 key_idx = 0;
 586         u8 *mac_addr = NULL;
 587         struct get_key_cookie cookie = {
 588                 .error = 0,
 589         };
 590         void *hdr;
 591         struct sk_buff *msg;
 592
 593         if (info->attrs[NL80211_ATTR_KEY_IDX])
 594                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
 595
 596         if (key_idx > 3)
 597                 return -EINVAL;
 598
 599         if (info->attrs[NL80211_ATTR_MAC])
 600                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
 601
 602         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 603         if (err)
 604                 return err;
 605
 606         if (!drv->ops->get_key) {
 607                 err = -EOPNOTSUPP;
 608                 goto out;
 609         }
 610
 611         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
 612         if (!msg) {
 613                 err = -ENOMEM;
 614                 goto out;
 615         }
 616
 617         hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
 618                              NL80211_CMD_NEW_KEY);
 619
 620         if (IS_ERR(hdr)) {
 621                 err = PTR_ERR(hdr);
 622                 goto free_msg;
 623         }
 624
 625         cookie.msg = msg;
 626
 627         NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
 628         NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_idx);
 629         if (mac_addr)
 630                 NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 631
 632         rtnl_lock();
 633         err = drv->ops->get_key(&drv->wiphy, dev, key_idx, mac_addr,
 634                                 &cookie, get_key_callback);
 635         rtnl_unlock();
 636
 637         if (err)
 638                 goto free_msg;
 639
 640         if (cookie.error)
 641                 goto nla_put_failure;
 642
 643         genlmsg_end(msg, hdr);
 644         err = genlmsg_unicast(msg, info->snd_pid);
 645         goto out;
 646
 647  nla_put_failure:
 648         err = -ENOBUFS;
 649  free_msg:
 650         nlmsg_free(msg);
 651  out:
 652         cfg80211_put_dev(drv);
 653         dev_put(dev);
 654         return err;
 655 }
 656
 657 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
 658 {
 659         struct cfg80211_registered_device *drv;
 660         int err;
 661         struct net_device *dev;
 662         u8 key_idx;
 663
 664         if (!info->attrs[NL80211_ATTR_KEY_IDX])
 665                 return -EINVAL;
 666
 667         key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
 668
 669         if (key_idx > 3)
 670                 return -EINVAL;
 671
 672         /* currently only support setting default key */
 673         if (!info->attrs[NL80211_ATTR_KEY_DEFAULT])
 674                 return -EINVAL;
 675
 676         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 677         if (err)
 678                 return err;
 679
 680         if (!drv->ops->set_default_key) {
 681                 err = -EOPNOTSUPP;
 682                 goto out;
 683         }
 684
 685         rtnl_lock();
 686         err = drv->ops->set_default_key(&drv->wiphy, dev, key_idx);
 687         rtnl_unlock();
 688
 689  out:
 690         cfg80211_put_dev(drv);
 691         dev_put(dev);
 692         return err;
 693 }
 694
 695 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
 696 {
 697         struct cfg80211_registered_device *drv;
 698         int err;
 699         struct net_device *dev;
 700         struct key_params params;
 701         u8 key_idx = 0;
 702         u8 *mac_addr = NULL;
 703
 704         memset(&params, 0, sizeof(params));
 705
 706         if (!info->attrs[NL80211_ATTR_KEY_CIPHER])
 707                 return -EINVAL;
 708
 709         if (info->attrs[NL80211_ATTR_KEY_DATA]) {
 710                 params.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
 711                 params.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
 712         }
 713
 714         if (info->attrs[NL80211_ATTR_KEY_IDX])
 715                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
 716
 717         params.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
 718
 719         if (info->attrs[NL80211_ATTR_MAC])
 720                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
 721
 722         if (key_idx > 3)
 723                 return -EINVAL;
 724
 725         /*
 726          * Disallow pairwise keys with non-zero index unless it's WEP
 727          * (because current deployments use pairwise WEP keys with
 728          * non-zero indizes but 802.11i clearly specifies to use zero)
 729          */
 730         if (mac_addr && key_idx &&
 731             params.cipher != WLAN_CIPHER_SUITE_WEP40 &&
 732             params.cipher != WLAN_CIPHER_SUITE_WEP104)
 733                 return -EINVAL;
 734
 735         /* TODO: add definitions for the lengths to linux/ieee80211.h */
 736         switch (params.cipher) {
 737         case WLAN_CIPHER_SUITE_WEP40:
 738                 if (params.key_len != 5)
 739                         return -EINVAL;
 740                 break;
 741         case WLAN_CIPHER_SUITE_TKIP:
 742                 if (params.key_len != 32)
 743                         return -EINVAL;
 744                 break;
 745         case WLAN_CIPHER_SUITE_CCMP:
 746                 if (params.key_len != 16)
 747                         return -EINVAL;
 748                 break;
 749         case WLAN_CIPHER_SUITE_WEP104:
 750                 if (params.key_len != 13)
 751                         return -EINVAL;
 752                 break;
 753         default:
 754                 return -EINVAL;
 755         }
 756
 757         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 758         if (err)
 759                 return err;
 760
 761         if (!drv->ops->add_key) {
 762                 err = -EOPNOTSUPP;
 763                 goto out;
 764         }
 765
 766         rtnl_lock();
 767         err = drv->ops->add_key(&drv->wiphy, dev, key_idx, mac_addr, &params);
 768         rtnl_unlock();
 769
 770  out:
 771         cfg80211_put_dev(drv);
 772         dev_put(dev);
 773         return err;
 774 }
 775
 776 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
 777 {
 778         struct cfg80211_registered_device *drv;
 779         int err;
 780         struct net_device *dev;
 781         u8 key_idx = 0;
 782         u8 *mac_addr = NULL;
 783
 784         if (info->attrs[NL80211_ATTR_KEY_IDX])
 785                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
 786
 787         if (key_idx > 3)
 788                 return -EINVAL;
 789
 790         if (info->attrs[NL80211_ATTR_MAC])
 791                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
 792
 793         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 794         if (err)
 795                 return err;
 796
 797         if (!drv->ops->del_key) {
 798                 err = -EOPNOTSUPP;
 799                 goto out;
 800         }
 801
 802         rtnl_lock();
 803         err = drv->ops->del_key(&drv->wiphy, dev, key_idx, mac_addr);
 804         rtnl_unlock();
 805
 806  out:
 807         cfg80211_put_dev(drv);
 808         dev_put(dev);
 809         return err;
 810 }
 811
 812 static int nl80211_addset_beacon(struct sk_buff *skb, struct genl_info *info)
 813 {
 814         int (*call)(struct wiphy *wiphy, struct net_device *dev,
 815                     struct beacon_parameters *info);
 816         struct cfg80211_registered_device *drv;
 817         int err;
 818         struct net_device *dev;
 819         struct beacon_parameters params;
 820         int haveinfo = 0;
 821
 822         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 823         if (err)
 824                 return err;
 825
 826         switch (info->genlhdr->cmd) {
 827         case NL80211_CMD_NEW_BEACON:
 828                 /* these are required for NEW_BEACON */
 829                 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
 830                     !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
 831                     !info->attrs[NL80211_ATTR_BEACON_HEAD]) {
 832                         err = -EINVAL;
 833                         goto out;
 834                 }
 835
 836                 call = drv->ops->add_beacon;
 837                 break;
 838         case NL80211_CMD_SET_BEACON:
 839                 call = drv->ops->set_beacon;
 840                 break;
 841         default:
 842                 WARN_ON(1);
 843                 err = -EOPNOTSUPP;
 844                 goto out;
 845         }
 846
 847         if (!call) {
 848                 err = -EOPNOTSUPP;
 849                 goto out;
 850         }
 851
 852         memset(&params, 0, sizeof(params));
 853
 854         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
 855                 params.interval =
 856                     nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
 857                 haveinfo = 1;
 858         }
 859
 860         if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
 861                 params.dtim_period =
 862                     nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
 863                 haveinfo = 1;
 864         }
 865
 866         if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
 867                 params.head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
 868                 params.head_len =
 869                     nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
 870                 haveinfo = 1;
 871         }
 872
 873         if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
 874                 params.tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
 875                 params.tail_len =
 876                     nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
 877                 haveinfo = 1;
 878         }
 879
 880         if (!haveinfo) {
 881                 err = -EINVAL;
 882                 goto out;
 883         }
 884
 885         rtnl_lock();
 886         err = call(&drv->wiphy, dev, &params);
 887         rtnl_unlock();
 888
 889  out:
 890         cfg80211_put_dev(drv);
 891         dev_put(dev);
 892         return err;
 893 }
 894
 895 static int nl80211_del_beacon(struct sk_buff *skb, struct genl_info *info)
 896 {
 897         struct cfg80211_registered_device *drv;
 898         int err;
 899         struct net_device *dev;
 900
 901         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
 902         if (err)
 903                 return err;
 904
 905         if (!drv->ops->del_beacon) {
 906                 err = -EOPNOTSUPP;
 907                 goto out;
 908         }
 909
 910         rtnl_lock();
 911         err = drv->ops->del_beacon(&drv->wiphy, dev);
 912         rtnl_unlock();
 913
 914  out:
 915         cfg80211_put_dev(drv);
 916         dev_put(dev);
 917         return err;
 918 }
 919
 920 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
 921         [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
 922         [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
 923         [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
 924 };
 925
 926 static int parse_station_flags(struct nlattr *nla, u32 *staflags)
 927 {
 928         struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
 929         int flag;
 930
 931         *staflags = 0;
 932
 933         if (!nla)
 934                 return 0;
 935
 936         if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
 937                              nla, sta_flags_policy))
 938                 return -EINVAL;
 939
 940         *staflags = STATION_FLAG_CHANGED;
 941
 942         for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++)
 943                 if (flags[flag])
 944                         *staflags |= (1<<flag);
 945
 946         return 0;
 947 }
 948
 949 static int nl80211_send_station(struct sk_buff *msg, u32 pid, u32 seq,
 950                                 int flags, struct net_device *dev,
 951                                 u8 *mac_addr, struct station_info *sinfo)
 952 {
 953         void *hdr;
 954         struct nlattr *sinfoattr;
 955
 956         hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
 957         if (!hdr)
 958                 return -1;
 959
 960         NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
 961         NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
 962
 963         sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
 964         if (!sinfoattr)
 965                 goto nla_put_failure;
 966         if (sinfo->filled & STATION_INFO_INACTIVE_TIME)
 967                 NLA_PUT_U32(msg, NL80211_STA_INFO_INACTIVE_TIME,
 968                             sinfo->inactive_time);
 969         if (sinfo->filled & STATION_INFO_RX_BYTES)
 970                 NLA_PUT_U32(msg, NL80211_STA_INFO_RX_BYTES,
 971                             sinfo->rx_bytes);
 972         if (sinfo->filled & STATION_INFO_TX_BYTES)
 973                 NLA_PUT_U32(msg, NL80211_STA_INFO_TX_BYTES,
 974                             sinfo->tx_bytes);
 975         if (sinfo->filled & STATION_INFO_LLID)
 976                 NLA_PUT_U16(msg, NL80211_STA_INFO_LLID,
 977                             sinfo->llid);
 978         if (sinfo->filled & STATION_INFO_PLID)
 979                 NLA_PUT_U16(msg, NL80211_STA_INFO_PLID,
 980                             sinfo->plid);
 981         if (sinfo->filled & STATION_INFO_PLINK_STATE)
 982                 NLA_PUT_U8(msg, NL80211_STA_INFO_PLINK_STATE,
 983                             sinfo->plink_state);
 984
 985         nla_nest_end(msg, sinfoattr);
 986
 987         return genlmsg_end(msg, hdr);
 988
 989  nla_put_failure:
 990         genlmsg_cancel(msg, hdr);
 991         return -EMSGSIZE;
 992 }
 993
 994 static int nl80211_dump_station(struct sk_buff *skb,
 995                                 struct netlink_callback *cb)
 996 {
 997         struct station_info sinfo;
 998         struct cfg80211_registered_device *dev;
 999         struct net_device *netdev;
1000         u8 mac_addr[ETH_ALEN];
1001         int ifidx = cb->args[0];
1002         int sta_idx = cb->args[1];
1003         int err;
1004
1005         if (!ifidx) {
1006                 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
1007                                   nl80211_fam.attrbuf, nl80211_fam.maxattr,
1008                                   nl80211_policy);
1009                 if (err)
1010                         return err;
1011
1012                 if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
1013                         return -EINVAL;
1014
1015                 ifidx = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
1016                 if (!ifidx)
1017                         return -EINVAL;
1018         }
1019
1020         netdev = dev_get_by_index(&init_net, ifidx);
1021         if (!netdev)
1022                 return -ENODEV;
1023
1024         dev = cfg80211_get_dev_from_ifindex(ifidx);
1025         if (IS_ERR(dev)) {
1026                 err = PTR_ERR(dev);
1027                 goto out_put_netdev;
1028         }
1029
1030         if (!dev->ops->dump_station) {
1031                 err = -ENOSYS;
1032                 goto out_err;
1033         }
1034
1035         rtnl_lock();
1036
1037         while (1) {
1038                 err = dev->ops->dump_station(&dev->wiphy, netdev, sta_idx,
1039                                              mac_addr, &sinfo);
1040                 if (err == -ENOENT)
1041                         break;
1042                 if (err)
1043                         goto out_err_rtnl;
1044
1045                 if (nl80211_send_station(skb,
1046                                 NETLINK_CB(cb->skb).pid,
1047                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1048                                 netdev, mac_addr,
1049                                 &sinfo) < 0)
1050                         goto out;
1051
1052                 sta_idx++;
1053         }
1054
1055
1056  out:
1057         cb->args[1] = sta_idx;
1058         err = skb->len;
1059  out_err_rtnl:
1060         rtnl_unlock();
1061  out_err:
1062         cfg80211_put_dev(dev);
1063  out_put_netdev:
1064         dev_put(netdev);
1065
1066         return err;
1067 }
1068
1069 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
1070 {
1071         struct cfg80211_registered_device *drv;
1072         int err;
1073         struct net_device *dev;
1074         struct station_info sinfo;
1075         struct sk_buff *msg;
1076         u8 *mac_addr = NULL;
1077
1078         memset(&sinfo, 0, sizeof(sinfo));
1079
1080         if (!info->attrs[NL80211_ATTR_MAC])
1081                 return -EINVAL;
1082
1083         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1084
1085         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1086         if (err)
1087                 return err;
1088
1089         if (!drv->ops->get_station) {
1090                 err = -EOPNOTSUPP;
1091                 goto out;
1092         }
1093
1094         rtnl_lock();
1095         err = drv->ops->get_station(&drv->wiphy, dev, mac_addr, &sinfo);
1096         rtnl_unlock();
1097
1098         if (err)
1099                 goto out;
1100
1101         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1102         if (!msg)
1103                 goto out;
1104
1105         if (nl80211_send_station(msg, info->snd_pid, info->snd_seq, 0,
1106                                  dev, mac_addr, &sinfo) < 0)
1107                 goto out_free;
1108
1109         err = genlmsg_unicast(msg, info->snd_pid);
1110         goto out;
1111
1112  out_free:
1113         nlmsg_free(msg);
1114
1115  out:
1116         cfg80211_put_dev(drv);
1117         dev_put(dev);
1118         return err;
1119 }
1120
1121 /*
1122  * Get vlan interface making sure it is on the right wiphy.
1123  */
1124 static int get_vlan(struct nlattr *vlanattr,
1125                     struct cfg80211_registered_device *rdev,
1126                     struct net_device **vlan)
1127 {
1128         *vlan = NULL;
1129
1130         if (vlanattr) {
1131                 *vlan = dev_get_by_index(&init_net, nla_get_u32(vlanattr));
1132                 if (!*vlan)
1133                         return -ENODEV;
1134                 if (!(*vlan)->ieee80211_ptr)
1135                         return -EINVAL;
1136                 if ((*vlan)->ieee80211_ptr->wiphy != &rdev->wiphy)
1137                         return -EINVAL;
1138         }
1139         return 0;
1140 }
1141
1142 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
1143 {
1144         struct cfg80211_registered_device *drv;
1145         int err;
1146         struct net_device *dev;
1147         struct station_parameters params;
1148         u8 *mac_addr = NULL;
1149
1150         memset(&params, 0, sizeof(params));
1151
1152         params.listen_interval = -1;
1153
1154         if (info->attrs[NL80211_ATTR_STA_AID])
1155                 return -EINVAL;
1156
1157         if (!info->attrs[NL80211_ATTR_MAC])
1158                 return -EINVAL;
1159
1160         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1161
1162         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
1163                 params.supported_rates =
1164                         nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
1165                 params.supported_rates_len =
1166                         nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
1167         }
1168
1169         if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
1170                 params.listen_interval =
1171                     nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
1172
1173         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
1174                 params.ht_capa =
1175                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
1176
1177         if (parse_station_flags(info->attrs[NL80211_ATTR_STA_FLAGS],
1178                                 &params.station_flags))
1179                 return -EINVAL;
1180
1181         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
1182                 params.plink_action =
1183                     nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
1184
1185         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1186         if (err)
1187                 return err;
1188
1189         err = get_vlan(info->attrs[NL80211_ATTR_STA_VLAN], drv, &params.vlan);
1190         if (err)
1191                 goto out;
1192
1193         if (!drv->ops->change_station) {
1194                 err = -EOPNOTSUPP;
1195                 goto out;
1196         }
1197
1198         rtnl_lock();
1199         err = drv->ops->change_station(&drv->wiphy, dev, mac_addr, &params);
1200         rtnl_unlock();
1201
1202  out:
1203         if (params.vlan)
1204                 dev_put(params.vlan);
1205         cfg80211_put_dev(drv);
1206         dev_put(dev);
1207         return err;
1208 }
1209
1210 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
1211 {
1212         struct cfg80211_registered_device *drv;
1213         int err;
1214         struct net_device *dev;
1215         struct station_parameters params;
1216         u8 *mac_addr = NULL;
1217
1218         memset(&params, 0, sizeof(params));
1219
1220         if (!info->attrs[NL80211_ATTR_MAC])
1221                 return -EINVAL;
1222
1223         if (!info->attrs[NL80211_ATTR_STA_AID])
1224                 return -EINVAL;
1225
1226         if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
1227                 return -EINVAL;
1228
1229         if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
1230                 return -EINVAL;
1231
1232         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1233         params.supported_rates =
1234                 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
1235         params.supported_rates_len =
1236                 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
1237         params.listen_interval =
1238                 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
1239         params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
1240         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
1241                 params.ht_capa =
1242                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
1243
1244         if (parse_station_flags(info->attrs[NL80211_ATTR_STA_FLAGS],
1245                                 &params.station_flags))
1246                 return -EINVAL;
1247
1248         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1249         if (err)
1250                 return err;
1251
1252         err = get_vlan(info->attrs[NL80211_ATTR_STA_VLAN], drv, &params.vlan);
1253         if (err)
1254                 goto out;
1255
1256         if (!drv->ops->add_station) {
1257                 err = -EOPNOTSUPP;
1258                 goto out;
1259         }
1260
1261         rtnl_lock();
1262         err = drv->ops->add_station(&drv->wiphy, dev, mac_addr, &params);
1263         rtnl_unlock();
1264
1265  out:
1266         if (params.vlan)
1267                 dev_put(params.vlan);
1268         cfg80211_put_dev(drv);
1269         dev_put(dev);
1270         return err;
1271 }
1272
1273 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
1274 {
1275         struct cfg80211_registered_device *drv;
1276         int err;
1277         struct net_device *dev;
1278         u8 *mac_addr = NULL;
1279
1280         if (info->attrs[NL80211_ATTR_MAC])
1281                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
1282
1283         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1284         if (err)
1285                 return err;
1286
1287         if (!drv->ops->del_station) {
1288                 err = -EOPNOTSUPP;
1289                 goto out;
1290         }
1291
1292         rtnl_lock();
1293         err = drv->ops->del_station(&drv->wiphy, dev, mac_addr);
1294         rtnl_unlock();
1295
1296  out:
1297         cfg80211_put_dev(drv);
1298         dev_put(dev);
1299         return err;
1300 }
1301
1302 static int nl80211_send_mpath(struct sk_buff *msg, u32 pid, u32 seq,
1303                                 int flags, struct net_device *dev,
1304                                 u8 *dst, u8 *next_hop,
1305                                 struct mpath_info *pinfo)
1306 {
1307         void *hdr;
1308         struct nlattr *pinfoattr;
1309
1310         hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
1311         if (!hdr)
1312                 return -1;
1313
1314         NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
1315         NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst);
1316         NLA_PUT(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop);
1317
1318         pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
1319         if (!pinfoattr)
1320                 goto nla_put_failure;
1321         if (pinfo->filled & MPATH_INFO_FRAME_QLEN)
1322                 NLA_PUT_U32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
1323                             pinfo->frame_qlen);
1324         if (pinfo->filled & MPATH_INFO_DSN)
1325                 NLA_PUT_U32(msg, NL80211_MPATH_INFO_DSN,
1326                             pinfo->dsn);
1327         if (pinfo->filled & MPATH_INFO_METRIC)
1328                 NLA_PUT_U32(msg, NL80211_MPATH_INFO_METRIC,
1329                             pinfo->metric);
1330         if (pinfo->filled & MPATH_INFO_EXPTIME)
1331                 NLA_PUT_U32(msg, NL80211_MPATH_INFO_EXPTIME,
1332                             pinfo->exptime);
1333         if (pinfo->filled & MPATH_INFO_FLAGS)
1334                 NLA_PUT_U8(msg, NL80211_MPATH_INFO_FLAGS,
1335                             pinfo->flags);
1336         if (pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT)
1337                 NLA_PUT_U32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
1338                             pinfo->discovery_timeout);
1339         if (pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES)
1340                 NLA_PUT_U8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
1341                             pinfo->discovery_retries);
1342
1343         nla_nest_end(msg, pinfoattr);
1344
1345         return genlmsg_end(msg, hdr);
1346
1347  nla_put_failure:
1348         genlmsg_cancel(msg, hdr);
1349         return -EMSGSIZE;
1350 }
1351
1352 static int nl80211_dump_mpath(struct sk_buff *skb,
1353                               struct netlink_callback *cb)
1354 {
1355         struct mpath_info pinfo;
1356         struct cfg80211_registered_device *dev;
1357         struct net_device *netdev;
1358         u8 dst[ETH_ALEN];
1359         u8 next_hop[ETH_ALEN];
1360         int ifidx = cb->args[0];
1361         int path_idx = cb->args[1];
1362         int err;
1363
1364         if (!ifidx) {
1365                 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
1366                                   nl80211_fam.attrbuf, nl80211_fam.maxattr,
1367                                   nl80211_policy);
1368                 if (err)
1369                         return err;
1370
1371                 if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
1372                         return -EINVAL;
1373
1374                 ifidx = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
1375                 if (!ifidx)
1376                         return -EINVAL;
1377         }
1378
1379         netdev = dev_get_by_index(&init_net, ifidx);
1380         if (!netdev)
1381                 return -ENODEV;
1382
1383         dev = cfg80211_get_dev_from_ifindex(ifidx);
1384         if (IS_ERR(dev)) {
1385                 err = PTR_ERR(dev);
1386                 goto out_put_netdev;
1387         }
1388
1389         if (!dev->ops->dump_mpath) {
1390                 err = -ENOSYS;
1391                 goto out_err;
1392         }
1393
1394         rtnl_lock();
1395
1396         while (1) {
1397                 err = dev->ops->dump_mpath(&dev->wiphy, netdev, path_idx,
1398                                            dst, next_hop, &pinfo);
1399                 if (err == -ENOENT)
1400                         break;
1401                 if (err)
1402                         goto out_err_rtnl;
1403
1404                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).pid,
1405                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
1406                                        netdev, dst, next_hop,
1407                                        &pinfo) < 0)
1408                         goto out;
1409
1410                 path_idx++;
1411         }
1412
1413
1414  out:
1415         cb->args[1] = path_idx;
1416         err = skb->len;
1417  out_err_rtnl:
1418         rtnl_unlock();
1419  out_err:
1420         cfg80211_put_dev(dev);
1421  out_put_netdev:
1422         dev_put(netdev);
1423
1424         return err;
1425 }
1426
1427 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
1428 {
1429         struct cfg80211_registered_device *drv;
1430         int err;
1431         struct net_device *dev;
1432         struct mpath_info pinfo;
1433         struct sk_buff *msg;
1434         u8 *dst = NULL;
1435         u8 next_hop[ETH_ALEN];
1436
1437         memset(&pinfo, 0, sizeof(pinfo));
1438
1439         if (!info->attrs[NL80211_ATTR_MAC])
1440                 return -EINVAL;
1441
1442         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
1443
1444         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1445         if (err)
1446                 return err;
1447
1448         if (!drv->ops->get_mpath) {
1449                 err = -EOPNOTSUPP;
1450                 goto out;
1451         }
1452
1453         rtnl_lock();
1454         err = drv->ops->get_mpath(&drv->wiphy, dev, dst, next_hop, &pinfo);
1455         rtnl_unlock();
1456
1457         if (err)
1458                 goto out;
1459
1460         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1461         if (!msg)
1462                 goto out;
1463
1464         if (nl80211_send_mpath(msg, info->snd_pid, info->snd_seq, 0,
1465                                  dev, dst, next_hop, &pinfo) < 0)
1466                 goto out_free;
1467
1468         err = genlmsg_unicast(msg, info->snd_pid);
1469         goto out;
1470
1471  out_free:
1472         nlmsg_free(msg);
1473
1474  out:
1475         cfg80211_put_dev(drv);
1476         dev_put(dev);
1477         return err;
1478 }
1479
1480 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
1481 {
1482         struct cfg80211_registered_device *drv;
1483         int err;
1484         struct net_device *dev;
1485         u8 *dst = NULL;
1486         u8 *next_hop = NULL;
1487
1488         if (!info->attrs[NL80211_ATTR_MAC])
1489                 return -EINVAL;
1490
1491         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
1492                 return -EINVAL;
1493
1494         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
1495         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
1496
1497         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1498         if (err)
1499                 return err;
1500
1501         if (!drv->ops->change_mpath) {
1502                 err = -EOPNOTSUPP;
1503                 goto out;
1504         }
1505
1506         rtnl_lock();
1507         err = drv->ops->change_mpath(&drv->wiphy, dev, dst, next_hop);
1508         rtnl_unlock();
1509
1510  out:
1511         cfg80211_put_dev(drv);
1512         dev_put(dev);
1513         return err;
1514 }
1515 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
1516 {
1517         struct cfg80211_registered_device *drv;
1518         int err;
1519         struct net_device *dev;
1520         u8 *dst = NULL;
1521         u8 *next_hop = NULL;
1522
1523         if (!info->attrs[NL80211_ATTR_MAC])
1524                 return -EINVAL;
1525
1526         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
1527                 return -EINVAL;
1528
1529         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
1530         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
1531
1532         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1533         if (err)
1534                 return err;
1535
1536         if (!drv->ops->add_mpath) {
1537                 err = -EOPNOTSUPP;
1538                 goto out;
1539         }
1540
1541         rtnl_lock();
1542         err = drv->ops->add_mpath(&drv->wiphy, dev, dst, next_hop);
1543         rtnl_unlock();
1544
1545  out:
1546         cfg80211_put_dev(drv);
1547         dev_put(dev);
1548         return err;
1549 }
1550
1551 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
1552 {
1553         struct cfg80211_registered_device *drv;
1554         int err;
1555         struct net_device *dev;
1556         u8 *dst = NULL;
1557
1558         if (info->attrs[NL80211_ATTR_MAC])
1559                 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
1560
1561         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1562         if (err)
1563                 return err;
1564
1565         if (!drv->ops->del_mpath) {
1566                 err = -EOPNOTSUPP;
1567                 goto out;
1568         }
1569
1570         rtnl_lock();
1571         err = drv->ops->del_mpath(&drv->wiphy, dev, dst);
1572         rtnl_unlock();
1573
1574  out:
1575         cfg80211_put_dev(drv);
1576         dev_put(dev);
1577         return err;
1578 }
1579
1580 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
1581 {
1582         struct cfg80211_registered_device *drv;
1583         int err;
1584         struct net_device *dev;
1585         struct bss_parameters params;
1586
1587         memset(&params, 0, sizeof(params));
1588         /* default to not changing parameters */
1589         params.use_cts_prot = -1;
1590         params.use_short_preamble = -1;
1591         params.use_short_slot_time = -1;
1592
1593         if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
1594                 params.use_cts_prot =
1595                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
1596         if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
1597                 params.use_short_preamble =
1598                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
1599         if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
1600                 params.use_short_slot_time =
1601                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
1602
1603         err = get_drv_dev_by_info_ifindex(info->attrs, &drv, &dev);
1604         if (err)
1605                 return err;
1606
1607         if (!drv->ops->change_bss) {
1608                 err = -EOPNOTSUPP;
1609                 goto out;
1610         }
1611
1612         rtnl_lock();
1613         err = drv->ops->change_bss(&drv->wiphy, dev, &params);
1614         rtnl_unlock();
1615
1616  out:
1617         cfg80211_put_dev(drv);
1618         dev_put(dev);
1619         return err;
1620 }
1621
1622 static const struct nla_policy
1623         reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
1624         [NL80211_ATTR_REG_RULE_FLAGS]           = { .type = NLA_U32 },
1625         [NL80211_ATTR_FREQ_RANGE_START]         = { .type = NLA_U32 },
1626         [NL80211_ATTR_FREQ_RANGE_END]           = { .type = NLA_U32 },
1627         [NL80211_ATTR_FREQ_RANGE_MAX_BW]        = { .type = NLA_U32 },
1628         [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]  = { .type = NLA_U32 },
1629         [NL80211_ATTR_POWER_RULE_MAX_EIRP]      = { .type = NLA_U32 },
1630 };
1631
1632 static int parse_reg_rule(struct nlattr *tb[],
1633         struct ieee80211_reg_rule *reg_rule)
1634 {
1635         struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
1636         struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
1637
1638         if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
1639                 return -EINVAL;
1640         if (!tb[NL80211_ATTR_FREQ_RANGE_START])
1641                 return -EINVAL;
1642         if (!tb[NL80211_ATTR_FREQ_RANGE_END])
1643                 return -EINVAL;
1644         if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
1645                 return -EINVAL;
1646         if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
1647                 return -EINVAL;
1648
1649         reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
1650
1651         freq_range->start_freq_khz =
1652                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
1653         freq_range->end_freq_khz =
1654                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
1655         freq_range->max_bandwidth_khz =
1656                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
1657
1658         power_rule->max_eirp =
1659                 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
1660
1661         if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
1662                 power_rule->max_antenna_gain =
1663                         nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
1664
1665         return 0;
1666 }
1667
1668 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
1669 {
1670         int r;
1671         char *data = NULL;
1672
1673         if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
1674                 return -EINVAL;
1675
1676         data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
1677
1678 #ifdef CONFIG_WIRELESS_OLD_REGULATORY
1679         /* We ignore world regdom requests with the old regdom setup */
1680         if (is_world_regdom(data))
1681                 return -EINVAL;
1682 #endif
1683         mutex_lock(&cfg80211_drv_mutex);
1684         r = __regulatory_hint(NULL, REGDOM_SET_BY_USER, data, NULL);
1685         mutex_unlock(&cfg80211_drv_mutex);
1686         return r;
1687 }
1688
1689 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
1690 {
1691         struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
1692         struct nlattr *nl_reg_rule;
1693         char *alpha2 = NULL;
1694         int rem_reg_rules = 0, r = 0;
1695         u32 num_rules = 0, rule_idx = 0, size_of_regd;
1696         struct ieee80211_regdomain *rd = NULL;
1697
1698         if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
1699                 return -EINVAL;
1700
1701         if (!info->attrs[NL80211_ATTR_REG_RULES])
1702                 return -EINVAL;
1703
1704         alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
1705
1706         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1707                         rem_reg_rules) {
1708                 num_rules++;
1709                 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
1710                         goto bad_reg;
1711         }
1712
1713         if (!reg_is_valid_request(alpha2))
1714                 return -EINVAL;
1715
1716         size_of_regd = sizeof(struct ieee80211_regdomain) +
1717                 (num_rules * sizeof(struct ieee80211_reg_rule));
1718
1719         rd = kzalloc(size_of_regd, GFP_KERNEL);
1720         if (!rd)
1721                 return -ENOMEM;
1722
1723         rd->n_reg_rules = num_rules;
1724         rd->alpha2[0] = alpha2[0];
1725         rd->alpha2[1] = alpha2[1];
1726
1727         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
1728                         rem_reg_rules) {
1729                 nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
1730                         nla_data(nl_reg_rule), nla_len(nl_reg_rule),
1731                         reg_rule_policy);
1732                 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
1733                 if (r)
1734                         goto bad_reg;
1735
1736                 rule_idx++;
1737
1738                 if (rule_idx > NL80211_MAX_SUPP_REG_RULES)
1739                         goto bad_reg;
1740         }
1741
1742         BUG_ON(rule_idx != num_rules);
1743
1744         mutex_lock(&cfg80211_drv_mutex);
1745         r = set_regdom(rd);
1746         mutex_unlock(&cfg80211_drv_mutex);
1747         if (r)
1748                 goto bad_reg;
1749
1750         return r;
1751
1752 bad_reg:
1753         kfree(rd);
1754         return -EINVAL;
1755 }
1756
1757 static struct genl_ops nl80211_ops[] = {
1758         {
1759                 .cmd = NL80211_CMD_GET_WIPHY,
1760                 .doit = nl80211_get_wiphy,
1761                 .dumpit = nl80211_dump_wiphy,
1762                 .policy = nl80211_policy,
1763                 /* can be retrieved by unprivileged users */
1764         },
1765         {
1766                 .cmd = NL80211_CMD_SET_WIPHY,
1767                 .doit = nl80211_set_wiphy,
1768                 .policy = nl80211_policy,
1769                 .flags = GENL_ADMIN_PERM,
1770         },
1771         {
1772                 .cmd = NL80211_CMD_GET_INTERFACE,
1773                 .doit = nl80211_get_interface,
1774                 .dumpit = nl80211_dump_interface,
1775                 .policy = nl80211_policy,
1776                 /* can be retrieved by unprivileged users */
1777         },
1778         {
1779                 .cmd = NL80211_CMD_SET_INTERFACE,
1780                 .doit = nl80211_set_interface,
1781                 .policy = nl80211_policy,
1782                 .flags = GENL_ADMIN_PERM,
1783         },
1784         {
1785                 .cmd = NL80211_CMD_NEW_INTERFACE,
1786                 .doit = nl80211_new_interface,
1787                 .policy = nl80211_policy,
1788                 .flags = GENL_ADMIN_PERM,
1789         },
1790         {
1791                 .cmd = NL80211_CMD_DEL_INTERFACE,
1792                 .doit = nl80211_del_interface,
1793                 .policy = nl80211_policy,
1794                 .flags = GENL_ADMIN_PERM,
1795         },
1796         {
1797                 .cmd = NL80211_CMD_GET_KEY,
1798                 .doit = nl80211_get_key,
1799                 .policy = nl80211_policy,
1800                 .flags = GENL_ADMIN_PERM,
1801         },
1802         {
1803                 .cmd = NL80211_CMD_SET_KEY,
1804                 .doit = nl80211_set_key,
1805                 .policy = nl80211_policy,
1806                 .flags = GENL_ADMIN_PERM,
1807         },
1808         {
1809                 .cmd = NL80211_CMD_NEW_KEY,
1810                 .doit = nl80211_new_key,
1811                 .policy = nl80211_policy,
1812                 .flags = GENL_ADMIN_PERM,
1813         },
1814         {
1815                 .cmd = NL80211_CMD_DEL_KEY,
1816                 .doit = nl80211_del_key,
1817                 .policy = nl80211_policy,
1818                 .flags = GENL_ADMIN_PERM,
1819         },
1820         {
1821                 .cmd = NL80211_CMD_SET_BEACON,
1822                 .policy = nl80211_policy,
1823                 .flags = GENL_ADMIN_PERM,
1824                 .doit = nl80211_addset_beacon,
1825         },
1826         {
1827                 .cmd = NL80211_CMD_NEW_BEACON,
1828                 .policy = nl80211_policy,
1829                 .flags = GENL_ADMIN_PERM,
1830                 .doit = nl80211_addset_beacon,
1831         },
1832         {
1833                 .cmd = NL80211_CMD_DEL_BEACON,
1834                 .policy = nl80211_policy,
1835                 .flags = GENL_ADMIN_PERM,
1836                 .doit = nl80211_del_beacon,
1837         },
1838         {
1839                 .cmd = NL80211_CMD_GET_STATION,
1840                 .doit = nl80211_get_station,
1841                 .dumpit = nl80211_dump_station,
1842                 .policy = nl80211_policy,
1843                 .flags = GENL_ADMIN_PERM,
1844         },
1845         {
1846                 .cmd = NL80211_CMD_SET_STATION,
1847                 .doit = nl80211_set_station,
1848                 .policy = nl80211_policy,
1849                 .flags = GENL_ADMIN_PERM,
1850         },
1851         {
1852                 .cmd = NL80211_CMD_NEW_STATION,
1853                 .doit = nl80211_new_station,
1854                 .policy = nl80211_policy,
1855                 .flags = GENL_ADMIN_PERM,
1856         },
1857         {
1858                 .cmd = NL80211_CMD_DEL_STATION,
1859                 .doit = nl80211_del_station,
1860                 .policy = nl80211_policy,
1861                 .flags = GENL_ADMIN_PERM,
1862         },
1863         {
1864                 .cmd = NL80211_CMD_GET_MPATH,
1865                 .doit = nl80211_get_mpath,
1866                 .dumpit = nl80211_dump_mpath,
1867                 .policy = nl80211_policy,
1868                 .flags = GENL_ADMIN_PERM,
1869         },
1870         {
1871                 .cmd = NL80211_CMD_SET_MPATH,
1872                 .doit = nl80211_set_mpath,
1873                 .policy = nl80211_policy,
1874                 .flags = GENL_ADMIN_PERM,
1875         },
1876         {
1877                 .cmd = NL80211_CMD_NEW_MPATH,
1878                 .doit = nl80211_new_mpath,
1879                 .policy = nl80211_policy,
1880                 .flags = GENL_ADMIN_PERM,
1881         },
1882         {
1883                 .cmd = NL80211_CMD_DEL_MPATH,
1884                 .doit = nl80211_del_mpath,
1885                 .policy = nl80211_policy,
1886                 .flags = GENL_ADMIN_PERM,
1887         },
1888         {
1889                 .cmd = NL80211_CMD_SET_BSS,
1890                 .doit = nl80211_set_bss,
1891                 .policy = nl80211_policy,
1892                 .flags = GENL_ADMIN_PERM,
1893         },
1894         {
1895                 .cmd = NL80211_CMD_SET_REG,
1896                 .doit = nl80211_set_reg,
1897                 .policy = nl80211_policy,
1898                 .flags = GENL_ADMIN_PERM,
1899         },
1900         {
1901                 .cmd = NL80211_CMD_REQ_SET_REG,
1902                 .doit = nl80211_req_set_reg,
1903                 .policy = nl80211_policy,
1904                 .flags = GENL_ADMIN_PERM,
1905         },
1906 };
1907
1908 /* multicast groups */
1909 static struct genl_multicast_group nl80211_config_mcgrp = {
1910         .name = "config",
1911 };
1912
1913 /* notification functions */
1914
1915 void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
1916 {
1917         struct sk_buff *msg;
1918
1919         msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1920         if (!msg)
1921                 return;
1922
1923         if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
1924                 nlmsg_free(msg);
1925                 return;
1926         }
1927
1928         genlmsg_multicast(msg, 0, nl80211_config_mcgrp.id, GFP_KERNEL);
1929 }
1930
1931 /* initialisation/exit functions */
1932
1933 int nl80211_init(void)
1934 {
1935         int err, i;
1936
1937         err = genl_register_family(&nl80211_fam);
1938         if (err)
1939                 return err;
1940
1941         for (i = 0; i < ARRAY_SIZE(nl80211_ops); i++) {
1942                 err = genl_register_ops(&nl80211_fam, &nl80211_ops[i]);
1943                 if (err)
1944                         goto err_out;
1945         }
1946
1947         err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
1948         if (err)
1949                 goto err_out;
1950
1951         return 0;
1952  err_out:
1953         genl_unregister_family(&nl80211_fam);
1954         return err;
1955 }
1956
1957 void nl80211_exit(void)
1958 {
1959         genl_unregister_family(&nl80211_fam);
1960 }