core.c 26.5 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 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");

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

DEFINE_MUTEX(cfg80211_mutex);
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
/* requires cfg80211_mutex to be held! */
55
struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
56
{
57
	struct cfg80211_registered_device *result = NULL, *rdev;
58

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

62 63
	assert_cfg80211_lock();

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

	return result;
}

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

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

	if (!wiphy_idx_valid(wiphy_idx))
		return NULL;

	assert_cfg80211_lock();

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

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

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

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

127
	assert_cfg80211_lock();
128

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


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

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

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

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

165
	nl80211_notify_dev_rename(rdev);
166

167
	return 0;
168 169
}

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

J
Johannes Berg 已提交
176
	if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
		return -EOPNOTSUPP;

	list_for_each_entry(wdev, &rdev->netdev_list, list) {
		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);

		list_for_each_entry_continue_reverse(wdev, &rdev->netdev_list,
						     list) {
			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;
		}
199 200

		return err;
201 202 203 204
	}

	wiphy_net_set(&rdev->wiphy, net);

205 206 207 208
	err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
	WARN_ON(err);

	return 0;
209 210
}

J
Johannes Berg 已提交
211 212
static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
{
213
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
214

215
	rdev->ops->rfkill_poll(&rdev->wiphy);
J
Johannes Berg 已提交
216 217 218 219
}

static int cfg80211_rfkill_set_block(void *data, bool blocked)
{
220
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
221 222 223 224 225 226
	struct wireless_dev *wdev;

	if (!blocked)
		return 0;

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

229
	list_for_each_entry(wdev, &rdev->netdev_list, list)
J
Johannes Berg 已提交
230 231
		dev_close(wdev->netdev);

232
	mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
233 234 235 236 237 238 239
	rtnl_unlock();

	return 0;
}

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

242 243
	rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
	cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
J
Johannes Berg 已提交
244 245
}

J
Johannes Berg 已提交
246 247 248 249 250 251 252 253 254 255
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);

256
	cfg80211_process_rdev_events(rdev);
J
Johannes Berg 已提交
257 258 259 260
	cfg80211_unlock_rdev(rdev);
	rtnl_unlock();
}

261 262
/* exported functions */

263
struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
264
{
265
	static int wiphy_counter;
266 267

	struct cfg80211_registered_device *rdev;
268 269
	int alloc_size;

270 271 272 273 274 275 276
	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);
277
	WARN_ON(ops->join_mesh && !ops->leave_mesh);
278

279
	alloc_size = sizeof(*rdev) + sizeof_priv;
280

281 282
	rdev = kzalloc(alloc_size, GFP_KERNEL);
	if (!rdev)
283 284
		return NULL;

285
	rdev->ops = ops;
286

287
	mutex_lock(&cfg80211_mutex);
288

289
	rdev->wiphy_idx = wiphy_counter++;
290

291
	if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
292
		wiphy_counter--;
293
		mutex_unlock(&cfg80211_mutex);
294
		/* ugh, wrapped! */
295
		kfree(rdev);
296 297 298
		return NULL;
	}

299
	mutex_unlock(&cfg80211_mutex);
300

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

304 305
	mutex_init(&rdev->mtx);
	mutex_init(&rdev->devlist_mtx);
306
	mutex_init(&rdev->sched_scan_mtx);
307 308 309 310
	INIT_LIST_HEAD(&rdev->netdev_list);
	spin_lock_init(&rdev->bss_lock);
	INIT_LIST_HEAD(&rdev->bss_list);
	INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
311
	INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
J
Johannes Berg 已提交
312 313 314 315
#ifdef CONFIG_CFG80211_WEXT
	rdev->wiphy.wext = &cfg80211_wext_handler;
#endif

316 317 318 319
	device_initialize(&rdev->wiphy.dev);
	rdev->wiphy.dev.class = &ieee80211_class;
	rdev->wiphy.dev.platform_data = rdev;

J
Johannes Berg 已提交
320 321 322
#ifdef CONFIG_CFG80211_DEFAULT_PS
	rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
#endif
323

324 325
	wiphy_net_set(&rdev->wiphy, &init_net);

