core.c 26.6 KB
Newer Older
1 2 3
/*
 * This is the linux wireless configuration interface.
 *
J
Johannes Berg 已提交
4
 * Copyright 2006-2010		Johannes Berg <johannes@sipsolutions.net>
5 6
 */

7 8
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

9 10 11 12
#include <linux/if.h>
#include <linux/module.h>
#include <linux/err.h>
#include <linux/list.h>
13
#include <linux/slab.h>
14 15 16 17
#include <linux/nl80211.h>
#include <linux/debugfs.h>
#include <linux/notifier.h>
#include <linux/device.h>
18
#include <linux/etherdevice.h>
J
Johannes Berg 已提交
19
#include <linux/rtnetlink.h>
20
#include <linux/sched.h>
21 22
#include <net/genetlink.h>
#include <net/cfg80211.h>
23
#include "nl80211.h"
24 25
#include "core.h"
#include "sysfs.h"
26
#include "debugfs.h"
27
#include "wext-compat.h"
28
#include "ethtool.h"
29
#include "rdev-ops.h"
30 31 32 33 34 35 36

/* name for sysfs, %d is appended */
#define PHY_NAME "phy"

MODULE_AUTHOR("Johannes Berg");
MODULE_LICENSE("GPL");
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 44 45
/* for debugfs */
static struct dentry *ieee80211_debugfs_dir;

46 47 48
/* for the cleanup, scan and event works */
struct workqueue_struct *cfg80211_wq;

49 50 51 52 53
static bool cfg80211_disable_40mhz_24ghz;
module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
		 "Disable 40MHz support in the 2.4GHz band");

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 61 62
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (rdev->wiphy_idx == wiphy_idx) {
			result = rdev;
63 64 65 66 67 68 69
			break;
		}
	}

	return result;
}

70 71
int get_wiphy_idx(struct wiphy *wiphy)
{
J
Johannes Berg 已提交
72 73
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);

74
	return rdev->wiphy_idx;
75 76 77 78
}

struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
{
79
	struct cfg80211_registered_device *rdev;
80

81
	ASSERT_RTNL();
82

83 84
	rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
	if (!rdev)
85
		return NULL;
86
	return &rdev->wiphy;
87 88
}

89 90 91
int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
			char *newname)
{
92
	struct cfg80211_registered_device *rdev2;
93
	int wiphy_idx, taken = -1, result, digits;
94

95
	ASSERT_RTNL();
96

97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
	/* prohibit calling the thing phy%d when %d is not its number */
	sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
	if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
		/* count number of places needed to print wiphy_idx */
		digits = 1;
		while (wiphy_idx /= 10)
			digits++;
		/*
		 * deny the name if it is phy<idx> where <idx> is printed
		 * without leading zeroes. taken == strlen(newname) here
		 */
		if (taken == strlen(PHY_NAME) + digits)
			return -EINVAL;
	}


113 114
	/* Ignore nop renames */
	if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
115
		return 0;
116 117

	/* Ensure another device does not already have this name. */
118 119
	list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
		if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
120
			return -EINVAL;
121 122 123

	result = device_rename(&rdev->wiphy.dev, newname);
	if (result)
124
		return result;
125

126 127
	if (rdev->wiphy.debugfsdir &&
	    !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
128 129 130
			    rdev->wiphy.debugfsdir,
			    rdev->wiphy.debugfsdir->d_parent,
			    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 139 140 141 142 143
int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
			  struct net *net)
{
	struct wireless_dev *wdev;
	int err = 0;

J
Johannes Berg 已提交
144
	if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
145 146
		return -EOPNOTSUPP;

147
	list_for_each_entry(wdev, &rdev->wdev_list, list) {
148 149
		if (!wdev->netdev)
			continue;
150 151 152 153 154 155 156 157 158 159 160
		wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
		err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
		if (err)
			break;
		wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
	}

	if (err) {
		/* failed -- clean up to old netns */
		net = wiphy_net(&rdev->wiphy);

161
		list_for_each_entry_continue_reverse(wdev, &rdev->wdev_list,
162
						     list) {
163 164
			if (!wdev->netdev)
				continue;
165 166 167 168 169 170
			wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
			err = dev_change_net_namespace(wdev->netdev, net,
							"wlan%d");
			WARN_ON(err);
			wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
		}
171 172

		return err;
173 174 175 176
	}

	wiphy_net_set(&rdev->wiphy, net);

177 178 179 180
	err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
	WARN_ON(err);

	return 0;
181 182
}

