core.c 27.2 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 37

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

MODULE_AUTHOR("Johannes Berg");
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("wireless configuration support");

J
Johannes Berg 已提交
38
/* RCU-protected (and cfg80211_mutex for writers) */
39
LIST_HEAD(cfg80211_rdev_list);
40
int cfg80211_rdev_list_generation;
41 42

DEFINE_MUTEX(cfg80211_mutex);
43 44 45 46

/* for debugfs */
static struct dentry *ieee80211_debugfs_dir;

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

50 51 52 53 54
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");

55
/* requires cfg80211_mutex to be held! */
56
struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
57
{
58
	struct cfg80211_registered_device *result = NULL, *rdev;
59

60 61 62
	if (!wiphy_idx_valid(wiphy_idx))
		return NULL;

63 64
	assert_cfg80211_lock();

65 66 67
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (rdev->wiphy_idx == wiphy_idx) {
			result = rdev;
68 69 70 71 72 73 74
			break;
		}
	}

	return result;
}

75 76
int get_wiphy_idx(struct wiphy *wiphy)
{
77
	struct cfg80211_registered_device *rdev;
78 79
	if (!wiphy)
		return WIPHY_IDX_STALE;
80 81
	rdev = wiphy_to_dev(wiphy);
	return rdev->wiphy_idx;
82 83
}

84
/* requires cfg80211_rdev_mutex to be held! */
85 86
struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
{
87
	struct cfg80211_registered_device *rdev;
88 89 90 91 92 93

	if (!wiphy_idx_valid(wiphy_idx))
		return NULL;

	assert_cfg80211_lock();

94 95
	rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
	if (!rdev)
96
		return NULL;
97
	return &rdev->wiphy;
98 99
}

100
struct cfg80211_registered_device *
101
cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
102
{
103
	struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
104 105
	struct net_device *dev;

106
	mutex_lock(&cfg80211_mutex);
107
	dev = dev_get_by_index(net, ifindex);
108 109 110
	if (!dev)
		goto out;
	if (dev->ieee80211_ptr) {
111 112
		rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
		mutex_lock(&rdev->mtx);
113
	} else
114
		rdev = ERR_PTR(-ENODEV);
115 116
	dev_put(dev);
 out:
117
	mutex_unlock(&cfg80211_mutex);
118
	return rdev;
119 120
}

121
/* requires cfg80211_mutex to be held */
122 123 124
int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
			char *newname)
{
125
	struct cfg80211_registered_device *rdev2;
126
	int wiphy_idx, taken = -1, result, digits;
127

128
	assert_cfg80211_lock();
129

130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
	/* 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;
	}


146 147
	/* Ignore nop renames */
	if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
148
		return 0;
149 150

	/* Ensure another device does not already have this name. */
151 152
	list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
		if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
153
			return -EINVAL;
154 155 156

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

159 160
	if (rdev->wiphy.debugfsdir &&
	    !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
161 162 163
			    rdev->wiphy.debugfsdir,
			    rdev->wiphy.debugfsdir->d_parent,
			    newname))
164
		pr_err("failed to rename debugfs dir to %s!\n", newname);
165

166
	nl80211_notify_dev_rename(rdev);
167

168
	return 0;
169 170
}

171 172 173 174 175 176
int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
			  struct net *net)
{
	struct wireless_dev *wdev;
	int err = 0;

J
Johannes Berg 已提交
177
	if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
178 179
		return -EOPNOTSUPP;

180
	list_for_each_entry(wdev, &rdev->wdev_list, list) {
181 182
		if (!wdev->netdev)
			continue;
183 184 185 186 187 188 189 190 191 192 193
		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);

194
		list_for_each_entry_continue_reverse(wdev, &rdev->wdev_list,
195
						     list) {
196 197
			if (!wdev->netdev)
				continue;
198 199 200 201 202 203
			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;
		}
204 205

		return err;
206 207 208 209
	}

	wiphy_net_set(&rdev->wiphy, net);

210 211 212 213
	err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
	WARN_ON(err);

	return 0;
214 215
}

J
Johannes Berg 已提交
216 217
static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
{
218
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
219

220
	rdev_rfkill_poll(rdev);
J
Johannes Berg 已提交
221 222 223 224
}

