core.c 22.8 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
/* requires cfg80211_mutex to be held! */
50
struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
51
{
52
	struct cfg80211_registered_device *result = NULL, *rdev;
53

54 55 56
	if (!wiphy_idx_valid(wiphy_idx))
		return NULL;

57 58
	assert_cfg80211_lock();

59 60 61
	list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
		if (rdev->wiphy_idx == wiphy_idx) {
			result = rdev;
62 63 64 65 66 67 68
			break;
		}
	}

	return result;
}

69 70
int get_wiphy_idx(struct wiphy *wiphy)
{
71
	struct cfg80211_registered_device *rdev;
72 73
	if (!wiphy)
		return WIPHY_IDX_STALE;
74 75
	rdev = wiphy_to_dev(wiphy);
	return rdev->wiphy_idx;
76 77
}

78
/* requires cfg80211_rdev_mutex to be held! */
79 80
struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
{
81
	struct cfg80211_registered_device *rdev;
82 83 84 85 86 87

	if (!wiphy_idx_valid(wiphy_idx))
		return NULL;

	assert_cfg80211_lock();

88 89
	rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
	if (!rdev)
90
		return NULL;
91
	return &rdev->wiphy;
92 93
}

94
/* requires cfg80211_mutex to be held! */
95
struct cfg80211_registered_device *
96
__cfg80211_rdev_from_info(struct genl_info *info)
97 98
{
	int ifindex;
99
	struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
100 101 102
	struct net_device *dev;
	int err = -EINVAL;

103 104
	assert_cfg80211_lock();

105
	if (info->attrs[NL80211_ATTR_WIPHY]) {
106
		bywiphyidx = cfg80211_rdev_by_wiphy_idx(
107 108 109 110 111 112
				nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
		err = -ENODEV;
	}

	if (info->attrs[NL80211_ATTR_IFINDEX]) {
		ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
113
		dev = dev_get_by_index(genl_info_net(info), ifindex);
114 115 116 117 118 119 120 121 122
		if (dev) {
			if (dev->ieee80211_ptr)
				byifidx =
					wiphy_to_dev(dev->ieee80211_ptr->wiphy);
			dev_put(dev);
		}
		err = -ENODEV;
	}

123 124
	if (bywiphyidx && byifidx) {
		if (bywiphyidx != byifidx)
125 126
			return ERR_PTR(-EINVAL);
		else
127
			return bywiphyidx; /* == byifidx */
128
	}
129 130
	if (bywiphyidx)
		return bywiphyidx;
131 132 133 134 135 136 137 138 139 140

	if (byifidx)
		return byifidx;

	return ERR_PTR(err);
}

struct cfg80211_registered_device *
cfg80211_get_dev_from_info(struct genl_info *info)
{
141
	struct cfg80211_registered_device *rdev;
142

143
	mutex_lock(&cfg80211_mutex);
144
	rdev = __cfg80211_rdev_from_info(info);
145 146 147 148

	/* if it is not an error we grab the lock on
	 * it to assure it won't be going away while
	 * we operate on it */
149 150
	if (!IS_ERR(rdev))
		mutex_lock(&rdev->mtx);
151

152
	mutex_unlock(&cfg80211_mutex);
153

154
	return rdev;
155 156 157
}

struct cfg80211_registered_device *
158
cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
159
{
160
	struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
161 162
	struct net_device *dev;

163
	mutex_lock(&cfg80211_mutex);
164
	dev = dev_get_by_index(net, ifindex);
165 166 167
	if (!dev)
		goto out;
	if (dev->ieee80211_ptr) {
168 169
		rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
		mutex_lock(&rdev->mtx);
170
	} else
171
		rdev = ERR_PTR(-ENODEV);
172 173
	dev_put(dev);
 out:
174
	mutex_unlock(&cfg80211_mutex);
175
	return rdev;
176 177
}

178
/* requires cfg80211_mutex to be held */
179 180 181
int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
			char *newname)
{
182
	struct cfg80211_registered_device *rdev2;
183
	int wiphy_idx, taken = -1, result, digits;
184

185
	assert_cfg80211_lock();
186

187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
	/* 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;
	}


203 204
	/* Ignore nop renames */
	if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
205
		return 0;
206 207

	/* Ensure another device does not already have this name. */
208 209
	list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
		if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
210
			return -EINVAL;
211 212 213

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

216 217
	if (rdev->wiphy.debugfsdir &&
	    !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
218 219 220
			    rdev->wiphy.debugfsdir,
			    rdev->wiphy.debugfsdir->d_parent,
			    newname))