J
Johannes Berg 已提交
183 184
static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
{
185
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
186

187
	rdev_rfkill_poll(rdev);
J
Johannes Berg 已提交
188 189
}

190 191 192
void cfg80211_stop_p2p_device(struct cfg80211_registered_device *rdev,
			      struct wireless_dev *wdev)
{
193
	ASSERT_RTNL();
194 195 196 197 198 199 200 201 202 203 204 205

	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_P2P_DEVICE))
		return;

	if (!wdev->p2p_started)
		return;

	rdev_stop_p2p_device(rdev, wdev);
	wdev->p2p_started = false;

	rdev->opencount--;

J
Johannes Berg 已提交
206 207 208
	if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
		if (WARN_ON(!rdev->scan_req->notified))
			rdev->scan_req->aborted = true;
209
		___cfg80211_scan_done(rdev, false);
J
Johannes Berg 已提交
210
	}
211 212
}

J
Johannes Berg 已提交
213 214
static int cfg80211_rfkill_set_block(void *data, bool blocked)
{
215
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
216 217 218 219 220 221
	struct wireless_dev *wdev;

	if (!blocked)
		return 0;

	rtnl_lock();
222

223 224
	list_for_each_entry(wdev, &rdev->wdev_list, list) {
		if (wdev->netdev) {
225
			dev_close(wdev->netdev);
226 227 228 229 230
			continue;
		}
		/* otherwise, check iftype */
		switch (wdev->iftype) {
		case NL80211_IFTYPE_P2P_DEVICE:
231
			cfg80211_stop_p2p_device(rdev, wdev);
232 233 234 235 236
			break;
		default:
			break;
		}
	}
J
Johannes Berg 已提交
237 238 239 240 241 242 243 244

	rtnl_unlock();

	return 0;
}

static void cfg80211_rfkill_sync_work(struct work_struct *work)
{
245
	struct cfg80211_registered_device *rdev;
J
Johannes Berg 已提交
246

247 248
	rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
	cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
J
Johannes Berg 已提交
249 250
}

J
Johannes Berg 已提交
251 252 253 254 255 256 257 258
static void cfg80211_event_work(struct work_struct *work)
{
	struct cfg80211_registered_device *rdev;

	rdev = container_of(work, struct cfg80211_registered_device,
			    event_work);

	rtnl_lock();
259
	cfg80211_process_rdev_events(rdev);
J
Johannes Berg 已提交
260 261 262
	rtnl_unlock();
}

263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
void cfg80211_destroy_ifaces(struct cfg80211_registered_device *rdev)
{
	struct cfg80211_iface_destroy *item;

	ASSERT_RTNL();

	spin_lock_irq(&rdev->destroy_list_lock);
	while ((item = list_first_entry_or_null(&rdev->destroy_list,
						struct cfg80211_iface_destroy,
						list))) {
		struct wireless_dev *wdev, *tmp;
		u32 nlportid = item->nlportid;

		list_del(&item->list);
		kfree(item);
		spin_unlock_irq(&rdev->destroy_list_lock);

		list_for_each_entry_safe(wdev, tmp, &rdev->wdev_list, list) {
			if (nlportid == wdev->owner_nlportid)
				rdev_del_virtual_intf(rdev, wdev);
		}

		spin_lock_irq(&rdev->destroy_list_lock);
	}
	spin_unlock_irq(&rdev->destroy_list_lock);
}

static void cfg80211_destroy_iface_wk(struct work_struct *work)
{
	struct cfg80211_registered_device *rdev;

	rdev = container_of(work, struct cfg80211_registered_device,
			    destroy_work);

	rtnl_lock();
	cfg80211_destroy_ifaces(rdev);
	rtnl_unlock();
}

302 303
/* exported functions */

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 310
	int alloc_size;

311 312 313 314 315 316 317
	WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
	WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
	WARN_ON(ops->connect && !ops->disconnect);
	WARN_ON(ops->join_ibss && !ops->leave_ibss);
	WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
	WARN_ON(ops->add_station && !ops->del_station);
	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 323
	rdev = kzalloc(alloc_size, GFP_KERNEL);
	if (!rdev)
324 325
		return NULL;

326
	rdev->ops = ops;
327

328
	rdev->wiphy_idx = atomic_inc_return(&wiphy_counter);
329

J
Johannes Berg 已提交
330
	if (unlikely(rdev->wiphy_idx < 0)) {
331
		/* ugh, wrapped! */
332
		atomic_dec(&wiphy_counter);
333
		kfree(rdev);
334 335 336
		return NULL;
	}

