net/wireless/core.c

   1 /*
   2  * This is the linux wireless configuration interface.
   3  *
   4  * Copyright 2006-2010          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/list.h>
  11 #include <linux/slab.h>
  12 #include <linux/nl80211.h>
  13 #include <linux/debugfs.h>
  14 #include <linux/notifier.h>
  15 #include <linux/device.h>
  16 #include <linux/etherdevice.h>
  17 #include <linux/rtnetlink.h>
  18 #include <linux/sched.h>
  19 #include <net/genetlink.h>
  20 #include <net/cfg80211.h>
  21 #include "nl80211.h"
  22 #include "core.h"
  23 #include "sysfs.h"
  24 #include "debugfs.h"
  25 #include "wext-compat.h"
  26 #include "ethtool.h"
  27
  28 /* name for sysfs, %d is appended */
  29 #define PHY_NAME "phy"
  30
  31 MODULE_AUTHOR("Johannes Berg");
  32 MODULE_LICENSE("GPL");
  33 MODULE_DESCRIPTION("wireless configuration support");
  34
  35 /* RCU-protected (and cfg80211_mutex for writers) */
  36 LIST_HEAD(cfg80211_rdev_list);
  37 int cfg80211_rdev_list_generation;
  38
  39 DEFINE_MUTEX(cfg80211_mutex);
  40
  41 /* for debugfs */
  42 static struct dentry *ieee80211_debugfs_dir;
  43
  44 /* for the cleanup, scan and event works */
  45 struct workqueue_struct *cfg80211_wq;
  46
  47 /* requires cfg80211_mutex to be held! */
  48 struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
  49 {
  50         struct cfg80211_registered_device *result = NULL, *rdev;
  51
  52         if (!wiphy_idx_valid(wiphy_idx))
  53                 return NULL;
  54
  55         assert_cfg80211_lock();
  56
  57         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  58                 if (rdev->wiphy_idx == wiphy_idx) {
  59                         result = rdev;
  60                         break;
  61                 }
  62         }
  63
  64         return result;
  65 }
  66
  67 int get_wiphy_idx(struct wiphy *wiphy)
  68 {
  69         struct cfg80211_registered_device *rdev;
  70         if (!wiphy)
  71                 return WIPHY_IDX_STALE;
  72         rdev = wiphy_to_dev(wiphy);
  73         return rdev->wiphy_idx;
  74 }
  75
  76 /* requires cfg80211_rdev_mutex to be held! */
  77 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
  78 {
  79         struct cfg80211_registered_device *rdev;
  80
  81         if (!wiphy_idx_valid(wiphy_idx))
  82                 return NULL;
  83
  84         assert_cfg80211_lock();
  85
  86         rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
  87         if (!rdev)
  88                 return NULL;
  89         return &rdev->wiphy;
  90 }
  91
  92 /* requires cfg80211_mutex to be held! */
  93 struct cfg80211_registered_device *
  94 __cfg80211_rdev_from_info(struct genl_info *info)
  95 {
  96         int ifindex;
  97         struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
  98         struct net_device *dev;
  99         int err = -EINVAL;
 100
 101         assert_cfg80211_lock();
 102
 103         if (info->attrs[NL80211_ATTR_WIPHY]) {
 104                 bywiphyidx = cfg80211_rdev_by_wiphy_idx(
 105                                 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
 106                 err = -ENODEV;
 107         }
 108
 109         if (info->attrs[NL80211_ATTR_IFINDEX]) {
 110                 ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
 111                 dev = dev_get_by_index(genl_info_net(info), ifindex);
 112                 if (dev) {
 113                         if (dev->ieee80211_ptr)
 114                                 byifidx =
 115                                         wiphy_to_dev(dev->ieee80211_ptr->wiphy);
 116                         dev_put(dev);
 117                 }
 118                 err = -ENODEV;
 119         }
 120
 121         if (bywiphyidx && byifidx) {
 122                 if (bywiphyidx != byifidx)
 123                         return ERR_PTR(-EINVAL);
 124                 else
 125                         return bywiphyidx; /* == byifidx */
 126         }
 127         if (bywiphyidx)
 128                 return bywiphyidx;
 129
 130         if (byifidx)
 131                 return byifidx;
 132
 133         return ERR_PTR(err);
 134 }
 135
 136 struct cfg80211_registered_device *
 137 cfg80211_get_dev_from_info(struct genl_info *info)
 138 {
 139         struct cfg80211_registered_device *rdev;
 140
 141         mutex_lock(&cfg80211_mutex);
 142         rdev = __cfg80211_rdev_from_info(info);
 143
 144         /* if it is not an error we grab the lock on
 145          * it to assure it won't be going away while
 146          * we operate on it */
 147         if (!IS_ERR(rdev))
 148                 mutex_lock(&rdev->mtx);
 149
 150         mutex_unlock(&cfg80211_mutex);
 151
 152         return rdev;
 153 }
 154
 155 struct cfg80211_registered_device *
 156 cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
 157 {
 158         struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
 159         struct net_device *dev;
 160
 161         mutex_lock(&cfg80211_mutex);
 162         dev = dev_get_by_index(net, ifindex);
 163         if (!dev)
 164                 goto out;
 165         if (dev->ieee80211_ptr) {
 166                 rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
 167                 mutex_lock(&rdev->mtx);
 168         } else
 169                 rdev = ERR_PTR(-ENODEV);
 170         dev_put(dev);
 171  out:
 172         mutex_unlock(&cfg80211_mutex);
 173         return rdev;
 174 }
 175
 176 /* requires cfg80211_mutex to be held */
 177 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
 178                         char *newname)
 179 {
 180         struct cfg80211_registered_device *rdev2;
 181         int wiphy_idx, taken = -1, result, digits;
 182
 183         assert_cfg80211_lock();
 184
 185         /* prohibit calling the thing phy%d when %d is not its number */
 186         sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
 187         if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
 188                 /* count number of places needed to print wiphy_idx */
 189                 digits = 1;
 190                 while (wiphy_idx /= 10)
 191                         digits++;
 192                 /*
 193                  * deny the name if it is phy<idx> where <idx> is printed
 194                  * without leading zeroes. taken == strlen(newname) here
 195                  */
 196                 if (taken == strlen(PHY_NAME) + digits)
 197                         return -EINVAL;
 198         }
 199
 200
 201         /* Ignore nop renames */
 202         if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
 203                 return 0;
 204
 205         /* Ensure another device does not already have this name. */
 206         list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
 207                 if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
 208                         return -EINVAL;
 209
 210         result = device_rename(&rdev->wiphy.dev, newname);
 211         if (result)
 212                 return result;
 213
 214         if (rdev->wiphy.debugfsdir &&
 215             !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
 216                             rdev->wiphy.debugfsdir,
 217                             rdev->wiphy.debugfsdir->d_parent,
 218                             newname))
 219                 printk(KERN_ERR "cfg80211: failed to rename debugfs dir to %s!\n",
 220                        newname);
 221
 222         nl80211_notify_dev_rename(rdev);
 223
 224         return 0;
 225 }
 226
 227 int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
 228                           struct net *net)
 229 {
 230         struct wireless_dev *wdev;
 231         int err = 0;
 232
 233         if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
 234                 return -EOPNOTSUPP;
 235
 236         list_for_each_entry(wdev, &rdev->netdev_list, list) {
 237                 wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
 238                 err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
 239                 if (err)
 240                         break;
 241                 wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
 242         }
 243
 244         if (err) {
 245                 /* failed -- clean up to old netns */
 246                 net = wiphy_net(&rdev->wiphy);
 247
 248                 list_for_each_entry_continue_reverse(wdev, &rdev->netdev_list,
 249                                                      list) {
 250                         wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
 251                         err = dev_change_net_namespace(wdev->netdev, net,
 252                                                         "wlan%d");
 253                         WARN_ON(err);
 254                         wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
 255                 }
 256         }
 257
 258         wiphy_net_set(&rdev->wiphy, net);
 259
 260         return err;
 261 }
 262
 263 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
 264 {
 265         struct cfg80211_registered_device *rdev = data;
 266
 267         rdev->ops->rfkill_poll(&rdev->wiphy);
 268 }
 269
 270 static int cfg80211_rfkill_set_block(void *data, bool blocked)
 271 {
 272         struct cfg80211_registered_device *rdev = data;
 273         struct wireless_dev *wdev;
 274
 275         if (!blocked)
 276                 return 0;
 277
 278         rtnl_lock();
 279         mutex_lock(&rdev->devlist_mtx);
 280
 281         list_for_each_entry(wdev, &rdev->netdev_list, list)
 282                 dev_close(wdev->netdev);
 283
 284         mutex_unlock(&rdev->devlist_mtx);
 285         rtnl_unlock();
 286
 287         return 0;
 288 }
 289
 290 static void cfg80211_rfkill_sync_work(struct work_struct *work)
 291 {
 292         struct cfg80211_registered_device *rdev;
 293
 294         rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
 295         cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
 296 }
 297
 298 static void cfg80211_event_work(struct work_struct *work)
 299 {
 300         struct cfg80211_registered_device *rdev;
 301
 302         rdev = container_of(work, struct cfg80211_registered_device,
 303                             event_work);
 304
 305         rtnl_lock();
 306         cfg80211_lock_rdev(rdev);
 307
 308         cfg80211_process_rdev_events(rdev);
 309         cfg80211_unlock_rdev(rdev);
 310         rtnl_unlock();
 311 }
 312
 313 /* exported functions */
 314
 315 struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
 316 {
 317         static int wiphy_counter;
 318
 319         struct cfg80211_registered_device *rdev;
 320         int alloc_size;
 321
 322         WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
 323         WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
 324         WARN_ON(ops->connect && !ops->disconnect);
 325         WARN_ON(ops->join_ibss && !ops->leave_ibss);
 326         WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
 327         WARN_ON(ops->add_station && !ops->del_station);
 328         WARN_ON(ops->add_mpath && !ops->del_mpath);
 329
 330         alloc_size = sizeof(*rdev) + sizeof_priv;
 331
 332         rdev = kzalloc(alloc_size, GFP_KERNEL);
 333         if (!rdev)
 334                 return NULL;
 335
 336         rdev->ops = ops;
 337
 338         mutex_lock(&cfg80211_mutex);
 339
 340         rdev->wiphy_idx = wiphy_counter++;
 341
 342         if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
 343                 wiphy_counter--;
 344                 mutex_unlock(&cfg80211_mutex);
 345                 /* ugh, wrapped! */
 346                 kfree(rdev);
 347                 return NULL;
 348         }
 349
 350         mutex_unlock(&cfg80211_mutex);
 351
 352         /* give it a proper name */
 353         dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
 354
 355         mutex_init(&rdev->mtx);
 356         mutex_init(&rdev->devlist_mtx);
 357         INIT_LIST_HEAD(&rdev->netdev_list);
 358         spin_lock_init(&rdev->bss_lock);
 359         INIT_LIST_HEAD(&rdev->bss_list);
 360         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
 361
 362 #ifdef CONFIG_CFG80211_WEXT
 363         rdev->wiphy.wext = &cfg80211_wext_handler;
 364 #endif
 365
 366         device_initialize(&rdev->wiphy.dev);
 367         rdev->wiphy.dev.class = &ieee80211_class;
 368         rdev->wiphy.dev.platform_data = rdev;
 369
 370 #ifdef CONFIG_CFG80211_DEFAULT_PS
 371         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
 372 #endif
 373
 374         wiphy_net_set(&rdev->wiphy, &init_net);
 375
 376         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
 377         rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
 378                                    &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
 379                                    &rdev->rfkill_ops, rdev);
 380
 381         if (!rdev->rfkill) {
 382                 kfree(rdev);
 383                 return NULL;
 384         }
 385
 386         INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
 387         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
 388         INIT_WORK(&rdev->event_work, cfg80211_event_work);
 389
 390         init_waitqueue_head(&rdev->dev_wait);
 391
 392         /*
 393          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
 394          * Fragmentation and RTS threshold are disabled by default with the
 395          * special -1 value.
 396          */
 397         rdev->wiphy.retry_short = 7;
 398         rdev->wiphy.retry_long = 4;
 399         rdev->wiphy.frag_threshold = (u32) -1;
 400         rdev->wiphy.rts_threshold = (u32) -1;
 401         rdev->wiphy.coverage_class = 0;
 402
 403         return &rdev->wiphy;
 404 }
 405 EXPORT_SYMBOL(wiphy_new);
 406
 407 int wiphy_register(struct wiphy *wiphy)
 408 {
 409         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
 410         int res;
 411         enum ieee80211_band band;
 412         struct ieee80211_supported_band *sband;
 413         bool have_band = false;
 414         int i;
 415         u16 ifmodes = wiphy->interface_modes;
 416
 417         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
 418                 return -EINVAL;
 419
 420         if (WARN_ON(wiphy->addresses &&
 421                     !is_zero_ether_addr(wiphy->perm_addr) &&
 422                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
 423                            ETH_ALEN)))
 424                 return -EINVAL;
 425
 426         if (wiphy->addresses)
 427                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
 428
 429         /* sanity check ifmodes */
 430         WARN_ON(!ifmodes);
 431         ifmodes &= ((1 << __NL80211_IFTYPE_AFTER_LAST) - 1) & ~1;
 432         if (WARN_ON(ifmodes != wiphy->interface_modes))
 433                 wiphy->interface_modes = ifmodes;
 434
 435         /* sanity check supported bands/channels */
 436         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
 437                 sband = wiphy->bands[band];
 438                 if (!sband)
 439                         continue;
 440
 441                 sband->band = band;
 442
 443                 if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
 444                         return -EINVAL;
 445
 446                 /*
 447                  * Since we use a u32 for rate bitmaps in
 448                  * ieee80211_get_response_rate, we cannot
 449                  * have more than 32 legacy rates.
 450                  */
 451                 if (WARN_ON(sband->n_bitrates > 32))
 452                         return -EINVAL;
 453
 454                 for (i = 0; i < sband->n_channels; i++) {
 455                         sband->channels[i].orig_flags =
 456                                 sband->channels[i].flags;
 457                         sband->channels[i].orig_mag =
 458                                 sband->channels[i].max_antenna_gain;
 459                         sband->channels[i].orig_mpwr =
 460                                 sband->channels[i].max_power;
 461                         sband->channels[i].band = band;
 462                 }
 463
 464                 have_band = true;
 465         }
 466
 467         if (!have_band) {
 468                 WARN_ON(1);
 469                 return -EINVAL;
 470         }
 471
 472         /* check and set up bitrates */
 473         ieee80211_set_bitrate_flags(wiphy);
 474
 475         mutex_lock(&cfg80211_mutex);
 476
 477         res = device_add(&rdev->wiphy.dev);
 478         if (res)
 479                 goto out_unlock;
 480
 481         res = rfkill_register(rdev->rfkill);
 482         if (res)
 483                 goto out_rm_dev;
 484
 485         /* set up regulatory info */
 486         wiphy_update_regulatory(wiphy, NL80211_REGDOM_SET_BY_CORE);
 487
 488         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
 489         cfg80211_rdev_list_generation++;
 490
 491         /* add to debugfs */
 492         rdev->wiphy.debugfsdir =
 493                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
 494                                    ieee80211_debugfs_dir);
 495         if (IS_ERR(rdev->wiphy.debugfsdir))
 496                 rdev->wiphy.debugfsdir = NULL;
 497
 498         if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
 499                 struct regulatory_request request;
 500
 501                 request.wiphy_idx = get_wiphy_idx(wiphy);
 502                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
 503                 request.alpha2[0] = '9';
 504                 request.alpha2[1] = '9';
 505
 506                 nl80211_send_reg_change_event(&request);
 507         }
 508
 509         cfg80211_debugfs_rdev_add(rdev);
 510         mutex_unlock(&cfg80211_mutex);
 511
 512         return 0;
 513
 514 out_rm_dev:
 515         device_del(&rdev->wiphy.dev);
 516
 517 out_unlock:
 518         mutex_unlock(&cfg80211_mutex);
 519         return res;
 520 }
 521 EXPORT_SYMBOL(wiphy_register);
 522
 523 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
 524 {
 525         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
 526
 527         if (!rdev->ops->rfkill_poll)
 528                 return;
 529         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
 530         rfkill_resume_polling(rdev->rfkill);
 531 }
 532 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
 533
 534 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
 535 {
 536         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
 537
 538         rfkill_pause_polling(rdev->rfkill);
 539 }
 540 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
 541
 542 void wiphy_unregister(struct wiphy *wiphy)
 543 {
 544         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
 545
 546         rfkill_unregister(rdev->rfkill);
 547
 548         /* protect the device list */
 549         mutex_lock(&cfg80211_mutex);
 550
 551         wait_event(rdev->dev_wait, ({
 552                 int __count;
 553                 mutex_lock(&rdev->devlist_mtx);
 554                 __count = rdev->opencount;
 555                 mutex_unlock(&rdev->devlist_mtx);
 556                 __count == 0;}));
 557
 558         mutex_lock(&rdev->devlist_mtx);
 559         BUG_ON(!list_empty(&rdev->netdev_list));
 560         mutex_unlock(&rdev->devlist_mtx);
 561
 562         /*
 563          * First remove the hardware from everywhere, this makes
 564          * it impossible to find from userspace.
 565          */
 566         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
 567         list_del_rcu(&rdev->list);
 568         synchronize_rcu();
 569
 570         /*
 571          * Try to grab rdev->mtx. If a command is still in progress,
 572          * hopefully the driver will refuse it since it's tearing
 573          * down the device already. We wait for this command to complete
 574          * before unlinking the item from the list.
 575          * Note: as codified by the BUG_ON above we cannot get here if
 576          * a virtual interface is still present. Hence, we can only get
 577          * to lock contention here if userspace issues a command that
 578          * identified the hardware by wiphy index.
 579          */
 580         cfg80211_lock_rdev(rdev);
 581         /* nothing */
 582         cfg80211_unlock_rdev(rdev);
 583
 584         /* If this device got a regulatory hint tell core its
 585          * free to listen now to a new shiny device regulatory hint */
 586         reg_device_remove(wiphy);
 587
 588         cfg80211_rdev_list_generation++;
 589         device_del(&rdev->wiphy.dev);
 590
 591         mutex_unlock(&cfg80211_mutex);
 592
 593         flush_work(&rdev->scan_done_wk);
 594         cancel_work_sync(&rdev->conn_work);
 595         flush_work(&rdev->event_work);
 596 }
 597 EXPORT_SYMBOL(wiphy_unregister);
 598
 599 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
 600 {
 601         struct cfg80211_internal_bss *scan, *tmp;
 602         rfkill_destroy(rdev->rfkill);
 603         mutex_destroy(&rdev->mtx);
 604         mutex_destroy(&rdev->devlist_mtx);
 605         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
 606                 cfg80211_put_bss(&scan->pub);
 607         kfree(rdev);
 608 }
 609
 610 void wiphy_free(struct wiphy *wiphy)
 611 {
 612         put_device(&wiphy->dev);
 613 }
 614 EXPORT_SYMBOL(wiphy_free);
 615
 616 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
 617 {
 618         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
 619
 620         if (rfkill_set_hw_state(rdev->rfkill, blocked))
 621                 schedule_work(&rdev->rfkill_sync);
 622 }
 623 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
 624
 625 static void wdev_cleanup_work(struct work_struct *work)
 626 {
 627         struct wireless_dev *wdev;
 628         struct cfg80211_registered_device *rdev;
 629
 630         wdev = container_of(work, struct wireless_dev, cleanup_work);
 631         rdev = wiphy_to_dev(wdev->wiphy);
 632
 633         cfg80211_lock_rdev(rdev);
 634
 635         if (WARN_ON(rdev->scan_req && rdev->scan_req->dev == wdev->netdev)) {
 636                 rdev->scan_req->aborted = true;
 637                 ___cfg80211_scan_done(rdev, true);
 638         }
 639
 640         cfg80211_unlock_rdev(rdev);
 641
 642         mutex_lock(&rdev->devlist_mtx);
 643         rdev->opencount--;
 644         mutex_unlock(&rdev->devlist_mtx);
 645         wake_up(&rdev->dev_wait);
 646
 647         dev_put(wdev->netdev);
 648 }
 649
 650 static struct device_type wiphy_type = {
 651         .name   = "wlan",
 652 };
 653
 654 static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
 655                                          unsigned long state,
 656                                          void *ndev)
 657 {
 658         struct net_device *dev = ndev;
 659         struct wireless_dev *wdev = dev->ieee80211_ptr;
 660         struct cfg80211_registered_device *rdev;
 661
 662         if (!wdev)
 663                 return NOTIFY_DONE;
 664
 665         rdev = wiphy_to_dev(wdev->wiphy);
 666
 667         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
 668
 669         switch (state) {
 670         case NETDEV_POST_INIT:
 671                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
 672                 break;
 673         case NETDEV_REGISTER:
 674                 /*
 675                  * NB: cannot take rdev->mtx here because this may be
 676                  * called within code protected by it when interfaces
 677                  * are added with nl80211.
 678                  */
 679                 mutex_init(&wdev->mtx);
 680                 INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
 681                 INIT_LIST_HEAD(&wdev->event_list);
 682                 spin_lock_init(&wdev->event_lock);
 683                 INIT_LIST_HEAD(&wdev->action_registrations);
 684                 spin_lock_init(&wdev->action_registrations_lock);
 685
 686                 mutex_lock(&rdev->devlist_mtx);
 687                 list_add_rcu(&wdev->list, &rdev->netdev_list);
 688                 rdev->devlist_generation++;
 689                 /* can only change netns with wiphy */
 690                 dev->features |= NETIF_F_NETNS_LOCAL;
 691
 692                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
 693                                       "phy80211")) {
 694                         printk(KERN_ERR "wireless: failed to add phy80211 "
 695                                 "symlink to netdev!\n");
 696                 }
 697                 wdev->netdev = dev;
 698                 wdev->sme_state = CFG80211_SME_IDLE;
 699                 mutex_unlock(&rdev->devlist_mtx);
 700 #ifdef CONFIG_CFG80211_WEXT
 701                 wdev->wext.default_key = -1;
 702                 wdev->wext.default_mgmt_key = -1;
 703                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
 704 #endif
 705
 706                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
 707                         wdev->ps = true;
 708                 else
 709                         wdev->ps = false;
 710                 /* allow mac80211 to determine the timeout */
 711                 wdev->ps_timeout = -1;
 712                 if (rdev->ops->set_power_mgmt)
 713                         if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
 714                                                       wdev->ps,
 715                                                       wdev->ps_timeout)) {
 716                                 /* assume this means it's off */
 717                                 wdev->ps = false;
 718                         }
 719
 720                 if (!dev->ethtool_ops)
 721                         dev->ethtool_ops = &cfg80211_ethtool_ops;
 722
 723                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
 724                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
 725                         dev->priv_flags |= IFF_DONT_BRIDGE;
 726                 break;
 727         case NETDEV_GOING_DOWN:
 728                 switch (wdev->iftype) {
 729                 case NL80211_IFTYPE_ADHOC:
 730                         cfg80211_leave_ibss(rdev, dev, true);
 731                         break;
 732                 case NL80211_IFTYPE_STATION:
 733                         wdev_lock(wdev);
 734 #ifdef CONFIG_CFG80211_WEXT
 735                         kfree(wdev->wext.ie);
 736                         wdev->wext.ie = NULL;
 737                         wdev->wext.ie_len = 0;
 738                         wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
 739 #endif
 740                         __cfg80211_disconnect(rdev, dev,
 741                                               WLAN_REASON_DEAUTH_LEAVING, true);
 742                         cfg80211_mlme_down(rdev, dev);
 743                         wdev_unlock(wdev);
 744                         break;
 745                 default:
 746                         break;
 747                 }
 748                 break;
 749         case NETDEV_DOWN:
 750                 dev_hold(dev);
 751                 queue_work(cfg80211_wq, &wdev->cleanup_work);
 752                 break;
 753         case NETDEV_UP:
 754                 /*
 755                  * If we have a really quick DOWN/UP succession we may
 756                  * have this work still pending ... cancel it and see
 757                  * if it was pending, in which case we need to account
 758                  * for some of the work it would have done.
 759                  */
 760                 if (cancel_work_sync(&wdev->cleanup_work)) {
 761                         mutex_lock(&rdev->devlist_mtx);
 762                         rdev->opencount--;
 763                         mutex_unlock(&rdev->devlist_mtx);
 764                         dev_put(dev);
 765                 }
 766                 cfg80211_lock_rdev(rdev);
 767                 mutex_lock(&rdev->devlist_mtx);
 768 #ifdef CONFIG_CFG80211_WEXT
 769                 wdev_lock(wdev);
 770                 switch (wdev->iftype) {
 771                 case NL80211_IFTYPE_ADHOC:
 772                         cfg80211_ibss_wext_join(rdev, wdev);
 773                         break;
 774                 case NL80211_IFTYPE_STATION:
 775                         cfg80211_mgd_wext_connect(rdev, wdev);
 776                         break;
 777                 default:
 778                         break;
 779                 }
 780                 wdev_unlock(wdev);
 781 #endif
 782                 rdev->opencount++;
 783                 mutex_unlock(&rdev->devlist_mtx);
 784                 cfg80211_unlock_rdev(rdev);
 785                 break;
 786         case NETDEV_UNREGISTER:
 787                 /*
 788                  * NB: cannot take rdev->mtx here because this may be
 789                  * called within code protected by it when interfaces
 790                  * are removed with nl80211.
 791                  */
 792                 mutex_lock(&rdev->devlist_mtx);
 793                 /*
 794                  * It is possible to get NETDEV_UNREGISTER
 795                  * multiple times. To detect that, check
 796                  * that the interface is still on the list
 797                  * of registered interfaces, and only then
 798                  * remove and clean it up.
 799                  */
 800                 if (!list_empty(&wdev->list)) {
 801                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
 802                         list_del_rcu(&wdev->list);
 803                         rdev->devlist_generation++;
 804                         cfg80211_mlme_purge_actions(wdev);
 805 #ifdef CONFIG_CFG80211_WEXT
 806                         kfree(wdev->wext.keys);
 807 #endif
 808                 }
 809                 mutex_unlock(&rdev->devlist_mtx);
 810                 /*
 811                  * synchronise (so that we won't find this netdev
 812                  * from other code any more) and then clear the list
 813                  * head so that the above code can safely check for
 814                  * !list_empty() to avoid double-cleanup.
 815                  */
 816                 synchronize_rcu();
 817                 INIT_LIST_HEAD(&wdev->list);
 818                 break;
 819         case NETDEV_PRE_UP:
 820                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
 821                         return notifier_from_errno(-EOPNOTSUPP);
 822                 if (rfkill_blocked(rdev->rfkill))
 823                         return notifier_from_errno(-ERFKILL);
 824                 break;
 825         }
 826
 827         return NOTIFY_DONE;
 828 }
 829
 830 static struct notifier_block cfg80211_netdev_notifier = {
 831         .notifier_call = cfg80211_netdev_notifier_call,
 832 };
 833
 834 static void __net_exit cfg80211_pernet_exit(struct net *net)
 835 {
 836         struct cfg80211_registered_device *rdev;
 837
 838         rtnl_lock();
 839         mutex_lock(&cfg80211_mutex);
 840         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
 841                 if (net_eq(wiphy_net(&rdev->wiphy), net))
 842                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
 843         }
 844         mutex_unlock(&cfg80211_mutex);
 845         rtnl_unlock();
 846 }
 847
 848 static struct pernet_operations cfg80211_pernet_ops = {
 849         .exit = cfg80211_pernet_exit,
 850 };
 851
 852 static int __init cfg80211_init(void)
 853 {
 854         int err;
 855
 856         err = register_pernet_device(&cfg80211_pernet_ops);
 857         if (err)
 858                 goto out_fail_pernet;
 859
 860         err = wiphy_sysfs_init();
 861         if (err)
 862                 goto out_fail_sysfs;
 863
 864         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
 865         if (err)
 866                 goto out_fail_notifier;
 867
 868         err = nl80211_init();
 869         if (err)
 870                 goto out_fail_nl80211;
 871
 872         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
 873
 874         err = regulatory_init();
 875         if (err)
 876                 goto out_fail_reg;
 877
 878         cfg80211_wq = create_singlethread_workqueue("cfg80211");
 879         if (!cfg80211_wq)
 880                 goto out_fail_wq;
 881
 882         return 0;
 883
 884 out_fail_wq:
 885         regulatory_exit();
 886 out_fail_reg:
 887         debugfs_remove(ieee80211_debugfs_dir);
 888 out_fail_nl80211:
 889         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
 890 out_fail_notifier:
 891         wiphy_sysfs_exit();
 892 out_fail_sysfs:
 893         unregister_pernet_device(&cfg80211_pernet_ops);
 894 out_fail_pernet:
 895         return err;
 896 }
 897 subsys_initcall(cfg80211_init);
 898
 899 static void __exit cfg80211_exit(void)
 900 {
 901         debugfs_remove(ieee80211_debugfs_dir);
 902         nl80211_exit();
 903         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
 904         wiphy_sysfs_exit();
 905         regulatory_exit();
 906         unregister_pernet_device(&cfg80211_pernet_ops);
 907         destroy_workqueue(cfg80211_wq);
 908 }
 909 module_exit(cfg80211_exit);
 910
 911 static int ___wiphy_printk(const char *level, const struct wiphy *wiphy,
 912                            struct va_format *vaf)
 913 {
 914         if (!wiphy)
 915                 return printk("%s(NULL wiphy *): %pV", level, vaf);
 916
 917         return printk("%s%s: %pV", level, wiphy_name(wiphy), vaf);
 918 }
 919
 920 int __wiphy_printk(const char *level, const struct wiphy *wiphy,
 921                    const char *fmt, ...)
 922 {
 923         struct va_format vaf;
 924         va_list args;
 925         int r;
 926
 927         va_start(args, fmt);
 928
 929         vaf.fmt = fmt;
 930         vaf.va = &args;
 931
 932         r = ___wiphy_printk(level, wiphy, &vaf);
 933         va_end(args);
 934
 935         return r;
 936 }
 937 EXPORT_SYMBOL(__wiphy_printk);
 938
 939 #define define_wiphy_printk_level(func, kern_level)             \
 940 int func(const struct wiphy *wiphy, const char *fmt, ...)       \
 941 {                                                               \
 942         struct va_format vaf;                                   \
 943         va_list args;                                           \
 944         int r;                                                  \
 945                                                                 \
 946         va_start(args, fmt);                                    \
 947                                                                 \
 948         vaf.fmt = fmt;                                          \
 949         vaf.va = &args;                                         \
 950                                                                 \
 951         r = ___wiphy_printk(kern_level, wiphy, &vaf);           \
 952         va_end(args);                                           \
 953                                                                 \
 954         return r;                                               \
 955 }                                                               \
 956 EXPORT_SYMBOL(func);
 957
 958 define_wiphy_printk_level(wiphy_debug, KERN_DEBUG);