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