337 338 339
	/* atomic_inc_return makes it start at 1, make it start at 0 */
	rdev->wiphy_idx--;

340 341 342
	/* give it a proper name */
	dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);

343
	INIT_LIST_HEAD(&rdev->wdev_list);
344 345
	INIT_LIST_HEAD(&rdev->beacon_registrations);
	spin_lock_init(&rdev->beacon_registrations_lock);
346 347 348
	spin_lock_init(&rdev->bss_lock);
	INIT_LIST_HEAD(&rdev->bss_list);
	INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
349
	INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
350 351
	INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
			  cfg80211_dfs_channels_update_work);
J
Johannes Berg 已提交
352 353 354 355
#ifdef CONFIG_CFG80211_WEXT
	rdev->wiphy.wext = &cfg80211_wext_handler;
#endif

356 357 358 359
	device_initialize(&rdev->wiphy.dev);
	rdev->wiphy.dev.class = &ieee80211_class;
	rdev->wiphy.dev.platform_data = rdev;

360 361 362 363
	INIT_LIST_HEAD(&rdev->destroy_list);
	spin_lock_init(&rdev->destroy_list_lock);
	INIT_WORK(&rdev->destroy_work, cfg80211_destroy_iface_wk);

J
Johannes Berg 已提交
364 365 366
#ifdef CONFIG_CFG80211_DEFAULT_PS
	rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
#endif
367

368 369
	wiphy_net_set(&rdev->wiphy, &init_net);

370 371 372 373 374 375 376
	rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
	rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
				   &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
				   &rdev->rfkill_ops, rdev);

	if (!rdev->rfkill) {
		kfree(rdev);
J
Johannes Berg 已提交
377 378 379
		return NULL;
	}

380 381 382
	INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
	INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
	INIT_WORK(&rdev->event_work, cfg80211_event_work);
J
Johannes Berg 已提交
383

384 385
	init_waitqueue_head(&rdev->dev_wait);

386 387 388 389 390
	/*
	 * Initialize wiphy parameters to IEEE 802.11 MIB default values.
	 * Fragmentation and RTS threshold are disabled by default with the
	 * special -1 value.
	 */
391 392 393 394
	rdev->wiphy.retry_short = 7;
	rdev->wiphy.retry_long = 4;
	rdev->wiphy.frag_threshold = (u32) -1;
	rdev->wiphy.rts_threshold = (u32) -1;
395
	rdev->wiphy.coverage_class = 0;
396

397
	return &rdev->wiphy;
398 399 400
}
EXPORT_SYMBOL(wiphy_new);

401 402 403 404 405 406 407 408 409 410 411
static int wiphy_verify_combinations(struct wiphy *wiphy)
{
	const struct ieee80211_iface_combination *c;
	int i, j;

	for (i = 0; i < wiphy->n_iface_combinations; i++) {
		u32 cnt = 0;
		u16 all_iftypes = 0;

		c = &wiphy->iface_combinations[i];

412 413 414 415 416
		/*
		 * Combinations with just one interface aren't real,
		 * however we make an exception for DFS.
		 */
		if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
417 418 419 420 421 422
			return -EINVAL;

		/* Need at least one channel */
		if (WARN_ON(!c->num_different_channels))
			return -EINVAL;

423 424 425 426 427 428 429 430
		/*
		 * Put a sane limit on maximum number of different
		 * channels to simplify channel accounting code.
		 */
		if (WARN_ON(c->num_different_channels >
				CFG80211_MAX_NUM_DIFFERENT_CHANNELS))
			return -EINVAL;

431 432 433 434 435
		/* DFS only works on one channel. */
		if (WARN_ON(c->radar_detect_widths &&
			    (c->num_different_channels > 1)))
			return -EINVAL;

436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456
		if (WARN_ON(!c->n_limits))
			return -EINVAL;

		for (j = 0; j < c->n_limits; j++) {
			u16 types = c->limits[j].types;

			/*
			 * interface types shouldn't overlap, this is
			 * used in cfg80211_can_change_interface()
			 */
			if (WARN_ON(types & all_iftypes))
				return -EINVAL;
			all_iftypes |= types;

			if (WARN_ON(!c->limits[j].max))
				return -EINVAL;

			/* Shouldn't list software iftypes in combinations! */
			if (WARN_ON(wiphy->software_iftypes & types))
				return -EINVAL;

457 458 459 460 461
			/* Only a single P2P_DEVICE can be allowed */
			if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
				    c->limits[j].max > 1))
				return -EINVAL;

462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478
			cnt += c->limits[j].max;
			/*
			 * Don't advertise an unsupported type
			 * in a combination.
			 */
			if (WARN_ON((wiphy->interface_modes & types) != types))
				return -EINVAL;
		}

		/* You can't even choose that many! */
		if (WARN_ON(cnt < c->max_interfaces))
			return -EINVAL;
	}

	return 0;
}