221
		pr_err("failed to rename debugfs dir to %s!\n", newname);
222

223
	nl80211_notify_dev_rename(rdev);
224

225
	return 0;
226 227
}

228 229 230 231 232 233
int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
			  struct net *net)
{
	struct wireless_dev *wdev;
	int err = 0;

J
Johannes Berg 已提交
234
	if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256
		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;
		}
257 258

		return err;
259 260 261 262
	}

	wiphy_net_set(&rdev->wiphy, net);

263 264 265 266
	err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
	WARN_ON(err);

	return 0;
267 268
}

J
Johannes Berg 已提交
269 270
static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
{
271
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
272

273
	rdev->ops->rfkill_poll(&rdev->wiphy);
J
Johannes Berg 已提交
274 275 276 277
}

static int cfg80211_rfkill_set_block(void *data, bool blocked)
{
278
	struct cfg80211_registered_device *rdev = data;
J
Johannes Berg 已提交
279 280 281 282 283 284
	struct wireless_dev *wdev;

	if (!blocked)
		return 0;

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

287
	list_for_each_entry(wdev, &rdev->netdev_list, list)
J
Johannes Berg 已提交
288 289
		dev_close(wdev->netdev);

290
	mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
291 292 293 294 295 296 297
	rtnl_unlock();

	return 0;
}

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

300 301
	rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
	cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
J
Johannes Berg 已提交
302 303
}

J
Johannes Berg 已提交
304 305 306 307 308 309 310 311 312 313
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);

314
	cfg80211_process_rdev_events(rdev);
J
Johannes Berg 已提交
315 316 317 318
	cfg80211_unlock_rdev(rdev);
	rtnl_unlock();
}

319 320
/* exported functions */

321
struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
322
{
323
	static int wiphy_counter;
324 325

	struct cfg80211_registered_device *rdev;
326 327
	int alloc_size;

328 329 330 331 332 333 334
	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);
335
	WARN_ON(ops->join_mesh && !ops->leave_mesh);
336

337
	alloc_size = sizeof(*rdev) + sizeof_priv;
338

339 340
	rdev = kzalloc(alloc_size, GFP_KERNEL);
	if (!rdev)
341 342
		return NULL;

343
	rdev->ops = ops;
344

345
	mutex_lock(&cfg80211_mutex);
346

347
	rdev->wiphy_idx = wiphy_counter++;
348

349
	if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
350
		wiphy_counter--;
351
		mutex_unlock(&cfg80211_mutex);
352
		/* ugh, wrapped! */
353
		kfree(rdev);
354 355 356
		return NULL;
	}

357
	mutex_unlock(&cfg80211_mutex);
358

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

362 363 364 365 366 367 368
	mutex_init(&rdev->mtx);
	mutex_init(&rdev->devlist_mtx);
	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);

J
Johannes Berg 已提交
369 370 371 372
#ifdef CONFIG_CFG80211_WEXT
	rdev->wiphy.wext = &cfg80211_wext_handler;
#endif

373 374 375 376
	device_initialize(&rdev->wiphy.dev);
	rdev->wiphy.dev.class = &ieee80211_class;
	rdev->wiphy.dev.platform_data = rdev;

J
Johannes Berg 已提交
377 378 379
#ifdef CONFIG_CFG80211_DEFAULT_PS
	rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