static int cfg80211_rfkill_set_block(void *data, bool blocked)
{
225
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
226 227 228 229 230 231
	struct wireless_dev *wdev;

	if (!blocked)
		return 0;

	rtnl_lock();
232
	mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
233

234 235
	list_for_each_entry(wdev, &rdev->wdev_list, list) {
		if (wdev->netdev) {
236
			dev_close(wdev->netdev);
237 238 239 240 241 242 243
			continue;
		}
		/* otherwise, check iftype */
		switch (wdev->iftype) {
		case NL80211_IFTYPE_P2P_DEVICE:
			if (!wdev->p2p_started)
				break;
244
			rdev_stop_p2p_device(rdev, wdev);
245 246 247 248 249 250 251
			wdev->p2p_started = false;
			rdev->opencount--;
			break;
		default:
			break;
		}
	}
J
Johannes Berg 已提交
252

253
	mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
254 255 256 257 258 259 260
	rtnl_unlock();

	return 0;
}

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

263 264
	rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
	cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
J
Johannes Berg 已提交
265 266
}

J
Johannes Berg 已提交
267 268 269 270 271 272 273 274 275 276
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();
	cfg80211_lock_rdev(rdev);

277
	cfg80211_process_rdev_events(rdev);
J
Johannes Berg 已提交
278 279 280 281
	cfg80211_unlock_rdev(rdev);
	rtnl_unlock();
}

282 283
/* exported functions */

284
struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
285
{
286
	static int wiphy_counter;
287 288

	struct cfg80211_registered_device *rdev;
289 290
	int alloc_size;

291 292 293 294 295 296 297
	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);
298
	WARN_ON(ops->join_mesh && !ops->leave_mesh);
299

300
	alloc_size = sizeof(*rdev) + sizeof_priv;
301

302 303
	rdev = kzalloc(alloc_size, GFP_KERNEL);
	if (!rdev)
304 305
		return NULL;

306
	rdev->ops = ops;
307

308
	mutex_lock(&cfg80211_mutex);
309

310
	rdev->wiphy_idx = wiphy_counter++;
311

312
	if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
313
		wiphy_counter--;
314
		mutex_unlock(&cfg80211_mutex);
315
		/* ugh, wrapped! */
316
		kfree(rdev);
317 318 319
		return NULL;
	}

320
	mutex_unlock(&cfg80211_mutex);
321

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

325 326
	mutex_init(&rdev->mtx);
	mutex_init(&rdev->devlist_mtx);
327
	mutex_init(&rdev->sched_scan_mtx);
328
	INIT_LIST_HEAD(&rdev->wdev_list);
329 330
	INIT_LIST_HEAD(&rdev->beacon_registrations);
	spin_lock_init(&rdev->beacon_registrations_lock);
331 332 333
	spin_lock_init(&rdev->bss_lock);
	INIT_LIST_HEAD(&rdev->bss_list);
	INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
334
	INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
J
Johannes Berg 已提交
335 336 337 338
#ifdef CONFIG_CFG80211_WEXT
	rdev->wiphy.wext = &cfg80211_wext_handler;
#endif

339 340 341 342
	device_initialize(&rdev->wiphy.dev);
	rdev->wiphy.dev.class = &ieee80211_class;
	rdev->wiphy.dev.platform_data = rdev;

J
Johannes Berg 已提交
343 344 345
#ifdef CONFIG_CFG80211_DEFAULT_PS
	rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
#endif
346

347 348
	wiphy_net_set(&rdev->wiphy, &init_net);

349 350 351 352 353 354 355
	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 已提交
356 357 358
		return NULL;
	}

359 360 361
	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 已提交
362

363 364
	init_waitqueue_head(&rdev->dev_wait);

365 366 367 368 369
	/*
	 * Initialize wiphy parameters to IEEE 802.11 MIB default values.
	 * Fragmentation and RTS threshold are disabled by default with the
	 * special -1 value.
	 */
370 371 372 373
	rdev->wiphy.retry_short = 7;
	rdev->wiphy.retry_long = 4;
	rdev->wiphy.frag_threshold = (u32) -1;
	rdev->wiphy.rts_threshold = (u32) -1;
374
	rdev->wiphy.coverage_class = 0;
375

376 377
	rdev->wiphy.features = NL80211_FEATURE_SCAN_FLUSH;

378
	return &rdev->wiphy;