479 480
int wiphy_register(struct wiphy *wiphy)
{
481
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
482
	int res;
483 484 485 486
	enum ieee80211_band band;
	struct ieee80211_supported_band *sband;
	bool have_band = false;
	int i;
487 488
	u16 ifmodes = wiphy->interface_modes;

489 490 491 492 493 494
	/*
	 * There are major locking problems in nl80211/mac80211 for CSA,
	 * disable for all drivers until this has been reworked.
	 */
	wiphy->flags &= ~WIPHY_FLAG_HAS_CHANNEL_SWITCH;

495
#ifdef CONFIG_PM
496 497 498 499 500 501 502
	if (WARN_ON(wiphy->wowlan &&
		    (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
		    !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
		return -EINVAL;
	if (WARN_ON(wiphy->wowlan &&
		    !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
		    !wiphy->wowlan->tcp))
503
		return -EINVAL;
504
#endif
505

506 507 508 509 510 511 512 513
	if (WARN_ON(wiphy->coalesce &&
		    (!wiphy->coalesce->n_rules ||
		     !wiphy->coalesce->n_patterns) &&
		    (!wiphy->coalesce->pattern_min_len ||
		     wiphy->coalesce->pattern_min_len >
			wiphy->coalesce->pattern_max_len)))
		return -EINVAL;

J
Johannes Berg 已提交
514 515 516 517
	if (WARN_ON(wiphy->ap_sme_capa &&
		    !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
		return -EINVAL;

518 519 520 521 522 523 524 525 526
	if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
		return -EINVAL;

	if (WARN_ON(wiphy->addresses &&
		    !is_zero_ether_addr(wiphy->perm_addr) &&
		    memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
			   ETH_ALEN)))
		return -EINVAL;

527 528 529 530 531
	if (WARN_ON(wiphy->max_acl_mac_addrs &&
		    (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
		     !rdev->ops->set_mac_acl)))
		return -EINVAL;

532 533 534
	if (wiphy->addresses)
		memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);

535 536
	/* sanity check ifmodes */
	WARN_ON(!ifmodes);
537
	ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
538 539
	if (WARN_ON(ifmodes != wiphy->interface_modes))
		wiphy->interface_modes = ifmodes;
540

541 542 543 544
	res = wiphy_verify_combinations(wiphy);
	if (res)
		return res;

545 546 547 548 549 550 551
	/* sanity check supported bands/channels */
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		sband = wiphy->bands[band];
		if (!sband)
			continue;

		sband->band = band;
552 553 554 555 556 557 558 559
		if (WARN_ON(!sband->n_channels))
			return -EINVAL;
		/*
		 * on 60gHz band, there are no legacy rates, so
		 * n_bitrates is 0
		 */
		if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
			    !sband->n_bitrates))
560 561
			return -EINVAL;

562 563 564 565 566 567 568 569 570 571 572 573
		/*
		 * Since cfg80211_disable_40mhz_24ghz is global, we can
		 * modify the sband's ht data even if the driver uses a
		 * global structure for that.
		 */
		if (cfg80211_disable_40mhz_24ghz &&
		    band == IEEE80211_BAND_2GHZ &&
		    sband->ht_cap.ht_supported) {
			sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
			sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
		}

574 575 576 577 578 579
		/*
		 * Since we use a u32 for rate bitmaps in
		 * ieee80211_get_response_rate, we cannot
		 * have more than 32 legacy rates.
		 */
		if (WARN_ON(sband->n_bitrates > 32))
580 581 582 583 584
			return -EINVAL;

		for (i = 0; i < sband->n_channels; i++) {
			sband->channels[i].orig_flags =
				sband->channels[i].flags;
585
			sband->channels[i].orig_mag = INT_MAX;
586 587 588 589 590 591 592 593 594 595 596 597 598
			sband->channels[i].orig_mpwr =
				sband->channels[i].max_power;
			sband->channels[i].band = band;
		}

		have_band = true;
	}

	if (!have_band) {
		WARN_ON(1);
		return -EINVAL;
	}

599
#ifdef CONFIG_PM
600 601 602 603 604
	if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
		    (!rdev->wiphy.wowlan->pattern_min_len ||
		     rdev->wiphy.wowlan->pattern_min_len >
				rdev->wiphy.wowlan->pattern_max_len)))
		return -EINVAL;