326 327 328 329 330 331 332
	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 已提交
333 334 335
		return NULL;
	}

336 337 338
	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 已提交
339

340 341
	init_waitqueue_head(&rdev->dev_wait);

342 343 344 345 346
	/*
	 * Initialize wiphy parameters to IEEE 802.11 MIB default values.
	 * Fragmentation and RTS threshold are disabled by default with the
	 * special -1 value.
	 */
347 348 349 350
	rdev->wiphy.retry_short = 7;
	rdev->wiphy.retry_long = 4;
	rdev->wiphy.frag_threshold = (u32) -1;
	rdev->wiphy.rts_threshold = (u32) -1;
351
	rdev->wiphy.coverage_class = 0;
352

353
	return &rdev->wiphy;
354 355 356
}
EXPORT_SYMBOL(wiphy_new);

357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413
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;

		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;

			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;
}

414 415
int wiphy_register(struct wiphy *wiphy)
{
416
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
417
	int res;
418 419 420 421
	enum ieee80211_band band;
	struct ieee80211_supported_band *sband;
	bool have_band = false;
	int i;
422 423
	u16 ifmodes = wiphy->interface_modes;

424
#ifdef CONFIG_PM
425 426 427
	if (WARN_ON((wiphy->wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
		    !(wiphy->wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
		return -EINVAL;
428
#endif
429

J
Johannes Berg 已提交
430 431 432 433
	if (WARN_ON(wiphy->ap_sme_capa &&
		    !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
		return -EINVAL;

434 435 436 437 438 439 440 441 442 443 444 445
	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);

446 447
	/* sanity check ifmodes */
	WARN_ON(!ifmodes);
448
	ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
449 450
	if (WARN_ON(ifmodes != wiphy->interface_modes))
		wiphy->interface_modes = ifmodes;
451

452 453 454 455
	res = wiphy_verify_combinations(wiphy);
	if (res)
		return res;

456 457 458 459 460 461 462 463
	/* sanity check supported bands/channels */
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		sband = wiphy->bands[band];
		if (!sband)
			continue;

		sband->band = band;

464 465 466
		if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
			return -EINVAL;

467 468 469 470 471 472 473 474 475 476 477 478
		/*
		 * 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;
		}

479 480 481 482 483 484
		/*
		 * 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))
485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504
			return -EINVAL;

		for (i = 0; i < sband->n_channels; i++) {
			sband->channels[i].orig_flags =
				sband->channels[i].flags;
			sband->channels[i].orig_mag =
				sband->channels[i].max_antenna_gain;
			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;
	}

505
#ifdef CONFIG_PM
J
Johannes Berg 已提交
506 507 508 509 510 511
	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;
	}
512
#endif
J
Johannes Berg 已提交
513

514 515 516
	/* check and set up bitrates */
	ieee80211_set_bitrate_flags(wiphy);

517 518
	mutex_lock(&cfg80211_mutex);

519
	res = device_add(&rdev->wiphy.dev);
520 521 522 523
	if (res) {
		mutex_unlock(&cfg80211_mutex);
		return res;
	}
J
Johannes Berg 已提交
524

525
	/* set up regulatory info */
526
	regulatory_update(wiphy, NL80211_REGDOM_SET_BY_CORE);
527

J
Johannes Berg 已提交
528
	list_add_rcu(&rdev->list, &cfg80211_rdev_list);
529
	cfg80211_rdev_list_generation++;
530 531

	/* add to debugfs */
532 533
	rdev->wiphy.debugfsdir =
		debugfs_create_dir(wiphy_name(&rdev->wiphy),
534
				   ieee80211_debugfs_dir);
535 536
	if (IS_ERR(rdev->wiphy.debugfsdir))
		rdev->wiphy.debugfsdir = NULL;
537

J
Johannes Berg 已提交
538
	if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
539 540 541 542 543 544 545 546 547 548
		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);
	}

549
	cfg80211_debugfs_rdev_add(rdev);
550
	mutex_unlock(&cfg80211_mutex);
551

552 553 554 555 556 557 558 559
	/*
	 * 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;

560 561 562
	rtnl_lock();
	rdev->wiphy.registered = true;
	rtnl_unlock();
563
	return 0;
J
Johannes Berg 已提交
564

565
out_rm_dev:
566
	device_del(&rdev->wiphy.dev);
567 568 569 570
	return res;
}
EXPORT_SYMBOL(wiphy_register);

J
Johannes Berg 已提交
571 572
void wiphy_rfkill_start_polling(struct wiphy *wiphy)
{
573
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
574

575
	if (!rdev->ops->rfkill_poll)
J
Johannes Berg 已提交
576
		return;
577 578
	rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
	rfkill_resume_polling(rdev->rfkill);
J
Johannes Berg 已提交
579 580 581 582 583
}
EXPORT_SYMBOL(wiphy_rfkill_start_polling);

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

586
	rfkill_pause_polling(rdev->rfkill);
J
Johannes Berg 已提交
587 588 589
}
EXPORT_SYMBOL(wiphy_rfkill_stop_polling);

590 591
void wiphy_unregister(struct wiphy *wiphy)
{
592
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
593

594 595 596 597
	rtnl_lock();
	rdev->wiphy.registered = false;
	rtnl_unlock();

598
	rfkill_unregister(rdev->rfkill);
J
Johannes Berg 已提交
599

600
	/* protect the device list */
601
	mutex_lock(&cfg80211_mutex);
602

603 604 605 606 607
	wait_event(rdev->dev_wait, ({
		int __count;
		mutex_lock(&rdev->devlist_mtx);
		__count = rdev->opencount;
		mutex_unlock(&rdev->devlist_mtx);
608
		__count == 0; }));
609 610

	mutex_lock(&rdev->devlist_mtx);
611
	BUG_ON(!list_empty(&rdev->netdev_list));
612 613 614 615 616 617
	mutex_unlock(&rdev->devlist_mtx);

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

	/*
623
	 * Try to grab rdev->mtx. If a command is still in progress,
624 625 626 627
	 * 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
628 629 630
	 * 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.
631
	 */
J
Johannes Berg 已提交
632
	cfg80211_lock_rdev(rdev);
633
	/* nothing */
J
Johannes Berg 已提交
634
	cfg80211_unlock_rdev(rdev);
635

636 637 638 639
	/* If this device got a regulatory hint tell core its
	 * free to listen now to a new shiny device regulatory hint */
	reg_device_remove(wiphy);

640
	cfg80211_rdev_list_generation++;
641
	device_del(&rdev->wiphy.dev);
642

643
	mutex_unlock(&cfg80211_mutex);
J
Johannes Berg 已提交
644

645
	flush_work(&rdev->scan_done_wk);
J
Johannes Berg 已提交
646 647
	cancel_work_sync(&rdev->conn_work);
	flush_work(&rdev->event_work);
648 649 650 651

	if (rdev->wowlan && rdev->ops->set_wakeup)
		rdev->ops->set_wakeup(&rdev->wiphy, false);
	cfg80211_rdev_free_wowlan(rdev);
652 653 654
}
EXPORT_SYMBOL(wiphy_unregister);

655
void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
656
{
657
	struct cfg80211_internal_bss *scan, *tmp;
658 659 660
	rfkill_destroy(rdev->rfkill);
	mutex_destroy(&rdev->mtx);
	mutex_destroy(&rdev->devlist_mtx);
661
	mutex_destroy(&rdev->sched_scan_mtx);
662
	list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
J
Johannes Berg 已提交
663
		cfg80211_put_bss(&scan->pub);
664
	kfree(rdev);
665 666 667 668 669 670 671 672
}

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

J
Johannes Berg 已提交
673 674
void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
{
675
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
676

677 678
	if (rfkill_set_hw_state(rdev->rfkill, blocked))
		schedule_work(&rdev->rfkill_sync);
J
Johannes Berg 已提交
679 680 681
}
EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);

682 683 684 685 686 687 688 689 690 691 692 693
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);

	if (WARN_ON(rdev->scan_req && rdev->scan_req->dev == wdev->netdev)) {
		rdev->scan_req->aborted = true;
694
		___cfg80211_scan_done(rdev, true);
695 696
	}

697 698 699 700
	cfg80211_unlock_rdev(rdev);

	mutex_lock(&rdev->sched_scan_mtx);

701 702 703 704 705
	if (WARN_ON(rdev->sched_scan_req &&
		    rdev->sched_scan_req->dev == wdev->netdev)) {
		__cfg80211_stop_sched_scan(rdev, false);
	}

706
	mutex_unlock(&rdev->sched_scan_mtx);
707 708 709 710 711 712 713 714 715

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

	dev_put(wdev->netdev);
}