379 380 381
}
EXPORT_SYMBOL(wiphy_new);

382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400
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];

		/* Combinations with just one interface aren't real */
		if (WARN_ON(c->max_interfaces < 2))
			return -EINVAL;

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

401 402 403 404 405 406 407 408
		/*
		 * 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;

409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429
		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;

430 431 432 433 434
			/* Only a single P2P_DEVICE can be allowed */
			if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
				    c->limits[j].max > 1))
				return -EINVAL;

435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
			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;
}

452 453
int wiphy_register(struct wiphy *wiphy)
{
454
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
455
	int res;
456 457 458 459
	enum ieee80211_band band;
	struct ieee80211_supported_band *sband;
	bool have_band = false;
	int i;
460 461
	u16 ifmodes = wiphy->interface_modes;

462
#ifdef CONFIG_PM
463 464 465
	if (WARN_ON((wiphy->wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
		    !(wiphy->wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
		return -EINVAL;
466
#endif
467

J
Johannes Berg 已提交
468 469 470 471
	if (WARN_ON(wiphy->ap_sme_capa &&
		    !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
		return -EINVAL;

472 473 474 475 476 477 478 479 480 481 482 483
	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;

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

484 485
	/* sanity check ifmodes */
	WARN_ON(!ifmodes);
486
	ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
487 488
	if (WARN_ON(ifmodes != wiphy->interface_modes))
		wiphy->interface_modes = ifmodes;
489

490 491 492 493
	res = wiphy_verify_combinations(wiphy);
	if (res)
		return res;

494 495 496 497 498 499 500
	/* sanity check supported bands/channels */
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		sband = wiphy->bands[band];
		if (!sband)
			continue;

		sband->band = band;
501 502 503 504 505 506 507 508
		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))
509 510
			return -EINVAL;

511 512 513 514 515 516 517 518 519 520 521 522
		/*
		 * 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;
		}

523 524 525 526 527 528
		/*
		 * 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))
529 530 531 532 533
			return -EINVAL;

		for (i = 0; i < sband->n_channels; i++) {
			sband->channels[i].orig_flags =
				sband->channels[i].flags;
534
			sband->channels[i].orig_mag = INT_MAX;
535 536 537 538 539 540 541 542 543 544 545 546 547
			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;
	}

548
#ifdef CONFIG_PM
J
Johannes Berg 已提交
549 550 551 552 553 554
	if (rdev->wiphy.wowlan.n_patterns) {
		if (WARN_ON(!rdev->wiphy.wowlan.pattern_min_len ||
			    rdev->wiphy.wowlan.pattern_min_len >
			    rdev->wiphy.wowlan.pattern_max_len))
			return -EINVAL;
	}
555
#endif
J
Johannes Berg 已提交
556

557 558 559
	/* check and set up bitrates */
	ieee80211_set_bitrate_flags(wiphy);

560 561
	mutex_lock(&cfg80211_mutex);

562
	res = device_add(&rdev->wiphy.dev);
563 564 565 566
	if (res) {
		mutex_unlock(&cfg80211_mutex);
		return res;
	}
J
Johannes Berg 已提交
567

568
	/* set up regulatory info */
569
	wiphy_regulatory_register(wiphy);
570

J
Johannes Berg 已提交
571
	list_add_rcu(&rdev->list, &cfg80211_rdev_list);
572
	cfg80211_rdev_list_generation++;
573 574

	/* add to debugfs */
575 576
	rdev->wiphy.debugfsdir =
		debugfs_create_dir(wiphy_name(&rdev->wiphy),
577
				   ieee80211_debugfs_dir);
578 579
	if (IS_ERR(rdev->wiphy.debugfsdir))
		rdev->wiphy.debugfsdir = NULL;
580

J
Johannes Berg 已提交
581
	if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
582 583 584 585 586 587 588 589 590 591
		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);
	}

592
	cfg80211_debugfs_rdev_add(rdev);
593
	mutex_unlock(&cfg80211_mutex);
594

595 596 597 598 599 600 601 602
	/*
	 * due to a locking dependency this has to be outside of the
	 * cfg80211_mutex lock
	 */
	res = rfkill_register(rdev->rfkill);
	if (res)
		goto out_rm_dev;

603 604 605
	rtnl_lock();
	rdev->wiphy.registered = true;
	rtnl_unlock();
606
	return 0;
J
Johannes Berg 已提交
607

608
out_rm_dev:
609
	device_del(&rdev->wiphy.dev);
610 611 612 613
	return res;
}
EXPORT_SYMBOL(wiphy_register);

J
Johannes Berg 已提交
614 615
void wiphy_rfkill_start_polling(struct wiphy *wiphy)
{
616
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
617

618
	if (!rdev->ops->rfkill_poll)
J
Johannes Berg 已提交
619
		return;
620 621
	rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
	rfkill_resume_polling(rdev->rfkill);
J
Johannes Berg 已提交
622 623 624 625 626
}
EXPORT_SYMBOL(wiphy_rfkill_start_polling);

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

629
	rfkill_pause_polling(rdev->rfkill);
J
Johannes Berg 已提交
630 631 632
}
EXPORT_SYMBOL(wiphy_rfkill_stop_polling);

633 634
void wiphy_unregister(struct wiphy *wiphy)
{
635
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
636

637 638 639 640
	rtnl_lock();
	rdev->wiphy.registered = false;
	rtnl_unlock();

641
	rfkill_unregister(rdev->rfkill);
J
Johannes Berg 已提交
642

643
	/* protect the device list */
644
	mutex_lock(&cfg80211_mutex);
645

646 647 648 649 650
	wait_event(rdev->dev_wait, ({
		int __count;
		mutex_lock(&rdev->devlist_mtx);
		__count = rdev->opencount;
		mutex_unlock(&rdev->devlist_mtx);
651
		__count == 0; }));
652 653

	mutex_lock(&rdev->devlist_mtx);
654
	BUG_ON(!list_empty(&rdev->wdev_list));
655 656 657 658 659 660
	mutex_unlock(&rdev->devlist_mtx);

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

	/*
666
	 * Try to grab rdev->mtx. If a command is still in progress,
667 668 669 670
	 * hopefully the driver will refuse it since it's tearing
	 * down the device already. We wait for this command to complete
	 * before unlinking the item from the list.
	 * Note: as codified by the BUG_ON above we cannot get here if
671 672 673
	 * a virtual interface is still present. Hence, we can only get
	 * to lock contention here if userspace issues a command that
	 * identified the hardware by wiphy index.
674
	 */
J
Johannes Berg 已提交
675
	cfg80211_lock_rdev(rdev);
676
	/* nothing */
J
Johannes Berg 已提交
677
	cfg80211_unlock_rdev(rdev);
678

679 680 681 682 683
	/*
	 * 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);
684

685
	cfg80211_rdev_list_generation++;
686
	device_del(&rdev->wiphy.dev);
687

688
	mutex_unlock(&cfg80211_mutex);
J
Johannes Berg 已提交
689

690
	flush_work(&rdev->scan_done_wk);
J
Johannes Berg 已提交
691 692
	cancel_work_sync(&rdev->conn_work);
	flush_work(&rdev->event_work);
693 694

	if (rdev->wowlan && rdev->ops->set_wakeup)
695
		rdev_set_wakeup(rdev, false);
696
	cfg80211_rdev_free_wowlan(rdev);
697 698 699
}
EXPORT_SYMBOL(wiphy_unregister);

700
void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
701
{
702
	struct cfg80211_internal_bss *scan, *tmp;
703
	struct cfg80211_beacon_registration *reg, *treg;
704 705 706
	rfkill_destroy(rdev->rfkill);
	mutex_destroy(&rdev->mtx);
	mutex_destroy(&rdev->devlist_mtx);
707
	mutex_destroy(&rdev->sched_scan_mtx);
708 709 710 711
	list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
		list_del(&reg->list);
		kfree(reg);
	}
712
	list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
J
Johannes Berg 已提交
713
		cfg80211_put_bss(&scan->pub);
714
	kfree(rdev);
715 716 717 718 719 720 721 722
}

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

J
Johannes Berg 已提交
723 724
void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
{
725
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
726

727 728
	if (rfkill_set_hw_state(rdev->rfkill, blocked))
		schedule_work(&rdev->rfkill_sync);
J
Johannes Berg 已提交
729 730 731
}
EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);

732 733 734 735 736 737 738 739 740 741
static void wdev_cleanup_work(struct work_struct *work)
{
	struct wireless_dev *wdev;
	struct cfg80211_registered_device *rdev;

	wdev = container_of(work, struct wireless_dev, cleanup_work);
	rdev = wiphy_to_dev(wdev->wiphy);

	cfg80211_lock_rdev(rdev);

J
Johannes Berg 已提交
742
	if (WARN_ON(rdev->scan_req && rdev->scan_req->wdev == wdev)) {
743
		rdev->scan_req->aborted = true;
744
		___cfg80211_scan_done(rdev, true);
745 746
	}

747 748 749 750
	cfg80211_unlock_rdev(rdev);

	mutex_lock(&rdev->sched_scan_mtx);

751 752 753 754 755
	if (WARN_ON(rdev->sched_scan_req &&
		    rdev->sched_scan_req->dev == wdev->netdev)) {
		__cfg80211_stop_sched_scan(rdev, false);
	}

756
	mutex_unlock(&rdev->sched_scan_mtx);
757 758 759 760 761 762 763 764 765

	mutex_lock(&rdev->devlist_mtx);
	rdev->opencount--;
	mutex_unlock(&rdev->devlist_mtx);
	wake_up(&rdev->dev_wait);

	dev_put(wdev->netdev);
}

766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782
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;

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

	switch (wdev->iftype) {
	case NL80211_IFTYPE_P2P_DEVICE:
		if (!wdev->p2p_started)
			break;
783
		rdev_stop_p2p_device(rdev, wdev);
784 785 786 787 788 789 790 791 792 793 794
		wdev->p2p_started = false;
		rdev->opencount--;
		break;
	default:
		WARN_ON_ONCE(1);
		break;
	}
	mutex_unlock(&rdev->devlist_mtx);
}
EXPORT_SYMBOL(cfg80211_unregister_wdev);

795 796 797 798
static struct device_type wiphy_type = {
	.name	= "wlan",
};

799 800 801
void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
			       enum nl80211_iftype iftype, int num)
{
802
	ASSERT_RTNL();
803 804 805 806 807 808

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

809
static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
810 811 812 813
					 unsigned long state,
					 void *ndev)
{
	struct net_device *dev = ndev;
814
	struct wireless_dev *wdev = dev->ieee80211_ptr;
815
	struct cfg80211_registered_device *rdev;
816
	int ret;
817

818
	if (!wdev)
J
Johannes Berg 已提交
819
		return NOTIFY_DONE;
820

821
	rdev = wiphy_to_dev(wdev->wiphy);
822

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

825
	switch (state) {
826 827 828
	case NETDEV_POST_INIT:
		SET_NETDEV_DEVTYPE(dev, &wiphy_type);
		break;
829
	case NETDEV_REGISTER:
J
Johannes Berg 已提交
830 831 832 833 834
		/*
		 * 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 已提交
835
		mutex_init(&wdev->mtx);
836
		INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
J
Johannes Berg 已提交
837 838
		INIT_LIST_HEAD(&wdev->event_list);
		spin_lock_init(&wdev->event_lock);
839 840
		INIT_LIST_HEAD(&wdev->mgmt_registrations);
		spin_lock_init(&wdev->mgmt_registrations_lock);
841

842
		mutex_lock(&rdev->devlist_mtx);
843 844
		wdev->identifier = ++rdev->wdev_id;
		list_add_rcu(&wdev->list, &rdev->wdev_list);
845
		rdev->devlist_generation++;
846 847 848
		/* can only change netns with wiphy */
		dev->features |= NETIF_F_NETNS_LOCAL;

849 850
		if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
				      "phy80211")) {
851
			pr_err("failed to add phy80211 symlink to netdev!\n");
852
		}