605
#endif
J
Johannes Berg 已提交
606

607 608 609
	/* check and set up bitrates */
	ieee80211_set_bitrate_flags(wiphy);

610 611
	rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;

612
	rtnl_lock();
613
	res = device_add(&rdev->wiphy.dev);
614
	if (res) {
615
		rtnl_unlock();
616 617
		return res;
	}
J
Johannes Berg 已提交
618

619
	/* set up regulatory info */
620
	wiphy_regulatory_register(wiphy);
621

J
Johannes Berg 已提交
622
	list_add_rcu(&rdev->list, &cfg80211_rdev_list);
623
	cfg80211_rdev_list_generation++;
624 625

	/* add to debugfs */
626 627
	rdev->wiphy.debugfsdir =
		debugfs_create_dir(wiphy_name(&rdev->wiphy),
628
				   ieee80211_debugfs_dir);
629 630
	if (IS_ERR(rdev->wiphy.debugfsdir))
		rdev->wiphy.debugfsdir = NULL;
631

632
	if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
633 634 635 636 637 638 639 640 641 642
		struct regulatory_request request;

		request.wiphy_idx = get_wiphy_idx(wiphy);
		request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
		request.alpha2[0] = '9';
		request.alpha2[1] = '9';

		nl80211_send_reg_change_event(&request);
	}

643
	cfg80211_debugfs_rdev_add(rdev);
644

645 646
	rdev->wiphy.registered = true;
	rtnl_unlock();
647 648 649 650 651 652 653 654 655

	res = rfkill_register(rdev->rfkill);
	if (res) {
		rfkill_destroy(rdev->rfkill);
		rdev->rfkill = NULL;
		wiphy_unregister(&rdev->wiphy);
		return res;
	}

656
	return 0;
657 658 659
}
EXPORT_SYMBOL(wiphy_register);

J
Johannes Berg 已提交
660 661
void wiphy_rfkill_start_polling(struct wiphy *wiphy)
{
662
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
663

664
	if (!rdev->ops->rfkill_poll)
J
Johannes Berg 已提交
665
		return;
666 667
	rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
	rfkill_resume_polling(rdev->rfkill);
J
Johannes Berg 已提交
668 669 670 671 672
}
EXPORT_SYMBOL(wiphy_rfkill_start_polling);

void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
{
673
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
674

675
	rfkill_pause_polling(rdev->rfkill);
J
Johannes Berg 已提交
676 677 678
}
EXPORT_SYMBOL(wiphy_rfkill_stop_polling);

679 680
void wiphy_unregister(struct wiphy *wiphy)
{
681
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
682

683 684
	wait_event(rdev->dev_wait, ({
		int __count;
685
		rtnl_lock();
686
		__count = rdev->opencount;
687
		rtnl_unlock();
688
		__count == 0; }));
689

690 691
	if (rdev->rfkill)
		rfkill_unregister(rdev->rfkill);
692

693 694 695
	rtnl_lock();
	rdev->wiphy.registered = false;

696
	BUG_ON(!list_empty(&rdev->wdev_list));
697 698 699 700 701

	/*
	 * First remove the hardware from everywhere, this makes
	 * it impossible to find from userspace.
	 */
702
	debugfs_remove_recursive(rdev->wiphy.debugfsdir);
J
Johannes Berg 已提交
703 704
	list_del_rcu(&rdev->list);
	synchronize_rcu();
705

706 707 708 709 710
	/*
	 * If this device got a regulatory hint tell core its
	 * free to listen now to a new shiny device regulatory hint
	 */
	wiphy_regulatory_deregister(wiphy);
711

712
	cfg80211_rdev_list_generation++;
713
	device_del(&rdev->wiphy.dev);
714

715
	rtnl_unlock();
J
Johannes Berg 已提交
716

717
	flush_work(&rdev->scan_done_wk);
J
Johannes Berg 已提交
718 719
	cancel_work_sync(&rdev->conn_work);
	flush_work(&rdev->event_work);
720
	cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
721
	flush_work(&rdev->destroy_work);
722

723 724
#ifdef CONFIG_PM
	if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
725
		rdev_set_wakeup(rdev, false);
726
#endif
727
	cfg80211_rdev_free_wowlan(rdev);
728
	cfg80211_rdev_free_coalesce(rdev);
729 730 731
}
EXPORT_SYMBOL(wiphy_unregister);