#endif
380

381 382
	wiphy_net_set(&rdev->wiphy, &init_net);

383 384 385 386 387 388 389
	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 已提交
390 391 392
		return NULL;
	}

393 394 395
	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 已提交
396

397 398
	init_waitqueue_head(&rdev->dev_wait);

399 400 401 402 403
	/*
	 * Initialize wiphy parameters to IEEE 802.11 MIB default values.
	 * Fragmentation and RTS threshold are disabled by default with the
	 * special -1 value.
	 */
404 405 406 407
	rdev->wiphy.retry_short = 7;
	rdev->wiphy.retry_long = 4;
	rdev->wiphy.frag_threshold = (u32) -1;
	rdev->wiphy.rts_threshold = (u32) -1;
408
	rdev->wiphy.coverage_class = 0;
409

410
	return &rdev->wiphy;
411 412 413 414 415
}
EXPORT_SYMBOL(wiphy_new);

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 425 426 427 428 429 430 431 432 433 434 435
	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);

436 437
	/* sanity check ifmodes */
	WARN_ON(!ifmodes);
438
	ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
439 440
	if (WARN_ON(ifmodes != wiphy->interface_modes))
		wiphy->interface_modes = ifmodes;
441 442 443 444 445 446 447 448 449

	/* sanity check supported bands/channels */
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		sband = wiphy->bands[band];
		if (!sband)
			continue;

		sband->band = band;

450 451 452 453 454 455 456 457 458
		if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
			return -EINVAL;

		/*
		 * 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))
459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481
			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;
	}

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

482 483
	mutex_lock(&cfg80211_mutex);

484
	res = device_add(&rdev->wiphy.dev);
485 486 487 488
	if (res) {
		mutex_unlock(&cfg80211_mutex);
		return res;
	}
J
Johannes Berg 已提交
489

490 491 492
	/* set up regulatory info */
	wiphy_update_regulatory(wiphy, NL80211_REGDOM_SET_BY_CORE);

J
Johannes Berg 已提交
493
	list_add_rcu(&rdev->list, &cfg80211_rdev_list);
494
	cfg80211_rdev_list_generation++;
495 496

	/* add to debugfs */
497 498
	rdev->wiphy.debugfsdir =
		debugfs_create_dir(wiphy_name(&rdev->wiphy),
499
				   ieee80211_debugfs_dir);
500 501
	if (IS_ERR(rdev->wiphy.debugfsdir))
		rdev->wiphy.debugfsdir = NULL;
502

J
Johannes Berg 已提交
503
	if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
504 505 506 507 508 509 510 511 512 513
		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);
	}

514
	cfg80211_debugfs_rdev_add(rdev);
515
	mutex_unlock(&cfg80211_mutex);
516

517 518 519 520 521 522 523 524
	/*
	 * 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;

525
	return 0;
J
Johannes Berg 已提交
526

527
out_rm_dev:
528
	device_del(&rdev->wiphy.dev);
529 530 531 532
	return res;
}
EXPORT_SYMBOL(wiphy_register);

J
Johannes Berg 已提交
533 534
void wiphy_rfkill_start_polling(struct wiphy *wiphy)
{
535
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
536

537
	if (!rdev->ops->rfkill_poll)
J
Johannes Berg 已提交
538
		return;
539 540
	rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
	rfkill_resume_polling(rdev->rfkill);
J
Johannes Berg 已提交
541 542 543 544 545
}
EXPORT_SYMBOL(wiphy_rfkill_start_polling);

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

548
	rfkill_pause_polling(rdev->rfkill);
J
Johannes Berg 已提交
549 550 551
}
EXPORT_SYMBOL(wiphy_rfkill_stop_polling);

552 553
void wiphy_unregister(struct wiphy *wiphy)
{
554
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
555

556
	rfkill_unregister(rdev->rfkill);
J
Johannes Berg 已提交
557

558
	/* protect the device list */