853
		wdev->netdev = dev;
S
Samuel Ortiz 已提交
854
		wdev->sme_state = CFG80211_SME_IDLE;
J
Johannes Berg 已提交
855
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
856
#ifdef CONFIG_CFG80211_WEXT
857 858
		wdev->wext.default_key = -1;
		wdev->wext.default_mgmt_key = -1;
859
		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
K
Kalle Valo 已提交
860 861
#endif

J
Johannes Berg 已提交
862
		if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
K
Kalle Valo 已提交
863
			wdev->ps = true;
J
Johannes Berg 已提交
864
		else
K
Kalle Valo 已提交
865
			wdev->ps = false;
866 867
		/* allow mac80211 to determine the timeout */
		wdev->ps_timeout = -1;
K
Kalle Valo 已提交
868

869 870
		if (!dev->ethtool_ops)
			dev->ethtool_ops = &cfg80211_ethtool_ops;
871 872

		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
873
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
874 875
		     wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
			dev->priv_flags |= IFF_DONT_BRIDGE;
876
		break;
J
Johannes Berg 已提交
877
	case NETDEV_GOING_DOWN:
S
Samuel Ortiz 已提交
878 879 880 881
		switch (wdev->iftype) {
		case NL80211_IFTYPE_ADHOC:
			cfg80211_leave_ibss(rdev, dev, true);
			break;
882
		case NL80211_IFTYPE_P2P_CLIENT:
S
Samuel Ortiz 已提交
883
		case NL80211_IFTYPE_STATION:
884
			mutex_lock(&rdev->sched_scan_mtx);
885
			__cfg80211_stop_sched_scan(rdev, false);
886
			mutex_unlock(&rdev->sched_scan_mtx);
887

J
Johannes Berg 已提交
888
			wdev_lock(wdev);
J
Johannes Berg 已提交
889
#ifdef CONFIG_CFG80211_WEXT
890 891 892
			kfree(wdev->wext.ie);
			wdev->wext.ie = NULL;
			wdev->wext.ie_len = 0;
J
Johannes Berg 已提交
893
			wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
894
#endif
J
Johannes Berg 已提交
895 896
			__cfg80211_disconnect(rdev, dev,
					      WLAN_REASON_DEAUTH_LEAVING, true);
J
Johannes Berg 已提交
897
			cfg80211_mlme_down(rdev, dev);
J
Johannes Berg 已提交
898
			wdev_unlock(wdev);
S
Samuel Ortiz 已提交
899
			break;
900 901 902
		case NL80211_IFTYPE_MESH_POINT:
			cfg80211_leave_mesh(rdev, dev);
			break;
903 904 905
		case NL80211_IFTYPE_AP:
			cfg80211_stop_ap(rdev, dev);
			break;
S
Samuel Ortiz 已提交
906 907 908
		default:
			break;
		}