732
void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
733
{
734
	struct cfg80211_internal_bss *scan, *tmp;
735
	struct cfg80211_beacon_registration *reg, *treg;
736
	rfkill_destroy(rdev->rfkill);
737 738 739 740
	list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
		list_del(&reg->list);
		kfree(reg);
	}
741
	list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
742
		cfg80211_put_bss(&rdev->wiphy, &scan->pub);
743
	kfree(rdev);
744 745 746 747 748 749 750 751
}

void wiphy_free(struct wiphy *wiphy)
{
	put_device(&wiphy->dev);
}
EXPORT_SYMBOL(wiphy_free);

J
Johannes Berg 已提交
752 753
void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
{
754
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
755

756 757
	if (rfkill_set_hw_state(rdev->rfkill, blocked))
		schedule_work(&rdev->rfkill_sync);
J
Johannes Berg 已提交
758 759 760
}
EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);

761 762 763 764 765 766 767 768 769 770 771 772 773 774
void cfg80211_unregister_wdev(struct wireless_dev *wdev)
{
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);

	ASSERT_RTNL();

	if (WARN_ON(wdev->netdev))
		return;

	list_del_rcu(&wdev->list);
	rdev->devlist_generation++;

	switch (wdev->iftype) {
	case NL80211_IFTYPE_P2P_DEVICE:
775
		cfg80211_stop_p2p_device(rdev, wdev);
776 777 778 779 780 781 782 783
		break;
	default:
		WARN_ON_ONCE(1);
		break;
	}
}
EXPORT_SYMBOL(cfg80211_unregister_wdev);

J
Johannes Berg 已提交
784
static const struct device_type wiphy_type = {
785 786 787
	.name	= "wlan",
};

788 789 790
void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
			       enum nl80211_iftype iftype, int num)
{
791
	ASSERT_RTNL();
792 793 794 795 796 797

	rdev->num_running_ifaces += num;
	if (iftype == NL80211_IFTYPE_MONITOR)
		rdev->num_running_monitor_ifaces += num;
}

798
void cfg80211_leave(struct cfg80211_registered_device *rdev,
799
		    struct wireless_dev *wdev)
800 801 802
{
	struct net_device *dev = wdev->netdev;

803 804
	ASSERT_RTNL();

805 806 807 808 809 810
	switch (wdev->iftype) {
	case NL80211_IFTYPE_ADHOC:
		cfg80211_leave_ibss(rdev, dev, true);
		break;
	case NL80211_IFTYPE_P2P_CLIENT:
	case NL80211_IFTYPE_STATION:
811 812
		if (rdev->sched_scan_req && dev == rdev->sched_scan_req->dev)
			__cfg80211_stop_sched_scan(rdev, false);
813 814 815 816 817 818 819 820

		wdev_lock(wdev);
#ifdef CONFIG_CFG80211_WEXT
		kfree(wdev->wext.ie);
		wdev->wext.ie = NULL;
		wdev->wext.ie_len = 0;
		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
#endif
821 822
		cfg80211_disconnect(rdev, dev,
				    WLAN_REASON_DEAUTH_LEAVING, true);
823 824 825 826 827 828
		wdev_unlock(wdev);
		break;
	case NL80211_IFTYPE_MESH_POINT:
		cfg80211_leave_mesh(rdev, dev);
		break;
	case NL80211_IFTYPE_AP:
829
	case NL80211_IFTYPE_P2P_GO:
830
		cfg80211_stop_ap(rdev, dev, true);
831 832 833 834 835 836
		break;
	default:
		break;
	}
}

837
static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
838
					 unsigned long state, void *ptr)
839
{
840
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
841
	struct wireless_dev *wdev = dev->ieee80211_ptr;
842
	struct cfg80211_registered_device *rdev;
843
	int ret;
844

845
	if (!wdev)
J
Johannes Berg 已提交
846
		return NOTIFY_DONE;
847

848
	rdev = wiphy_to_dev(wdev->wiphy);
849

850
	WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
J
Johannes Berg 已提交
851

852
	switch (state) {
853 854 855
	case NETDEV_POST_INIT:
		SET_NETDEV_DEVTYPE(dev, &wiphy_type);
		break;
856
	case NETDEV_REGISTER:
J
Johannes Berg 已提交
857 858 859 860 861
		/*
		 * NB: cannot take rdev->mtx here because this may be
		 * called within code protected by it when interfaces
		 * are added with nl80211.
		 */
J
Johannes Berg 已提交
862 863 864
		mutex_init(&wdev->mtx);
		INIT_LIST_HEAD(&wdev->event_list);
		spin_lock_init(&wdev->event_lock);
865 866
		INIT_LIST_HEAD(&wdev->mgmt_registrations);
		spin_lock_init(&wdev->mgmt_registrations_lock);
867

868 869
		wdev->identifier = ++rdev->wdev_id;
		list_add_rcu(&wdev->list, &rdev->wdev_list);
870
		rdev->devlist_generation++;
871 872 873
		/* can only change netns with wiphy */
		dev->features |= NETIF_F_NETNS_LOCAL;

874 875
		if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
				      "phy80211")) {
876
			pr_err("failed to add phy80211 symlink to netdev!\n");
877
		}