559
	mutex_lock(&cfg80211_mutex);
560

561 562 563 564 565 566 567 568
	wait_event(rdev->dev_wait, ({
		int __count;
		mutex_lock(&rdev->devlist_mtx);
		__count = rdev->opencount;
		mutex_unlock(&rdev->devlist_mtx);
		__count == 0;}));

	mutex_lock(&rdev->devlist_mtx);
569
	BUG_ON(!list_empty(&rdev->netdev_list));
570 571 572 573 574 575
	mutex_unlock(&rdev->devlist_mtx);

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

	/*
581
	 * Try to grab rdev->mtx. If a command is still in progress,
582 583 584 585
	 * 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
586 587 588
	 * 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.
589
	 */
J
Johannes Berg 已提交
590
	cfg80211_lock_rdev(rdev);
591
	/* nothing */
J
Johannes Berg 已提交
592
	cfg80211_unlock_rdev(rdev);
593

594 595 596 597
	/* 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);

598
	cfg80211_rdev_list_generation++;
599
	device_del(&rdev->wiphy.dev);
600

601
	mutex_unlock(&cfg80211_mutex);
J
Johannes Berg 已提交
602

603
	flush_work(&rdev->scan_done_wk);
J
Johannes Berg 已提交
604 605
	cancel_work_sync(&rdev->conn_work);
	flush_work(&rdev->event_work);
606 607 608
}
EXPORT_SYMBOL(wiphy_unregister);

609
void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
610
{
611
	struct cfg80211_internal_bss *scan, *tmp;
612 613 614 615
	rfkill_destroy(rdev->rfkill);
	mutex_destroy(&rdev->mtx);
	mutex_destroy(&rdev->devlist_mtx);
	list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
J
Johannes Berg 已提交
616
		cfg80211_put_bss(&scan->pub);
617
	kfree(rdev);
618 619 620 621 622 623 624 625
}

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

J
Johannes Berg 已提交
626 627
void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
{
628
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
J
Johannes Berg 已提交
629

630 631
	if (rfkill_set_hw_state(rdev->rfkill, blocked))
		schedule_work(&rdev->rfkill_sync);
J
Johannes Berg 已提交
632 633 634
}
EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);

635 636 637 638 639 640 641 642 643 644 645 646
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;
647
		___cfg80211_scan_done(rdev, true);
648 649 650 651 652 653 654 655 656 657 658 659
	}

	cfg80211_unlock_rdev(rdev);

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

	dev_put(wdev->netdev);
}

660 661 662 663
static struct device_type wiphy_type = {
	.name	= "wlan",
};

664 665 666 667 668
static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
					 unsigned long state,
					 void *ndev)
{
	struct net_device *dev = ndev;
669
	struct wireless_dev *wdev = dev->ieee80211_ptr;
670 671
	struct cfg80211_registered_device *rdev;

672
	if (!wdev)
J
Johannes Berg 已提交
673
		return NOTIFY_DONE;
674

675
	rdev = wiphy_to_dev(wdev->wiphy);
676

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

679
	switch (state) {
680 681 682
	case NETDEV_POST_INIT:
		SET_NETDEV_DEVTYPE(dev, &wiphy_type);
		break;
683
	case NETDEV_REGISTER:
J
Johannes Berg 已提交
684 685 686 687 688
		/*
		 * 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 已提交
689
		mutex_init(&wdev->mtx);
690
		INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
J
Johannes Berg 已提交
691 692
		INIT_LIST_HEAD(&wdev->event_list);
		spin_lock_init(&wdev->event_lock);
693 694
		INIT_LIST_HEAD(&wdev->mgmt_registrations);
		spin_lock_init(&wdev->mgmt_registrations_lock);
695

696
		mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
697
		list_add_rcu(&wdev->list, &rdev->netdev_list);
698
		rdev->devlist_generation++;
699 700 701
		/* can only change netns with wiphy */
		dev->features |= NETIF_F_NETNS_LOCAL;