716 717 718 719
static struct device_type wiphy_type = {
	.name	= "wlan",
};

720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748
static struct ieee80211_channel *
cfg80211_get_any_chan(struct cfg80211_registered_device *rdev)
{
	struct ieee80211_supported_band *sband;
	int i;

	for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
		sband = rdev->wiphy.bands[i];
		if (sband && sband->n_channels > 0)
			return &sband->channels[0];
	}

	return NULL;
}

static void cfg80211_init_mon_chan(struct cfg80211_registered_device *rdev)
{
	struct ieee80211_channel *chan;

	chan = cfg80211_get_any_chan(rdev);
	if (WARN_ON(!chan))
		return;

	mutex_lock(&rdev->devlist_mtx);
	WARN_ON(cfg80211_set_monitor_channel(rdev, chan->center_freq,
					     NL80211_CHAN_NO_HT));
	mutex_unlock(&rdev->devlist_mtx);
}

749 750 751 752 753 754 755 756 757 758 759 760 761
void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
			       enum nl80211_iftype iftype, int num)
{
	bool has_monitors_only_old = cfg80211_has_monitors_only(rdev);
	bool has_monitors_only_new;

	ASSERT_RDEV_LOCK(rdev);

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

	has_monitors_only_new = cfg80211_has_monitors_only(rdev);
M
Michal Kazior 已提交
762
	if (has_monitors_only_new != has_monitors_only_old) {
763 764
		rdev->ops->set_monitor_enabled(&rdev->wiphy,
					       has_monitors_only_new);
M
Michal Kazior 已提交
765 766 767 768

		if (!has_monitors_only_new) {
			rdev->monitor_channel = NULL;
			rdev->monitor_channel_type = NL80211_CHAN_NO_HT;
769 770
		} else {
			cfg80211_init_mon_chan(rdev);
M
Michal Kazior 已提交
771 772
		}
	}
773 774
}