878
		wdev->netdev = dev;
J
Johannes Berg 已提交
879
#ifdef CONFIG_CFG80211_WEXT
880 881
		wdev->wext.default_key = -1;
		wdev->wext.default_mgmt_key = -1;
882
		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
K
Kalle Valo 已提交
883 884
#endif

J
Johannes Berg 已提交
885
		if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
K
Kalle Valo 已提交
886
			wdev->ps = true;
J
Johannes Berg 已提交
887
		else
K
Kalle Valo 已提交
888
			wdev->ps = false;
889 890
		/* allow mac80211 to determine the timeout */
		wdev->ps_timeout = -1;
K
Kalle Valo 已提交
891

892
		netdev_set_default_ethtool_ops(dev, &cfg80211_ethtool_ops);
893 894

		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
895
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
896 897
		     wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
			dev->priv_flags |= IFF_DONT_BRIDGE;
898
		break;
J
Johannes Berg 已提交
899
	case NETDEV_GOING_DOWN:
900
		cfg80211_leave(rdev, wdev);
901 902
		break;
	case NETDEV_DOWN:
903
		cfg80211_update_iface_num(rdev, wdev->iftype, -1);
J
Johannes Berg 已提交
904 905 906
		if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
			if (WARN_ON(!rdev->scan_req->notified))
				rdev->scan_req->aborted = true;
907
			___cfg80211_scan_done(rdev, false);
J
Johannes Berg 已提交
908
		}
909 910 911 912 913 914 915 916

		if (WARN_ON(rdev->sched_scan_req &&
			    rdev->sched_scan_req->dev == wdev->netdev)) {
			__cfg80211_stop_sched_scan(rdev, false);
		}

		rdev->opencount--;
		wake_up(&rdev->dev_wait);
J
Johannes Berg 已提交
917 918
		break;
	case NETDEV_UP:
919
		cfg80211_update_iface_num(rdev, wdev->iftype, 1);
J
Johannes Berg 已提交
920
		wdev_lock(wdev);
921
		switch (wdev->iftype) {
922
#ifdef CONFIG_CFG80211_WEXT
923
		case NL80211_IFTYPE_ADHOC:
J
Johannes Berg 已提交
924
			cfg80211_ibss_wext_join(rdev, wdev);
J
Johannes Berg 已提交
925
			break;
926
		case NL80211_IFTYPE_STATION:
J
Johannes Berg 已提交
927
			cfg80211_mgd_wext_connect(rdev, wdev);
928
			break;
929
#endif
930
#ifdef CONFIG_MAC80211_MESH
931
		case NL80211_IFTYPE_MESH_POINT:
932 933 934 935 936 937 938 939 940 941 942 943 944 945 946
			{
				/* backward compat code... */
				struct mesh_setup setup;
				memcpy(&setup, &default_mesh_setup,
						sizeof(setup));
				 /* back compat only needed for mesh_id */
				setup.mesh_id = wdev->ssid;
				setup.mesh_id_len = wdev->mesh_id_up_len;
				if (wdev->mesh_id_up_len)
					__cfg80211_join_mesh(rdev, dev,
							&setup,
							&default_mesh_config);
				break;
			}
#endif
947
		default:
J
Johannes Berg 已提交
948
			break;
949
		}
J
Johannes Berg 已提交
950
		wdev_unlock(wdev);
951
		rdev->opencount++;
952 953 954 955 956

		/*
		 * Configure power management to the driver here so that its
		 * correctly set also after interface type changes etc.
		 */
957 958
		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
959
		    rdev->ops->set_power_mgmt)
960 961
			if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
						wdev->ps_timeout)) {
962 963 964
				/* assume this means it's off */
				wdev->ps = false;
			}
965
		break;
966
	case NETDEV_UNREGISTER:
967 968 969 970 971 972 973
		/*
		 * It is possible to get NETDEV_UNREGISTER
		 * multiple times. To detect that, check
		 * that the interface is still on the list
		 * of registered interfaces, and only then
		 * remove and clean it up.
		 */
974
		if (!list_empty(&wdev->list)) {
975
			sysfs_remove_link(&dev->dev.kobj, "phy80211");
J
Johannes Berg 已提交
976
			list_del_rcu(&wdev->list);
977
			rdev->devlist_generation++;
978
			cfg80211_mlme_purge_registrations(wdev);
J
Johannes Berg 已提交
979
#ifdef CONFIG_CFG80211_WEXT
980
			kfree(wdev->wext.keys);
J
Johannes Berg 已提交
981
#endif
982
		}
J
Johannes Berg 已提交
983 984 985 986 987 988 989 990
		/*
		 * synchronise (so that we won't find this netdev
		 * from other code any more) and then clear the list
		 * head so that the above code can safely check for
		 * !list_empty() to avoid double-cleanup.
		 */
		synchronize_rcu();
		INIT_LIST_HEAD(&wdev->list);
991 992 993 994 995
		/*
		 * Ensure that all events have been processed and
		 * freed.
		 */
		cfg80211_process_wdev_events(wdev);
996 997 998 999 1000 1001

		if (WARN_ON(wdev->current_bss)) {
			cfg80211_unhold_bss(wdev->current_bss);
			cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
			wdev->current_bss = NULL;
		}
1002
		break;
J
Johannes Berg 已提交
1003
	case NETDEV_PRE_UP:
1004 1005
		if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
			return notifier_from_errno(-EOPNOTSUPP);
1006 1007 1008
		ret = cfg80211_can_add_interface(rdev, wdev->iftype);
		if (ret)
			return notifier_from_errno(ret);
J
Johannes Berg 已提交
1009
		break;
1010 1011
	}

J
Johannes Berg 已提交
1012
	return NOTIFY_DONE;
1013 1014 1015 1016 1017 1018
}

static struct notifier_block cfg80211_netdev_notifier = {
	.notifier_call = cfg80211_netdev_notifier_call,
};

1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
static void __net_exit cfg80211_pernet_exit(struct net *net)
{
	struct cfg80211_registered_device *rdev;

	rtnl_lock();
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (net_eq(wiphy_net(&rdev->wiphy), net))
			WARN_ON(cfg80211_switch_netns(rdev, &init_net));
	}
	rtnl_unlock();
}

static struct pernet_operations cfg80211_pernet_ops = {
	.exit = cfg80211_pernet_exit,
};

static int __init cfg80211_init(void)
1036
{
1037 1038
	int err;

1039 1040 1041 1042
	err = register_pernet_device(&cfg80211_pernet_ops);
	if (err)
		goto out_fail_pernet;

1043
	err = wiphy_sysfs_init();
1044 1045 1046 1047 1048 1049 1050
	if (err)
		goto out_fail_sysfs;

	err = register_netdevice_notifier(&cfg80211_netdev_notifier);
	if (err)
		goto out_fail_notifier;

1051 1052 1053 1054
	err = nl80211_init();
	if (err)
		goto out_fail_nl80211;

1055 1056
	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);

1057 1058 1059 1060
	err = regulatory_init();
	if (err)
		goto out_fail_reg;

1061
	cfg80211_wq = create_singlethread_workqueue("cfg80211");
1062 1063
	if (!cfg80211_wq) {
		err = -ENOMEM;
1064
		goto out_fail_wq;
1065
	}
1066

1067 1068
	return 0;

1069 1070
out_fail_wq:
	regulatory_exit();
1071 1072
out_fail_reg:
	debugfs_remove(ieee80211_debugfs_dir);
1073 1074
out_fail_nl80211:
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1075 1076 1077
out_fail_notifier:
	wiphy_sysfs_exit();
out_fail_sysfs:
1078 1079
	unregister_pernet_device(&cfg80211_pernet_ops);
out_fail_pernet:
1080 1081
	return err;
}
1082
subsys_initcall(cfg80211_init);
1083

1084
static void __exit cfg80211_exit(void)
1085 1086
{
	debugfs_remove(ieee80211_debugfs_dir);
1087
	nl80211_exit();
1088 1089
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	wiphy_sysfs_exit();
1090
	regulatory_exit();
1091
	unregister_pernet_device(&cfg80211_pernet_ops);
1092
	destroy_workqueue(cfg80211_wq);
1093 1094
}
module_exit(cfg80211_exit);