702 703
		if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
				      "phy80211")) {
704
			pr_err("failed to add phy80211 symlink to netdev!\n");
705
		}
706
		wdev->netdev = dev;
S
Samuel Ortiz 已提交
707
		wdev->sme_state = CFG80211_SME_IDLE;
J
Johannes Berg 已提交
708
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
709
#ifdef CONFIG_CFG80211_WEXT
710 711
		wdev->wext.default_key = -1;
		wdev->wext.default_mgmt_key = -1;
712
		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
K
Kalle Valo 已提交
713 714
#endif

J
Johannes Berg 已提交
715
		if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
K
Kalle Valo 已提交
716
			wdev->ps = true;
J
Johannes Berg 已提交
717
		else
K
Kalle Valo 已提交
718
			wdev->ps = false;
719 720
		/* allow mac80211 to determine the timeout */
		wdev->ps_timeout = -1;
J
Johannes Berg 已提交
721 722
		if (rdev->ops->set_power_mgmt)
			if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
K
Kalle Valo 已提交
723 724
						      wdev->ps,
						      wdev->ps_timeout)) {
J
Johannes Berg 已提交
725
				/* assume this means it's off */
K
Kalle Valo 已提交
726
				wdev->ps = false;
J
Johannes Berg 已提交
727
			}
K
Kalle Valo 已提交
728

729 730
		if (!dev->ethtool_ops)
			dev->ethtool_ops = &cfg80211_ethtool_ops;