909
		wdev->beacon_interval = 0;
910 911
		break;
	case NETDEV_DOWN:
912
		cfg80211_update_iface_num(rdev, wdev->iftype, -1);
913
		dev_hold(dev);
914
		queue_work(cfg80211_wq, &wdev->cleanup_work);
J
Johannes Berg 已提交
915 916
		break;
	case NETDEV_UP:
917 918 919 920 921 922 923 924 925 926 927 928
		/*
		 * If we have a really quick DOWN/UP succession we may
		 * have this work still pending ... cancel it and see
		 * if it was pending, in which case we need to account
		 * for some of the work it would have done.
		 */
		if (cancel_work_sync(&wdev->cleanup_work)) {
			mutex_lock(&rdev->devlist_mtx);
			rdev->opencount--;
			mutex_unlock(&rdev->devlist_mtx);
			dev_put(dev);
		}
929
		cfg80211_update_iface_num(rdev, wdev->iftype, 1);
J
Johannes Berg 已提交
930
		cfg80211_lock_rdev(rdev);
931
		mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
932
		wdev_lock(wdev);
933
		switch (wdev->iftype) {
934
#ifdef CONFIG_CFG80211_WEXT
935
		case NL80211_IFTYPE_ADHOC:
J
Johannes Berg 已提交
936
			cfg80211_ibss_wext_join(rdev, wdev);
J
Johannes Berg 已提交
937
			break;
938
		case NL80211_IFTYPE_STATION:
J
Johannes Berg 已提交
939
			cfg80211_mgd_wext_connect(rdev, wdev);
940
			break;
941
#endif
942
#ifdef CONFIG_MAC80211_MESH
943
		case NL80211_IFTYPE_MESH_POINT:
944 945 946 947 948 949 950 951 952 953 954 955 956 957 958
			{
				/* 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
959
		default:
J
Johannes Berg 已提交
960
			break;
961
		}
J
Johannes Berg 已提交
962
		wdev_unlock(wdev);
963
		rdev->opencount++;
964
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
965
		cfg80211_unlock_rdev(rdev);
966 967 968 969 970

		/*
		 * Configure power management to the driver here so that its
		 * correctly set also after interface type changes etc.
		 */
971 972
		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
973
		    rdev->ops->set_power_mgmt)
974 975
			if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
						wdev->ps_timeout)) {
976 977 978
				/* assume this means it's off */
				wdev->ps = false;
			}