775
static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
776 777 778 779
					 unsigned long state,
					 void *ndev)
{
	struct net_device *dev = ndev;
780
	struct wireless_dev *wdev = dev->ieee80211_ptr;
781
	struct cfg80211_registered_device *rdev;
782
	int ret;
783

784
	if (!wdev)
J
Johannes Berg 已提交
785
		return NOTIFY_DONE;
786

787
	rdev = wiphy_to_dev(wdev->wiphy);
788

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

791
	switch (state) {
792 793 794
	case NETDEV_POST_INIT:
		SET_NETDEV_DEVTYPE(dev, &wiphy_type);
		break;
795
	case NETDEV_REGISTER:
J
Johannes Berg 已提交
796 797 798 799 800
		/*
		 * 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 已提交
801
		mutex_init(&wdev->mtx);
802
		INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
J
Johannes Berg 已提交
803 804
		INIT_LIST_HEAD(&wdev->event_list);
		spin_lock_init(&wdev->event_lock);
805 806
		INIT_LIST_HEAD(&wdev->mgmt_registrations);
		spin_lock_init(&wdev->mgmt_registrations_lock);
807

808
		mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
809
		list_add_rcu(&wdev->list, &rdev->netdev_list);
810
		rdev->devlist_generation++;
811 812 813
		/* can only change netns with wiphy */
		dev->features |= NETIF_F_NETNS_LOCAL;

814 815
		if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
				      "phy80211")) {
816
			pr_err("failed to add phy80211 symlink to netdev!\n");
817
		}
818
		wdev->netdev = dev;
S
Samuel Ortiz 已提交
819
		wdev->sme_state = CFG80211_SME_IDLE;