731 732

		if ((wdev->iftype == NL80211_IFTYPE_STATION ||
733
		     wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
734 735
		     wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
			dev->priv_flags |= IFF_DONT_BRIDGE;
736
		break;
J
Johannes Berg 已提交
737
	case NETDEV_GOING_DOWN:
S
Samuel Ortiz 已提交
738 739 740 741
		switch (wdev->iftype) {
		case NL80211_IFTYPE_ADHOC:
			cfg80211_leave_ibss(rdev, dev, true);
			break;
742
		case NL80211_IFTYPE_P2P_CLIENT:
S
Samuel Ortiz 已提交
743
		case NL80211_IFTYPE_STATION:
J
Johannes Berg 已提交
744
			wdev_lock(wdev);
J
Johannes Berg 已提交
745
#ifdef CONFIG_CFG80211_WEXT
746 747 748
			kfree(wdev->wext.ie);
			wdev->wext.ie = NULL;
			wdev->wext.ie_len = 0;
J
Johannes Berg 已提交
749
			wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
750
#endif
J
Johannes Berg 已提交
751 752
			__cfg80211_disconnect(rdev, dev,
					      WLAN_REASON_DEAUTH_LEAVING, true);
J
Johannes Berg 已提交
753
			cfg80211_mlme_down(rdev, dev);
J
Johannes Berg 已提交
754
			wdev_unlock(wdev);
S
Samuel Ortiz 已提交
755
			break;
756 757 758
		case NL80211_IFTYPE_MESH_POINT:
			cfg80211_leave_mesh(rdev, dev);
			break;
S
Samuel Ortiz 已提交
759 760 761
		default:
			break;
		}
762 763
		break;
	case NETDEV_DOWN:
764
		dev_hold(dev);
765
		queue_work(cfg80211_wq, &wdev->cleanup_work);
J
Johannes Berg 已提交
766 767
		break;
	case NETDEV_UP:
768 769 770 771 772 773 774 775 776 777 778 779
		/*
		 * 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 已提交
780
		cfg80211_lock_rdev(rdev);
781
		mutex_lock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
782
		wdev_lock(wdev);
783
		switch (wdev->iftype) {
784
#ifdef CONFIG_CFG80211_WEXT
785
		case NL80211_IFTYPE_ADHOC:
J
Johannes Berg 已提交
786
			cfg80211_ibss_wext_join(rdev, wdev);
J
Johannes Berg 已提交
787
			break;
788
		case NL80211_IFTYPE_STATION:
J
Johannes Berg 已提交
789
			cfg80211_mgd_wext_connect(rdev, wdev);
790
			break;
791
#endif
792
#ifdef CONFIG_MAC80211_MESH
793
		case NL80211_IFTYPE_MESH_POINT:
794 795 796 797 798 799 800 801 802 803 804 805 806 807 808
			{
				/* 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
809
		default:
J
Johannes Berg 已提交
810
			break;
811
		}
J
Johannes Berg 已提交
812
		wdev_unlock(wdev);
813
		rdev->opencount++;
814
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
815
		cfg80211_unlock_rdev(rdev);
816
		break;
817
	case NETDEV_UNREGISTER:
J
Johannes Berg 已提交
818 819 820 821 822
		/*
		 * NB: cannot take rdev->mtx here because this may be
		 * called within code protected by it when interfaces
		 * are removed with nl80211.
		 */
823
		mutex_lock(&rdev->devlist_mtx);
824 825 826 827 828 829 830
		/*
		 * 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.
		 */
831
		if (!list_empty(&wdev->list)) {
832
			sysfs_remove_link(&dev->dev.kobj, "phy80211");
J
Johannes Berg 已提交
833
			list_del_rcu(&wdev->list);
834
			rdev->devlist_generation++;
835
			cfg80211_mlme_purge_registrations(wdev);
J
Johannes Berg 已提交
836
#ifdef CONFIG_CFG80211_WEXT
837
			kfree(wdev->wext.keys);
J
Johannes Berg 已提交
838
#endif
839 840
		}
		mutex_unlock(&rdev->devlist_mtx);
J
Johannes Berg 已提交
841 842 843 844 845 846 847 848
		/*
		 * 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);
849
		break;
J
Johannes Berg 已提交
850
	case NETDEV_PRE_UP:
851 852
		if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
			return notifier_from_errno(-EOPNOTSUPP);
J
Johannes Berg 已提交
853 854 855
		if (rfkill_blocked(rdev->rfkill))
			return notifier_from_errno(-ERFKILL);
		break;
856 857
	}

J
Johannes Berg 已提交
858
	return NOTIFY_DONE;
859 860 861 862 863 864
}

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

865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883
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)
884
{
885 886
	int err;

887 888 889 890
	err = register_pernet_device(&cfg80211_pernet_ops);
	if (err)
		goto out_fail_pernet;

891
	err = wiphy_sysfs_init();
892 893 894 895 896 897 898
	if (err)
		goto out_fail_sysfs;

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

899 900 901 902
	err = nl80211_init();
	if (err)
		goto out_fail_nl80211;

903 904
	ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);

905 906 907 908
	err = regulatory_init();
	if (err)
		goto out_fail_reg;

909 910 911 912
	cfg80211_wq = create_singlethread_workqueue("cfg80211");
	if (!cfg80211_wq)
		goto out_fail_wq;

913 914
	return 0;

915 916
out_fail_wq:
	regulatory_exit();
917 918
out_fail_reg:
	debugfs_remove(ieee80211_debugfs_dir);
919 920
out_fail_nl80211:
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
921 922 923
out_fail_notifier:
	wiphy_sysfs_exit();
out_fail_sysfs:
924 925
	unregister_pernet_device(&cfg80211_pernet_ops);
out_fail_pernet:
926 927
	return err;
}
928
subsys_initcall(cfg80211_init);
929

930
static void __exit cfg80211_exit(void)
931 932
{
	debugfs_remove(ieee80211_debugfs_dir);
933
	nl80211_exit();
934 935
	unregister_netdevice_notifier(&cfg80211_netdev_notifier);
	wiphy_sysfs_exit();
936
	regulatory_exit();
937
	unregister_pernet_device(&cfg80211_pernet_ops);
938
	destroy_workqueue(cfg80211_wq);
939 940
}
module_exit(cfg80211_exit);