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 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
   8
   9 #include <linux/if.h>
  10 #include <linux/module.h>
  11 #include <linux/err.h>
  12 #include <linux/list.h>
  13 #include <linux/slab.h>
  14 #include <linux/nl80211.h>
  15 #include <linux/debugfs.h>
  16 #include <linux/notifier.h>
  17 #include <linux/device.h>
  18 #include <linux/etherdevice.h>
  19 #include <linux/rtnetlink.h>
  20 #include <linux/sched.h>
  21 #include <net/genetlink.h>
  22 #include <net/cfg80211.h>
  23 #include "nl80211.h"
  24 #include "core.h"
  25 #include "sysfs.h"
  26 #include "debugfs.h"
  27 #include "wext-compat.h"
  28 #include "ethtool.h"
  29 #include "rdev-ops.h"
  30
  31 /* name for sysfs, %d is appended */
  32 #define PHY_NAME "phy"
  33
  34 MODULE_AUTHOR("Johannes Berg");
  35 MODULE_LICENSE("GPL");
  36 MODULE_DESCRIPTION("wireless configuration support");
  37 MODULE_ALIAS_GENL_FAMILY(NL80211_GENL_NAME);
  38
  39 /* RCU-protected (and RTNL for writers) */
  40 LIST_HEAD(cfg80211_rdev_list);
  41 int cfg80211_rdev_list_generation;
  42
  43 /* for debugfs */
  44 static struct dentry *ieee80211_debugfs_dir;
  45
  46 /* for the cleanup, scan and event works */
  47 struct workqueue_struct *cfg80211_wq;
  48
  49 static bool cfg80211_disable_40mhz_24ghz;
  50 module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
  51 MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
  52                  "Disable 40MHz support in the 2.4GHz band");
  53
  54 struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
  55 {
  56         struct cfg80211_registered_device *result = NULL, *rdev;
  57
  58         ASSERT_RTNL();
  59
  60         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  61                 if (rdev->wiphy_idx == wiphy_idx) {
  62                         result = rdev;
  63                         break;
  64                 }
  65         }
  66
  67         return result;
  68 }
  69
  70 int get_wiphy_idx(struct wiphy *wiphy)
  71 {
  72         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  73
  74         return rdev->wiphy_idx;
  75 }
  76
  77 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
  78 {
  79         struct cfg80211_registered_device *rdev;
  80
  81         ASSERT_RTNL();
  82
  83         rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
  84         if (!rdev)
  85                 return NULL;
  86         return &rdev->wiphy;
  87 }
  88
  89 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
  90                         char *newname)
  91 {
  92         struct cfg80211_registered_device *rdev2;
  93         int wiphy_idx, taken = -1, result, digits;
  94
  95         ASSERT_RTNL();
  96
  97         /* prohibit calling the thing phy%d when %d is not its number */
  98         sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
  99         if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
 100                 /* count number of places needed to print wiphy_idx */
 101                 digits = 1;
 102                 while (wiphy_idx /= 10)
 103                         digits++;
 104                 /*
 105                  * deny the name if it is phy<idx> where <idx> is printed
 106                  * without leading zeroes. taken == strlen(newname) here
 107                  */
 108                 if (taken == strlen(PHY_NAME) + digits)
 109                         return -EINVAL;
 110         }
 111
 112
 113         /* Ignore nop renames */
 114         if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
 115                 return 0;
 116
 117         /* Ensure another device does not already have this name. */
 118         list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
 119                 if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
 120                         return -EINVAL;
 121
 122         result = device_rename(&rdev->wiphy.dev, newname);
 123         if (result)
 124                 return result;
 125
 126         if (rdev->wiphy.debugfsdir &&
 127             !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
 128                             rdev->wiphy.debugfsdir,
 129                             rdev->wiphy.debugfsdir->d_parent,
 130                             newname))
 131                 pr_err("failed to rename debugfs dir to %s!\n", newname);
 132
 133         nl80211_notify_dev_rename(rdev);
 134
 135         return 0;
 136 }
 137
 138 int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
 139                           struct net *net)
 140 {
 141         struct wireless_dev *wdev;
 142         int err = 0;
 143
 144         if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
 145                 return -EOPNOTSUPP;
 146
 147         list_for_each_entry(wdev, &rdev->wdev_list, list) {
 148                 if (!wdev->netdev)
 149                         continue;
 150                 wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
 151                 err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
 152                 if (err)
 153                         break;
 154                 wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
 155         }
 156
 157         if (err) {
 158                 /* failed -- clean up to old netns */
 159                 net = wiphy_net(&rdev->wiphy);
 160
 161                 list_for_each_entry_continue_reverse(wdev, &rdev->wdev_list,
 162                                                      list) {
 163                         if (!wdev->netdev)
 164                                 continue;
 165                         wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
 166                         err = dev_change_net_namespace(wdev->netdev, net,
 167                                                         "wlan%d");
 168                         WARN_ON(err);
 169                         wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
 170                 }
 171
 172                 return err;
 173         }
 174
 175         wiphy_net_set(&rdev->wiphy, net);
 176
 177         err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
 178         WARN_ON(err);
 179
 180         return 0;
 181 }
 182
 183 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
 184 {
 185         struct cfg80211_registered_device *rdev = data;
 186
 187         rdev_rfkill_poll(rdev);
 188 }
 189
 190 void cfg80211_stop_p2p_device(struct cfg80211_registered_device *rdev,
 191                               struct wireless_dev *wdev)
 192 {
 193         ASSERT_RTNL();
 194
 195         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_P2P_DEVICE))
 196                 return;
 197
 198         if (!wdev->p2p_started)
 199                 return;
 200
 201         rdev_stop_p2p_device(rdev, wdev);
 202         wdev->p2p_started = false;
 203
 204         rdev->opencount--;
 205
 206         if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
 207                 if (WARN_ON(!rdev->scan_req->notified))
 208                         rdev->scan_req->aborted = true;
 209                 ___cfg80211_scan_done(rdev, false);
 210         }
 211 }
 212
 213 static int cfg80211_rfkill_set_block(void *data, bool blocked)
 214 {
 215         struct cfg80211_registered_device *rdev = data;
 216         struct wireless_dev *wdev;
 217
 218         if (!blocked)
 219                 return 0;
 220
 221         rtnl_lock();
 222
 223         list_for_each_entry(wdev, &rdev->wdev_list, list) {
 224                 if (wdev->netdev) {
 225                         dev_close(wdev->netdev);
 226                         continue;
 227                 }
 228                 /* otherwise, check iftype */
 229                 switch (wdev->iftype) {
 230                 case NL80211_IFTYPE_P2P_DEVICE:
 231                         cfg80211_stop_p2p_device(rdev, wdev);
 232                         break;
 233                 default:
 234                         break;
 235                 }
 236         }
 237
 238         rtnl_unlock();
 239
 240         return 0;
 241 }
 242
 243 static void cfg80211_rfkill_sync_work(struct work_struct *work)
 244 {
 245         struct cfg80211_registered_device *rdev;
 246
 247         rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
 248         cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
 249 }
 250
 251 static void cfg80211_event_work(struct work_struct *work)
 252 {
 253         struct cfg80211_registered_device *rdev;
 254
 255         rdev = container_of(work, struct cfg80211_registered_device,
 256                             event_work);
 257
 258         rtnl_lock();
 259         cfg80211_process_rdev_events(rdev);
 260         rtnl_unlock();
 261 }
 262
 263 void cfg80211_destroy_ifaces(struct cfg80211_registered_device *rdev)
 264 {
 265         struct cfg80211_iface_destroy *item;
 266
 267         ASSERT_RTNL();
 268
 269         spin_lock_irq(&rdev->destroy_list_lock);
 270         while ((item = list_first_entry_or_null(&rdev->destroy_list,
 271                                                 struct cfg80211_iface_destroy,
 272                                                 list))) {
 273                 struct wireless_dev *wdev, *tmp;
 274                 u32 nlportid = item->nlportid;
 275
 276                 list_del(&item->list);
 277                 kfree(item);
 278                 spin_unlock_irq(&rdev->destroy_list_lock);
 279
 280                 list_for_each_entry_safe(wdev, tmp, &rdev->wdev_list, list) {
 281                         if (nlportid == wdev->owner_nlportid)
 282                                 rdev_del_virtual_intf(rdev, wdev);
 283                 }
 284
 285                 spin_lock_irq(&rdev->destroy_list_lock);
 286         }
 287         spin_unlock_irq(&rdev->destroy_list_lock);
 288 }
 289
 290 static void cfg80211_destroy_iface_wk(struct work_struct *work)
 291 {
 292         struct cfg80211_registered_device *rdev;
 293
 294         rdev = container_of(work, struct cfg80211_registered_device,
 295                             destroy_work);
 296
 297         rtnl_lock();
 298         cfg80211_destroy_ifaces(rdev);
 299         rtnl_unlock();
 300 }
 301
 302 /* exported functions */
 303
 304 struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
 305 {
 306         static atomic_t wiphy_counter = ATOMIC_INIT(0);
 307
 308         struct cfg80211_registered_device *rdev;
 309         int alloc_size;
 310
 311         WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
 312         WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
 313         WARN_ON(ops->connect && !ops->disconnect);
 314         WARN_ON(ops->join_ibss && !ops->leave_ibss);
 315         WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
 316         WARN_ON(ops->add_station && !ops->del_station);
 317         WARN_ON(ops->add_mpath && !ops->del_mpath);
 318         WARN_ON(ops->join_mesh && !ops->leave_mesh);
 319
 320         alloc_size = sizeof(*rdev) + sizeof_priv;
 321
 322         rdev = kzalloc(alloc_size, GFP_KERNEL);
 323         if (!rdev)
 324                 return NULL;
 325
 326         rdev->ops = ops;
 327
 328         rdev->wiphy_idx = atomic_inc_return(&wiphy_counter);
 329
 330         if (unlikely(rdev->wiphy_idx < 0)) {
 331                 /* ugh, wrapped! */
 332                 atomic_dec(&wiphy_counter);
 333                 kfree(rdev);
 334                 return NULL;
 335         }
 336
 337         /* atomic_inc_return makes it start at 1, make it start at 0 */
 338         rdev->wiphy_idx--;
 339
 340         /* give it a proper name */
 341         dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
 342
 343         INIT_LIST_HEAD(&rdev->wdev_list);
 344         INIT_LIST_HEAD(&rdev->beacon_registrations);
 345         spin_lock_init(&rdev->beacon_registrations_lock);
 346         spin_lock_init(&rdev->bss_lock);
 347         INIT_LIST_HEAD(&rdev->bss_list);
 348         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
 349         INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
 350         INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
 351                           cfg80211_dfs_channels_update_work);
 352 #ifdef CONFIG_CFG80211_WEXT
 353         rdev->wiphy.wext = &cfg80211_wext_handler;
 354 #endif
 355
 356         device_initialize(&rdev->wiphy.dev);
 357         rdev->wiphy.dev.class = &ieee80211_class;
 358         rdev->wiphy.dev.platform_data = rdev;
 359
 360         INIT_LIST_HEAD(&rdev->destroy_list);
 361         spin_lock_init(&rdev->destroy_list_lock);
 362         INIT_WORK(&rdev->destroy_work, cfg80211_destroy_iface_wk);
 363
 364 #ifdef CONFIG_CFG80211_DEFAULT_PS
 365         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
 366 #endif
 367
 368         wiphy_net_set(&rdev->wiphy, &init_net);
 369
 370         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
 371         rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
 372                                    &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
 373                                    &rdev->rfkill_ops, rdev);
 374
 375         if (!rdev->rfkill) {
 376                 kfree(rdev);
 377                 return NULL;
 378         }
 379
 380         INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
 381         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
 382         INIT_WORK(&rdev->event_work, cfg80211_event_work);
 383
 384         init_waitqueue_head(&rdev->dev_wait);
 385
 386         /*
 387          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
 388          * Fragmentation and RTS threshold are disabled by default with the
 389          * special -1 value.
 390          */
 391         rdev->wiphy.retry_short = 7;
 392         rdev->wiphy.retry_long = 4;
 393         rdev->wiphy.frag_threshold = (u32) -1;
 394         rdev->wiphy.rts_threshold = (u32) -1;
 395         rdev->wiphy.coverage_class = 0;
 396
 397         return &rdev->wiphy;
 398 }
 399 EXPORT_SYMBOL(wiphy_new);
 400
 401 static int wiphy_verify_combinations(struct wiphy *wiphy)
 402 {
 403         const struct ieee80211_iface_combination *c;
 404         int i, j;
 405
 406         for (i = 0; i < wiphy->n_iface_combinations; i++) {
 407                 u32 cnt = 0;
 408                 u16 all_iftypes = 0;
 409
 410                 c = &wiphy->iface_combinations[i];
 411
 412                 /*
 413                  * Combinations with just one interface aren't real,
 414                  * however we make an exception for DFS.
 415                  */
 416                 if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
 417                         return -EINVAL;
 418
 419                 /* Need at least one channel */
 420                 if (WARN_ON(!c->num_different_channels))
 421                         return -EINVAL;
 422
 423                 /*
 424                  * Put a sane limit on maximum number of different
 425                  * channels to simplify channel accounting code.
 426                  */
 427                 if (WARN_ON(c->num_different_channels >
 428                                 CFG80211_MAX_NUM_DIFFERENT_CHANNELS))
 429                         return -EINVAL;
 430
 431                 /* DFS only works on one channel. */
 432                 if (WARN_ON(c->radar_detect_widths &&
 433                             (c->num_different_channels > 1)))
 434                         return -EINVAL;
 435
 436                 if (WARN_ON(!c->n_limits))
 437                         return -EINVAL;
 438
 439                 for (j = 0; j < c->n_limits; j++) {
 440                         u16 types = c->limits[j].types;
 441
 442                         /* interface types shouldn't overlap */
 443                         if (WARN_ON(types & all_iftypes))
 444                                 return -EINVAL;
 445                         all_iftypes |= types;
 446
 447                         if (WARN_ON(!c->limits[j].max))
 448                                 return -EINVAL;
 449
 450                         /* Shouldn't list software iftypes in combinations! */
 451                         if (WARN_ON(wiphy->software_iftypes & types))
 452                                 return -EINVAL;
 453
 454                         /* Only a single P2P_DEVICE can be allowed */
 455                         if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
 456                                     c->limits[j].max > 1))
 457                                 return -EINVAL;
 458
 459                         cnt += c->limits[j].max;
 460                         /*
 461                          * Don't advertise an unsupported type
 462                          * in a combination.
 463                          */
 464                         if (WARN_ON((wiphy->interface_modes & types) != types))
 465                                 return -EINVAL;
 466                 }
 467
 468                 /* You can't even choose that many! */
 469                 if (WARN_ON(cnt < c->max_interfaces))
 470                         return -EINVAL;
 471         }
 472
 473         return 0;
 474 }
 475
 476 int wiphy_register(struct wiphy *wiphy)
 477 {
 478         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 479         int res;
 480         enum ieee80211_band band;
 481         struct ieee80211_supported_band *sband;
 482         bool have_band = false;
 483         int i;
 484         u16 ifmodes = wiphy->interface_modes;
 485
 486         /*
 487          * There are major locking problems in nl80211/mac80211 for CSA,
 488          * disable for all drivers until this has been reworked.
 489          */
 490         wiphy->flags &= ~WIPHY_FLAG_HAS_CHANNEL_SWITCH;
 491
 492 #ifdef CONFIG_PM
 493         if (WARN_ON(wiphy->wowlan &&
 494                     (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
 495                     !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
 496                 return -EINVAL;
 497         if (WARN_ON(wiphy->wowlan &&
 498                     !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
 499                     !wiphy->wowlan->tcp))
 500                 return -EINVAL;
 501 #endif
 502
 503         if (WARN_ON(wiphy->coalesce &&
 504                     (!wiphy->coalesce->n_rules ||
 505                      !wiphy->coalesce->n_patterns) &&
 506                     (!wiphy->coalesce->pattern_min_len ||
 507                      wiphy->coalesce->pattern_min_len >
 508                         wiphy->coalesce->pattern_max_len)))
 509                 return -EINVAL;
 510
 511         if (WARN_ON(wiphy->ap_sme_capa &&
 512                     !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
 513                 return -EINVAL;
 514
 515         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
 516                 return -EINVAL;
 517
 518         if (WARN_ON(wiphy->addresses &&
 519                     !is_zero_ether_addr(wiphy->perm_addr) &&
 520                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
 521                            ETH_ALEN)))
 522                 return -EINVAL;
 523
 524         if (WARN_ON(wiphy->max_acl_mac_addrs &&
 525                     (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
 526                      !rdev->ops->set_mac_acl)))
 527                 return -EINVAL;
 528
 529         if (wiphy->addresses)
 530                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
 531
 532         /* sanity check ifmodes */
 533         WARN_ON(!ifmodes);
 534         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
 535         if (WARN_ON(ifmodes != wiphy->interface_modes))
 536                 wiphy->interface_modes = ifmodes;
 537
 538         res = wiphy_verify_combinations(wiphy);
 539         if (res)
 540                 return res;
 541
 542         /* sanity check supported bands/channels */
 543         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
 544                 sband = wiphy->bands[band];
 545                 if (!sband)
 546                         continue;
 547
 548                 sband->band = band;
 549                 if (WARN_ON(!sband->n_channels))
 550                         return -EINVAL;
 551                 /*
 552                  * on 60gHz band, there are no legacy rates, so
 553                  * n_bitrates is 0
 554                  */
 555                 if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
 556                             !sband->n_bitrates))
 557                         return -EINVAL;
 558
 559                 /*
 560                  * Since cfg80211_disable_40mhz_24ghz is global, we can
 561                  * modify the sband's ht data even if the driver uses a
 562                  * global structure for that.
 563                  */
 564                 if (cfg80211_disable_40mhz_24ghz &&
 565                     band == IEEE80211_BAND_2GHZ &&
 566                     sband->ht_cap.ht_supported) {
 567                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
 568                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
 569                 }
 570
 571                 /*
 572                  * Since we use a u32 for rate bitmaps in
 573                  * ieee80211_get_response_rate, we cannot
 574                  * have more than 32 legacy rates.
 575                  */
 576                 if (WARN_ON(sband->n_bitrates > 32))
 577                         return -EINVAL;
 578
 579                 for (i = 0; i < sband->n_channels; i++) {
 580                         sband->channels[i].orig_flags =
 581                                 sband->channels[i].flags;
 582                         sband->channels[i].orig_mag = INT_MAX;
 583                         sband->channels[i].orig_mpwr =
 584                                 sband->channels[i].max_power;
 585                         sband->channels[i].band = band;
 586                 }
 587
 588                 have_band = true;
 589         }
 590
 591         if (!have_band) {
 592                 WARN_ON(1);
 593                 return -EINVAL;
 594         }
 595
 596 #ifdef CONFIG_PM
 597         if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
 598                     (!rdev->wiphy.wowlan->pattern_min_len ||
 599                      rdev->wiphy.wowlan->pattern_min_len >
 600                                 rdev->wiphy.wowlan->pattern_max_len)))
 601                 return -EINVAL;
 602 #endif
 603
 604         /* check and set up bitrates */
 605         ieee80211_set_bitrate_flags(wiphy);
 606
 607         rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
 608
 609         rtnl_lock();
 610         res = device_add(&rdev->wiphy.dev);
 611         if (res) {
 612                 rtnl_unlock();
 613                 return res;
 614         }
 615
 616         /* set up regulatory info */
 617         wiphy_regulatory_register(wiphy);
 618
 619         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
 620         cfg80211_rdev_list_generation++;
 621
 622         /* add to debugfs */
 623         rdev->wiphy.debugfsdir =
 624                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
 625                                    ieee80211_debugfs_dir);
 626         if (IS_ERR(rdev->wiphy.debugfsdir))
 627                 rdev->wiphy.debugfsdir = NULL;
 628
 629         if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
 630                 struct regulatory_request request;
 631
 632                 request.wiphy_idx = get_wiphy_idx(wiphy);
 633                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
 634                 request.alpha2[0] = '9';
 635                 request.alpha2[1] = '9';
 636
 637                 nl80211_send_reg_change_event(&request);
 638         }
 639
 640         cfg80211_debugfs_rdev_add(rdev);
 641
 642         rdev->wiphy.registered = true;
 643         rtnl_unlock();
 644
 645         res = rfkill_register(rdev->rfkill);
 646         if (res) {
 647                 rfkill_destroy(rdev->rfkill);
 648                 rdev->rfkill = NULL;
 649                 wiphy_unregister(&rdev->wiphy);
 650                 return res;
 651         }
 652
 653         return 0;
 654 }
 655 EXPORT_SYMBOL(wiphy_register);
 656
 657 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
 658 {
 659         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 660
 661         if (!rdev->ops->rfkill_poll)
 662                 return;
 663         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
 664         rfkill_resume_polling(rdev->rfkill);
 665 }
 666 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
 667
 668 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
 669 {
 670         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 671
 672         rfkill_pause_polling(rdev->rfkill);
 673 }
 674 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
 675
 676 void wiphy_unregister(struct wiphy *wiphy)
 677 {
 678         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 679
 680         wait_event(rdev->dev_wait, ({
 681                 int __count;
 682                 rtnl_lock();
 683                 __count = rdev->opencount;
 684                 rtnl_unlock();
 685                 __count == 0; }));
 686
 687         if (rdev->rfkill)
 688                 rfkill_unregister(rdev->rfkill);
 689
 690         rtnl_lock();
 691         rdev->wiphy.registered = false;
 692
 693         WARN_ON(!list_empty(&rdev->wdev_list));
 694
 695         /*
 696          * First remove the hardware from everywhere, this makes
 697          * it impossible to find from userspace.
 698          */
 699         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
 700         list_del_rcu(&rdev->list);
 701         synchronize_rcu();
 702
 703         /*
 704          * If this device got a regulatory hint tell core its
 705          * free to listen now to a new shiny device regulatory hint
 706          */
 707         wiphy_regulatory_deregister(wiphy);
 708
 709         cfg80211_rdev_list_generation++;
 710         device_del(&rdev->wiphy.dev);
 711
 712         rtnl_unlock();
 713
 714         flush_work(&rdev->scan_done_wk);
 715         cancel_work_sync(&rdev->conn_work);
 716         flush_work(&rdev->event_work);
 717         cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
 718         flush_work(&rdev->destroy_work);
 719
 720 #ifdef CONFIG_PM
 721         if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
 722                 rdev_set_wakeup(rdev, false);
 723 #endif
 724         cfg80211_rdev_free_wowlan(rdev);
 725         cfg80211_rdev_free_coalesce(rdev);
 726 }
 727 EXPORT_SYMBOL(wiphy_unregister);
 728
 729 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
 730 {
 731         struct cfg80211_internal_bss *scan, *tmp;
 732         struct cfg80211_beacon_registration *reg, *treg;
 733         rfkill_destroy(rdev->rfkill);
 734         list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
 735                 list_del(&reg->list);
 736                 kfree(reg);
 737         }
 738         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
 739                 cfg80211_put_bss(&rdev->wiphy, &scan->pub);
 740         kfree(rdev);
 741 }
 742
 743 void wiphy_free(struct wiphy *wiphy)
 744 {
 745         put_device(&wiphy->dev);
 746 }
 747 EXPORT_SYMBOL(wiphy_free);
 748
 749 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
 750 {
 751         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 752
 753         if (rfkill_set_hw_state(rdev->rfkill, blocked))
 754                 schedule_work(&rdev->rfkill_sync);
 755 }
 756 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
 757
 758 void cfg80211_unregister_wdev(struct wireless_dev *wdev)
 759 {
 760         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
 761
 762         ASSERT_RTNL();
 763
 764         if (WARN_ON(wdev->netdev))
 765                 return;
 766
 767         list_del_rcu(&wdev->list);
 768         rdev->devlist_generation++;
 769
 770         switch (wdev->iftype) {
 771         case NL80211_IFTYPE_P2P_DEVICE:
 772                 cfg80211_stop_p2p_device(rdev, wdev);
 773                 break;
 774         default:
 775                 WARN_ON_ONCE(1);
 776                 break;
 777         }
 778 }
 779 EXPORT_SYMBOL(cfg80211_unregister_wdev);
 780
 781 static const struct device_type wiphy_type = {
 782         .name   = "wlan",
 783 };
 784
 785 void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
 786                                enum nl80211_iftype iftype, int num)
 787 {
 788         ASSERT_RTNL();
 789
 790         rdev->num_running_ifaces += num;
 791         if (iftype == NL80211_IFTYPE_MONITOR)
 792                 rdev->num_running_monitor_ifaces += num;
 793 }
 794
 795 void __cfg80211_leave(struct cfg80211_registered_device *rdev,
 796                       struct wireless_dev *wdev)
 797 {
 798         struct net_device *dev = wdev->netdev;
 799
 800         ASSERT_RTNL();
 801         ASSERT_WDEV_LOCK(wdev);
 802
 803         switch (wdev->iftype) {
 804         case NL80211_IFTYPE_ADHOC:
 805                 __cfg80211_leave_ibss(rdev, dev, true);
 806                 break;
 807         case NL80211_IFTYPE_P2P_CLIENT:
 808         case NL80211_IFTYPE_STATION:
 809                 if (rdev->sched_scan_req && dev == rdev->sched_scan_req->dev)
 810                         __cfg80211_stop_sched_scan(rdev, false);
 811
 812 #ifdef CONFIG_CFG80211_WEXT
 813                 kfree(wdev->wext.ie);
 814                 wdev->wext.ie = NULL;
 815                 wdev->wext.ie_len = 0;
 816                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
 817 #endif
 818                 cfg80211_disconnect(rdev, dev,
 819                                     WLAN_REASON_DEAUTH_LEAVING, true);
 820                 break;
 821         case NL80211_IFTYPE_MESH_POINT:
 822                 __cfg80211_leave_mesh(rdev, dev);
 823                 break;
 824         case NL80211_IFTYPE_AP:
 825         case NL80211_IFTYPE_P2P_GO:
 826                 __cfg80211_stop_ap(rdev, dev, true);
 827                 break;
 828         default:
 829                 break;
 830         }
 831 }
 832
 833 void cfg80211_leave(struct cfg80211_registered_device *rdev,
 834                     struct wireless_dev *wdev)
 835 {
 836         wdev_lock(wdev);
 837         __cfg80211_leave(rdev, wdev);
 838         wdev_unlock(wdev);
 839 }
 840
 841 void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
 842                          gfp_t gfp)
 843 {
 844         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
 845         struct cfg80211_event *ev;
 846         unsigned long flags;
 847
 848         trace_cfg80211_stop_iface(wiphy, wdev);
 849
 850         ev = kzalloc(sizeof(*ev), gfp);
 851         if (!ev)
 852                 return;
 853
 854         ev->type = EVENT_STOPPED;
 855
 856         spin_lock_irqsave(&wdev->event_lock, flags);
 857         list_add_tail(&ev->list, &wdev->event_list);
 858         spin_unlock_irqrestore(&wdev->event_lock, flags);
 859         queue_work(cfg80211_wq, &rdev->event_work);
 860 }
 861 EXPORT_SYMBOL(cfg80211_stop_iface);
 862
 863 static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
 864                                          unsigned long state, void *ptr)
 865 {
 866         struct net_device *dev = netdev_notifier_info_to_dev(ptr);
 867         struct wireless_dev *wdev = dev->ieee80211_ptr;
 868         struct cfg80211_registered_device *rdev;
 869
 870         if (!wdev)
 871                 return NOTIFY_DONE;
 872
 873         rdev = wiphy_to_rdev(wdev->wiphy);
 874
 875         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
 876
 877         switch (state) {
 878         case NETDEV_POST_INIT:
 879                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
 880                 break;
 881         case NETDEV_REGISTER:
 882                 /*
 883                  * NB: cannot take rdev->mtx here because this may be
 884                  * called within code protected by it when interfaces
 885                  * are added with nl80211.
 886                  */
 887                 mutex_init(&wdev->mtx);
 888                 INIT_LIST_HEAD(&wdev->event_list);
 889                 spin_lock_init(&wdev->event_lock);
 890                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
 891                 spin_lock_init(&wdev->mgmt_registrations_lock);
 892
 893                 wdev->identifier = ++rdev->wdev_id;
 894                 list_add_rcu(&wdev->list, &rdev->wdev_list);
 895                 rdev->devlist_generation++;
 896                 /* can only change netns with wiphy */
 897                 dev->features |= NETIF_F_NETNS_LOCAL;
 898
 899                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
 900                                       "phy80211")) {
 901                         pr_err("failed to add phy80211 symlink to netdev!\n");
 902                 }
 903                 wdev->netdev = dev;
 904 #ifdef CONFIG_CFG80211_WEXT
 905                 wdev->wext.default_key = -1;
 906                 wdev->wext.default_mgmt_key = -1;
 907                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
 908 #endif
 909
 910                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
 911                         wdev->ps = true;
 912                 else
 913                         wdev->ps = false;
 914                 /* allow mac80211 to determine the timeout */
 915                 wdev->ps_timeout = -1;
 916
 917                 netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
 918
 919                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
 920                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
 921                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
 922                         dev->priv_flags |= IFF_DONT_BRIDGE;
 923                 break;
 924         case NETDEV_GOING_DOWN:
 925                 cfg80211_leave(rdev, wdev);
 926                 break;
 927         case NETDEV_DOWN:
 928                 cfg80211_update_iface_num(rdev, wdev->iftype, -1);
 929                 if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
 930                         if (WARN_ON(!rdev->scan_req->notified))
 931                                 rdev->scan_req->aborted = true;
 932                         ___cfg80211_scan_done(rdev, false);
 933                 }
 934
 935                 if (WARN_ON(rdev->sched_scan_req &&
 936                             rdev->sched_scan_req->dev == wdev->netdev)) {
 937                         __cfg80211_stop_sched_scan(rdev, false);
 938                 }
 939
 940                 rdev->opencount--;
 941                 wake_up(&rdev->dev_wait);
 942                 break;
 943         case NETDEV_UP:
 944                 cfg80211_update_iface_num(rdev, wdev->iftype, 1);
 945                 wdev_lock(wdev);
 946                 switch (wdev->iftype) {
 947 #ifdef CONFIG_CFG80211_WEXT
 948                 case NL80211_IFTYPE_ADHOC:
 949                         cfg80211_ibss_wext_join(rdev, wdev);
 950                         break;
 951                 case NL80211_IFTYPE_STATION:
 952                         cfg80211_mgd_wext_connect(rdev, wdev);
 953                         break;
 954 #endif
 955 #ifdef CONFIG_MAC80211_MESH
 956                 case NL80211_IFTYPE_MESH_POINT:
 957                         {
 958                                 /* backward compat code... */
 959                                 struct mesh_setup setup;
 960                                 memcpy(&setup, &default_mesh_setup,
 961                                                 sizeof(setup));
 962                                  /* back compat only needed for mesh_id */
 963                                 setup.mesh_id = wdev->ssid;
 964                                 setup.mesh_id_len = wdev->mesh_id_up_len;
 965                                 if (wdev->mesh_id_up_len)
 966                                         __cfg80211_join_mesh(rdev, dev,
 967                                                         &setup,
 968                                                         &default_mesh_config);
 969                                 break;
 970                         }
 971 #endif
 972                 default:
 973                         break;
 974                 }
 975                 wdev_unlock(wdev);
 976                 rdev->opencount++;
 977
 978                 /*
 979                  * Configure power management to the driver here so that its
 980                  * correctly set also after interface type changes etc.
 981                  */
 982                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
 983                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
 984                     rdev->ops->set_power_mgmt)
 985                         if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
 986                                                 wdev->ps_timeout)) {
 987                                 /* assume this means it's off */
 988                                 wdev->ps = false;
 989                         }
 990                 break;
 991         case NETDEV_UNREGISTER:
 992                 /*
 993                  * It is possible to get NETDEV_UNREGISTER
 994                  * multiple times. To detect that, check
 995                  * that the interface is still on the list
 996                  * of registered interfaces, and only then
 997                  * remove and clean it up.
 998                  */
 999                 if (!list_empty(&wdev->list)) {
1000                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
1001                         list_del_rcu(&wdev->list);
1002                         rdev->devlist_generation++;
1003                         cfg80211_mlme_purge_registrations(wdev);
1004 #ifdef CONFIG_CFG80211_WEXT
1005                         kfree(wdev->wext.keys);
1006 #endif
1007                 }
1008                 /*
1009                  * synchronise (so that we won't find this netdev
1010                  * from other code any more) and then clear the list
1011                  * head so that the above code can safely check for
1012                  * !list_empty() to avoid double-cleanup.
1013                  */
1014                 synchronize_rcu();
1015                 INIT_LIST_HEAD(&wdev->list);
1016                 /*
1017                  * Ensure that all events have been processed and
1018                  * freed.
1019                  */
1020                 cfg80211_process_wdev_events(wdev);
1021
1022                 if (WARN_ON(wdev->current_bss)) {
1023                         cfg80211_unhold_bss(wdev->current_bss);
1024                         cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
1025                         wdev->current_bss = NULL;
1026                 }
1027                 break;
1028         case NETDEV_PRE_UP:
1029                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
1030                         return notifier_from_errno(-EOPNOTSUPP);
1031                 if (rfkill_blocked(rdev->rfkill))
1032                         return notifier_from_errno(-ERFKILL);
1033                 break;
1034         default:
1035                 return NOTIFY_DONE;
1036         }
1037
1038         return NOTIFY_OK;
1039 }
1040
1041 static struct notifier_block cfg80211_netdev_notifier = {
1042         .notifier_call = cfg80211_netdev_notifier_call,
1043 };
1044
1045 static void __net_exit cfg80211_pernet_exit(struct net *net)
1046 {
1047         struct cfg80211_registered_device *rdev;
1048
1049         rtnl_lock();
1050         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1051                 if (net_eq(wiphy_net(&rdev->wiphy), net))
1052                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
1053         }
1054         rtnl_unlock();
1055 }
1056
1057 static struct pernet_operations cfg80211_pernet_ops = {
1058         .exit = cfg80211_pernet_exit,
1059 };
1060
1061 static int __init cfg80211_init(void)
1062 {
1063         int err;
1064
1065         err = register_pernet_device(&cfg80211_pernet_ops);
1066         if (err)
1067                 goto out_fail_pernet;
1068
1069         err = wiphy_sysfs_init();
1070         if (err)
1071                 goto out_fail_sysfs;
1072
1073         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
1074         if (err)
1075                 goto out_fail_notifier;
1076
1077         err = nl80211_init();
1078         if (err)
1079                 goto out_fail_nl80211;
1080
1081         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
1082
1083         err = regulatory_init();
1084         if (err)
1085                 goto out_fail_reg;
1086
1087         cfg80211_wq = create_singlethread_workqueue("cfg80211");
1088         if (!cfg80211_wq) {
1089                 err = -ENOMEM;
1090                 goto out_fail_wq;
1091         }
1092
1093         return 0;
1094
1095 out_fail_wq:
1096         regulatory_exit();
1097 out_fail_reg:
1098         debugfs_remove(ieee80211_debugfs_dir);
1099 out_fail_nl80211:
1100         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1101 out_fail_notifier:
1102         wiphy_sysfs_exit();
1103 out_fail_sysfs:
1104         unregister_pernet_device(&cfg80211_pernet_ops);
1105 out_fail_pernet:
1106         return err;
1107 }
1108 subsys_initcall(cfg80211_init);
1109
1110 static void __exit cfg80211_exit(void)
1111 {
1112         debugfs_remove(ieee80211_debugfs_dir);
1113         nl80211_exit();
1114         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1115         wiphy_sysfs_exit();
1116         regulatory_exit();
1117         unregister_pernet_device(&cfg80211_pernet_ops);
1118         destroy_workqueue(cfg80211_wq);
1119 }
1120 module_exit(cfg80211_exit);