J
Johannes Berg 已提交
820
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
821
#ifdef CONFIG_CFG80211_WEXT
822 823
		wdev->wext.default_key = -1;
		wdev->wext.default_mgmt_key = -1;
824
		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
K
Kalle Valo 已提交
825 826
#endif

J
Johannes Berg 已提交
827
		if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
K
Kalle Valo 已提交
828
			wdev->ps = true;
J
Johannes Berg 已提交
829
		else
K
Kalle Valo 已提交
830
			wdev->ps = false;
831 832
		/* allow mac80211 to determine the timeout */
		wdev->ps_timeout = -1;
K
Kalle Valo 已提交
833

834 835
		if (!dev->ethtool_ops)
			dev->ethtool_ops = &cfg80211_ethtool_ops;
836 837

		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
838
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
839 840
		     wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
			dev->priv_flags |= IFF_DONT_BRIDGE;
841
		break;
J
Johannes Berg 已提交
842
	case NETDEV_GOING_DOWN:
S
Samuel Ortiz 已提交
843 844 845 846
		switch (wdev->iftype) {
		case NL80211_IFTYPE_ADHOC:
			cfg80211_leave_ibss(rdev, dev, true);
			break;
847
		case NL80211_IFTYPE_P2P_CLIENT:
S
Samuel Ortiz 已提交
848
		case NL80211_IFTYPE_STATION:
849
			mutex_lock(&rdev->sched_scan_mtx);
850
			__cfg80211_stop_sched_scan(rdev, false);
851
			mutex_unlock(&rdev->sched_scan_mtx);
852

J
Johannes Berg 已提交
853
			wdev_lock(wdev);
J
Johannes Berg 已提交
854
#ifdef CONFIG_CFG80211_WEXT
855 856 857
			kfree(wdev->wext.ie);
			wdev->wext.ie = NULL;
			wdev->wext.ie_len = 0;
J
Johannes Berg 已提交
858
			wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
859
#endif
J
Johannes Berg 已提交
860 861
			__cfg80211_disconnect(rdev, dev,
					      WLAN_REASON_DEAUTH_LEAVING, true);
J
Johannes Berg 已提交
862
			cfg80211_mlme_down(rdev, dev);
J
Johannes Berg 已提交
863
			wdev_unlock(wdev);
S
Samuel Ortiz 已提交
864
			break;
865 866 867
		case NL80211_IFTYPE_MESH_POINT:
			cfg80211_leave_mesh(rdev, dev);
			break;
868 869 870
		case NL80211_IFTYPE_AP:
			cfg80211_stop_ap(rdev, dev);
			break;
S
Samuel Ortiz 已提交
871 872 873
		default:
			break;
		}
874
		wdev->beacon_interval = 0;
875 876
		break;
	case NETDEV_DOWN:
877
		dev_hold(dev);
878 879 880
		cfg80211_lock_rdev(rdev);
		cfg80211_update_iface_num(rdev, wdev->iftype, -1);
		cfg80211_unlock_rdev(rdev);
881
		queue_work(cfg80211_wq, &wdev->cleanup_work);
J
Johannes Berg 已提交
882 883
		break;
	case NETDEV_UP:
884 885 886 887 888 889 890 891 892 893 894 895
		/*
		 * 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);
		}
J
Johannes Berg 已提交
896
		cfg80211_lock_rdev(rdev);
897
		mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
898
		wdev_lock(wdev);
899
		switch (wdev->iftype) {
900
#ifdef CONFIG_CFG80211_WEXT
901
		case NL80211_IFTYPE_ADHOC:
J
Johannes Berg 已提交
902
			cfg80211_ibss_wext_join(rdev, wdev);
J
Johannes Berg 已提交
903
			break;
904
		case NL80211_IFTYPE_STATION:
J
Johannes Berg 已提交
905
			cfg80211_mgd_wext_connect(rdev, wdev);
906
			break;
907
#endif
908
#ifdef CONFIG_MAC80211_MESH
909
		case NL80211_IFTYPE_MESH_POINT:
910 911 912 913 914 915 916 917 918 919 920 921 922 923 924
			{
				/* 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
925
		default:
J
Johannes Berg 已提交
926
			break;
927
		}
J
Johannes Berg 已提交
928
		wdev_unlock(wdev);
929
		rdev->opencount++;
930
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
931
		cfg80211_unlock_rdev(rdev);
932 933 934 935 936

		/*
		 * Configure power management to the driver here so that its
		 * correctly set also after interface type changes etc.
		 */