979
		break;
980
	case NETDEV_UNREGISTER:
J
Johannes Berg 已提交
981 982 983 984 985
		/*
		 * NB: cannot take rdev->mtx here because this may be
		 * called within code protected by it when interfaces
		 * are removed with nl80211.
		 */
986
		mutex_lock(&rdev->devlist_mtx);
987 988 989 990 991 992 993
		/*
		 * 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.
		 */
994
		if (!list_empty(&wdev->list)) {
995
			sysfs_remove_link(&dev->dev.kobj, "phy80211");
J
Johannes Berg 已提交
996
			list_del_rcu(&wdev->list);
997
			rdev->devlist_generation++;
998
			cfg80211_mlme_purge_registrations(wdev);
J
Johannes Berg 已提交
999
#ifdef CONFIG_CFG80211_WEXT
1000
			kfree(wdev->wext.keys);
J
Johannes Berg 已提交
1001
#endif
1002 1003
		}
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
1004 1005 1006 1007 1008 1009 1010 1011
		/*
		 * 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);
1012 1013 1014 1015 1016
		/*
		 * Ensure that all events have been processed and
		 * freed.
		 */
		cfg80211_process_wdev_events(wdev);
1017
		break;
J
Johannes Berg 已提交
1018
	case NETDEV_PRE_UP:
