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