net/wireless/core.c

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