1019 1020
		if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
			return notifier_from_errno(-EOPNOTSUPP);
J
Johannes Berg 已提交
1021 1022
		if (rfkill_blocked(rdev->rfkill))
			return notifier_from_errno(-ERFKILL);
1023
		mutex_lock(&rdev->devlist_mtx);
1024
		ret = cfg80211_can_add_interface(rdev, wdev->iftype);
1025
		mutex_unlock(&rdev->devlist_mtx);
1026 1027
		if (ret)
			return notifier_from_errno(ret);
J
Johannes Berg 已提交
1028
		break;
1029 1030
	}

J
Johannes Berg 已提交
1031
	return NOTIFY_DONE;
1032 1033 1034 1035 1036 1037
}

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

1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056
static void __net_exit cfg80211_pernet_exit(struct net *net)
{
	struct cfg80211_registered_device *rdev;

	rtnl_lock();
	mutex_lock(&cfg80211_mutex);
	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));
	}
	mutex_unlock(&cfg80211_mutex);
	rtnl_unlock();
}

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

static int __init cfg80211_init(void)
1057
{
1058 1059
	int err;

1060 1061 1062 1063
	err = register_pernet_device(&cfg80211_pernet_ops);
	if (err)
		goto out_fail_pernet;

1064
	err = wiphy_sysfs_init();
1065 1066 1067 1068 1069 1070 1071
	if (err)
		goto out_fail_sysfs;

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

1072 1073 1074 1075
	err = nl80211_init();
	if (err)
		goto out_fail_nl80211;

1076 1077
	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);

1078 1079 1080 1081
	err = regulatory_init();
	if (err)
		goto out_fail_reg;

1082 1083 1084 1085
	cfg80211_wq = create_singlethread_workqueue("cfg80211");
	if (!cfg80211_wq)
		goto out_fail_wq;

1086 1087
	return 0;

1088 1089
out_fail_wq:
	regulatory_exit();
1090 1091
out_fail_reg:
	debugfs_remove(ieee80211_debugfs_dir);
1092 1093
out_fail_nl80211:
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1094 1095 1096
out_fail_notifier:
	wiphy_sysfs_exit();
out_fail_sysfs:
1097 1098
	unregister_pernet_device(&cfg80211_pernet_ops);
out_fail_pernet:
1099 1100
	return err;
}
1101
subsys_initcall(cfg80211_init);
1102

1103
static void __exit cfg80211_exit(void)
1104 1105
{
	debugfs_remove(ieee80211_debugfs_dir);
1106
	nl80211_exit();
1107 1108
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	wiphy_sysfs_exit();
1109
	regulatory_exit();
1110
	unregister_pernet_device(&cfg80211_pernet_ops);
1111
	destroy_workqueue(cfg80211_wq);
1112 1113
}
module_exit(cfg80211_exit);