937 938
		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
939 940 941 942 943 944 945
		    rdev->ops->set_power_mgmt)
			if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
						      wdev->ps,
						      wdev->ps_timeout)) {
				/* assume this means it's off */
				wdev->ps = false;
			}
946
		break;
947
	case NETDEV_UNREGISTER:
J
Johannes Berg 已提交
948 949 950 951 952
		/*
		 * NB: cannot take rdev->mtx here because this may be
		 * called within code protected by it when interfaces
		 * are removed with nl80211.
		 */
953
		mutex_lock(&rdev->devlist_mtx);
954 955 956 957 958 959 960
		/*
		 * 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.
		 */
961
		if (!list_empty(&wdev->list)) {
962
			sysfs_remove_link(&dev->dev.kobj, "phy80211");
J
Johannes Berg 已提交
963
			list_del_rcu(&wdev->list);
964
			rdev->devlist_generation++;
965
			cfg80211_mlme_purge_registrations(wdev);
J
Johannes Berg 已提交
966
#ifdef CONFIG_CFG80211_WEXT
967
			kfree(wdev->wext.keys);
J
Johannes Berg 已提交
968
#endif
969 970
		}
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
971 972 973 974 975 976 977 978
		/*
		 * 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);
979
		break;
J
Johannes Berg 已提交
980
	case NETDEV_PRE_UP:
981 982
		if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
			return notifier_from_errno(-EOPNOTSUPP);
J
Johannes Berg 已提交
983 984
		if (rfkill_blocked(rdev->rfkill))
			return notifier_from_errno(-ERFKILL);
985 986 987
		ret = cfg80211_can_add_interface(rdev, wdev->iftype);
		if (ret)
			return notifier_from_errno(ret);
988 989 990
		cfg80211_lock_rdev(rdev);
		cfg80211_update_iface_num(rdev, wdev->iftype, 1);
		cfg80211_unlock_rdev(rdev);
J
Johannes Berg 已提交
991
		break;
992 993
	}

J
Johannes Berg 已提交
994
	return NOTIFY_DONE;
995 996 997 998 999 1000
}

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

1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019
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)
1020
{
1021 1022
	int err;

1023 1024 1025 1026
	err = register_pernet_device(&cfg80211_pernet_ops);
	if (err)
		goto out_fail_pernet;

1027
	err = wiphy_sysfs_init();
1028 1029 1030 1031 1032 1033 1034
	if (err)
		goto out_fail_sysfs;

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

1035 1036 1037 1038
	err = nl80211_init();
	if (err)
		goto out_fail_nl80211;

1039 1040
	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);

1041 1042 1043 1044
	err = regulatory_init();
	if (err)
		goto out_fail_reg;

1045 1046 1047 1048
	cfg80211_wq = create_singlethread_workqueue("cfg80211");
	if (!cfg80211_wq)
		goto out_fail_wq;

1049 1050
	return 0;

1051 1052
out_fail_wq:
	regulatory_exit();
1053 1054
out_fail_reg:
	debugfs_remove(ieee80211_debugfs_dir);
1055 1056
out_fail_nl80211:
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1057 1058 1059
out_fail_notifier:
	wiphy_sysfs_exit();
out_fail_sysfs:
1060 1061
	unregister_pernet_device(&cfg80211_pernet_ops);
out_fail_pernet:
1062 1063
	return err;
}
1064
subsys_initcall(cfg80211_init);
1065

1066
static void __exit cfg80211_exit(void)
1067 1068
{
	debugfs_remove(ieee80211_debugfs_dir);
1069
	nl80211_exit();
1070 1071
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	wiphy_sysfs_exit();
1072
	regulatory_exit();
1073
	unregister_pernet_device(&cfg80211_pernet_ops);
1074
	destroy_workqueue(cfg80211_wq);
1075 1076
}
module_exit(cfg80211_exit);