main.c revision 4bf88530be971bf95a7830ca61b4120980bf4347
1/*
2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <net/mac80211.h>
12#include <linux/module.h>
13#include <linux/init.h>
14#include <linux/netdevice.h>
15#include <linux/types.h>
16#include <linux/slab.h>
17#include <linux/skbuff.h>
18#include <linux/etherdevice.h>
19#include <linux/if_arp.h>
20#include <linux/rtnetlink.h>
21#include <linux/bitmap.h>
22#include <linux/pm_qos.h>
23#include <linux/inetdevice.h>
24#include <net/net_namespace.h>
25#include <net/cfg80211.h>
26
27#include "ieee80211_i.h"
28#include "driver-ops.h"
29#include "rate.h"
30#include "mesh.h"
31#include "wep.h"
32#include "led.h"
33#include "cfg.h"
34#include "debugfs.h"
35
36static struct lock_class_key ieee80211_rx_skb_queue_class;
37
38void ieee80211_configure_filter(struct ieee80211_local *local)
39{
40	u64 mc;
41	unsigned int changed_flags;
42	unsigned int new_flags = 0;
43
44	if (atomic_read(&local->iff_promiscs))
45		new_flags |= FIF_PROMISC_IN_BSS;
46
47	if (atomic_read(&local->iff_allmultis))
48		new_flags |= FIF_ALLMULTI;
49
50	if (local->monitors || test_bit(SCAN_SW_SCANNING, &local->scanning) ||
51	    test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning))
52		new_flags |= FIF_BCN_PRBRESP_PROMISC;
53
54	if (local->fif_probe_req || local->probe_req_reg)
55		new_flags |= FIF_PROBE_REQ;
56
57	if (local->fif_fcsfail)
58		new_flags |= FIF_FCSFAIL;
59
60	if (local->fif_plcpfail)
61		new_flags |= FIF_PLCPFAIL;
62
63	if (local->fif_control)
64		new_flags |= FIF_CONTROL;
65
66	if (local->fif_other_bss)
67		new_flags |= FIF_OTHER_BSS;
68
69	if (local->fif_pspoll)
70		new_flags |= FIF_PSPOLL;
71
72	spin_lock_bh(&local->filter_lock);
73	changed_flags = local->filter_flags ^ new_flags;
74
75	mc = drv_prepare_multicast(local, &local->mc_list);
76	spin_unlock_bh(&local->filter_lock);
77
78	/* be a bit nasty */
79	new_flags |= (1<<31);
80
81	drv_configure_filter(local, changed_flags, &new_flags, mc);
82
83	WARN_ON(new_flags & (1<<31));
84
85	local->filter_flags = new_flags & ~(1<<31);
86}
87
88static void ieee80211_reconfig_filter(struct work_struct *work)
89{
90	struct ieee80211_local *local =
91		container_of(work, struct ieee80211_local, reconfig_filter);
92
93	ieee80211_configure_filter(local);
94}
95
96static u32 ieee80211_hw_conf_chan(struct ieee80211_local *local)
97{
98	struct ieee80211_sub_if_data *sdata;
99	struct ieee80211_channel *chan;
100	u32 changed = 0;
101	int power;
102	enum nl80211_channel_type channel_type;
103	u32 offchannel_flag;
104	bool scanning = false;
105
106	offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
107	if (local->scan_channel) {
108		chan = local->scan_channel;
109		/* If scanning on oper channel, use whatever channel-type
110		 * is currently in use.
111		 */
112		if (chan == local->_oper_channel)
113			channel_type = local->_oper_channel_type;
114		else
115			channel_type = NL80211_CHAN_NO_HT;
116	} else if (local->tmp_channel) {
117		chan = local->tmp_channel;
118		channel_type = NL80211_CHAN_NO_HT;
119	} else {
120		chan = local->_oper_channel;
121		channel_type = local->_oper_channel_type;
122	}
123
124	if (chan != local->_oper_channel ||
125	    channel_type != local->_oper_channel_type)
126		local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL;
127	else
128		local->hw.conf.flags &= ~IEEE80211_CONF_OFFCHANNEL;
129
130	offchannel_flag ^= local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
131
132	if (offchannel_flag || chan != local->hw.conf.channel ||
133	    channel_type != local->hw.conf.channel_type) {
134		local->hw.conf.channel = chan;
135		local->hw.conf.channel_type = channel_type;
136		changed |= IEEE80211_CONF_CHANGE_CHANNEL;
137	}
138
139	if (!conf_is_ht(&local->hw.conf)) {
140		/*
141		 * mac80211.h documents that this is only valid
142		 * when the channel is set to an HT type, and
143		 * that otherwise STATIC is used.
144		 */
145		local->hw.conf.smps_mode = IEEE80211_SMPS_STATIC;
146	} else if (local->hw.conf.smps_mode != local->smps_mode) {
147		local->hw.conf.smps_mode = local->smps_mode;
148		changed |= IEEE80211_CONF_CHANGE_SMPS;
149	}
150
151	scanning = test_bit(SCAN_SW_SCANNING, &local->scanning) ||
152		   test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning) ||
153		   test_bit(SCAN_HW_SCANNING, &local->scanning);
154	power = chan->max_power;
155
156	rcu_read_lock();
157	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
158		if (!rcu_access_pointer(sdata->vif.chanctx_conf))
159			continue;
160		power = min(power, sdata->vif.bss_conf.txpower);
161	}
162	rcu_read_unlock();
163
164	if (local->hw.conf.power_level != power) {
165		changed |= IEEE80211_CONF_CHANGE_POWER;
166		local->hw.conf.power_level = power;
167	}
168
169	return changed;
170}
171
172int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
173{
174	int ret = 0;
175
176	might_sleep();
177
178	if (!local->use_chanctx)
179		changed |= ieee80211_hw_conf_chan(local);
180	else
181		changed &= ~(IEEE80211_CONF_CHANGE_CHANNEL |
182			     IEEE80211_CONF_CHANGE_POWER);
183
184	if (changed && local->open_count) {
185		ret = drv_config(local, changed);
186		/*
187		 * Goal:
188		 * HW reconfiguration should never fail, the driver has told
189		 * us what it can support so it should live up to that promise.
190		 *
191		 * Current status:
192		 * rfkill is not integrated with mac80211 and a
193		 * configuration command can thus fail if hardware rfkill
194		 * is enabled
195		 *
196		 * FIXME: integrate rfkill with mac80211 and then add this
197		 * WARN_ON() back
198		 *
199		 */
200		/* WARN_ON(ret); */
201	}
202
203	return ret;
204}
205
206void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata,
207				      u32 changed)
208{
209	struct ieee80211_local *local = sdata->local;
210	static const u8 zero[ETH_ALEN] = { 0 };
211
212	if (!changed)
213		return;
214
215	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
216		sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid;
217	} else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
218		sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid;
219	else if (sdata->vif.type == NL80211_IFTYPE_AP)
220		sdata->vif.bss_conf.bssid = sdata->vif.addr;
221	else if (sdata->vif.type == NL80211_IFTYPE_WDS)
222		sdata->vif.bss_conf.bssid = NULL;
223	else if (ieee80211_vif_is_mesh(&sdata->vif)) {
224		sdata->vif.bss_conf.bssid = zero;
225	} else if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE) {
226		sdata->vif.bss_conf.bssid = sdata->vif.addr;
227		WARN_ONCE(changed & ~(BSS_CHANGED_IDLE),
228			  "P2P Device BSS changed %#x", changed);
229	} else {
230		WARN_ON(1);
231		return;
232	}
233
234	switch (sdata->vif.type) {
235	case NL80211_IFTYPE_AP:
236	case NL80211_IFTYPE_ADHOC:
237	case NL80211_IFTYPE_WDS:
238	case NL80211_IFTYPE_MESH_POINT:
239		break;
240	default:
241		/* do not warn to simplify caller in scan.c */
242		changed &= ~BSS_CHANGED_BEACON_ENABLED;
243		if (WARN_ON(changed & BSS_CHANGED_BEACON))
244			return;
245		break;
246	}
247
248	if (changed & BSS_CHANGED_BEACON_ENABLED) {
249		if (local->quiescing || !ieee80211_sdata_running(sdata) ||
250		    test_bit(SDATA_STATE_OFFCHANNEL, &sdata->state)) {
251			sdata->vif.bss_conf.enable_beacon = false;
252		} else {
253			/*
254			 * Beacon should be enabled, but AP mode must
255			 * check whether there is a beacon configured.
256			 */
257			switch (sdata->vif.type) {
258			case NL80211_IFTYPE_AP:
259				sdata->vif.bss_conf.enable_beacon =
260					!!sdata->u.ap.beacon;
261				break;
262			case NL80211_IFTYPE_ADHOC:
263				sdata->vif.bss_conf.enable_beacon =
264					!!sdata->u.ibss.presp;
265				break;
266#ifdef CONFIG_MAC80211_MESH
267			case NL80211_IFTYPE_MESH_POINT:
268				sdata->vif.bss_conf.enable_beacon =
269					!!sdata->u.mesh.mesh_id_len;
270				break;
271#endif
272			default:
273				/* not reached */
274				WARN_ON(1);
275				break;
276			}
277		}
278	}
279
280	drv_bss_info_changed(local, sdata, &sdata->vif.bss_conf, changed);
281}
282
283u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata)
284{
285	sdata->vif.bss_conf.use_cts_prot = false;
286	sdata->vif.bss_conf.use_short_preamble = false;
287	sdata->vif.bss_conf.use_short_slot = false;
288	return BSS_CHANGED_ERP_CTS_PROT |
289	       BSS_CHANGED_ERP_PREAMBLE |
290	       BSS_CHANGED_ERP_SLOT;
291}
292
293static void ieee80211_tasklet_handler(unsigned long data)
294{
295	struct ieee80211_local *local = (struct ieee80211_local *) data;
296	struct sta_info *sta, *tmp;
297	struct skb_eosp_msg_data *eosp_data;
298	struct sk_buff *skb;
299
300	while ((skb = skb_dequeue(&local->skb_queue)) ||
301	       (skb = skb_dequeue(&local->skb_queue_unreliable))) {
302		switch (skb->pkt_type) {
303		case IEEE80211_RX_MSG:
304			/* Clear skb->pkt_type in order to not confuse kernel
305			 * netstack. */
306			skb->pkt_type = 0;
307			ieee80211_rx(&local->hw, skb);
308			break;
309		case IEEE80211_TX_STATUS_MSG:
310			skb->pkt_type = 0;
311			ieee80211_tx_status(&local->hw, skb);
312			break;
313		case IEEE80211_EOSP_MSG:
314			eosp_data = (void *)skb->cb;
315			for_each_sta_info(local, eosp_data->sta, sta, tmp) {
316				/* skip wrong virtual interface */
317				if (memcmp(eosp_data->iface,
318					   sta->sdata->vif.addr, ETH_ALEN))
319					continue;
320				clear_sta_flag(sta, WLAN_STA_SP);
321				break;
322			}
323			dev_kfree_skb(skb);
324			break;
325		default:
326			WARN(1, "mac80211: Packet is of unknown type %d\n",
327			     skb->pkt_type);
328			dev_kfree_skb(skb);
329			break;
330		}
331	}
332}
333
334static void ieee80211_restart_work(struct work_struct *work)
335{
336	struct ieee80211_local *local =
337		container_of(work, struct ieee80211_local, restart_work);
338
339	/* wait for scan work complete */
340	flush_workqueue(local->workqueue);
341
342	mutex_lock(&local->mtx);
343	WARN(test_bit(SCAN_HW_SCANNING, &local->scanning) ||
344	     rcu_dereference_protected(local->sched_scan_sdata,
345				       lockdep_is_held(&local->mtx)),
346		"%s called with hardware scan in progress\n", __func__);
347	mutex_unlock(&local->mtx);
348
349	rtnl_lock();
350	ieee80211_scan_cancel(local);
351	ieee80211_reconfig(local);
352	rtnl_unlock();
353}
354
355void ieee80211_restart_hw(struct ieee80211_hw *hw)
356{
357	struct ieee80211_local *local = hw_to_local(hw);
358
359	trace_api_restart_hw(local);
360
361	wiphy_info(hw->wiphy,
362		   "Hardware restart was requested\n");
363
364	/* use this reason, ieee80211_reconfig will unblock it */
365	ieee80211_stop_queues_by_reason(hw,
366		IEEE80211_QUEUE_STOP_REASON_SUSPEND);
367
368	/*
369	 * Stop all Rx during the reconfig. We don't want state changes
370	 * or driver callbacks while this is in progress.
371	 */
372	local->in_reconfig = true;
373	barrier();
374
375	schedule_work(&local->restart_work);
376}
377EXPORT_SYMBOL(ieee80211_restart_hw);
378
379#ifdef CONFIG_INET
380static int ieee80211_ifa_changed(struct notifier_block *nb,
381				 unsigned long data, void *arg)
382{
383	struct in_ifaddr *ifa = arg;
384	struct ieee80211_local *local =
385		container_of(nb, struct ieee80211_local,
386			     ifa_notifier);
387	struct net_device *ndev = ifa->ifa_dev->dev;
388	struct wireless_dev *wdev = ndev->ieee80211_ptr;
389	struct in_device *idev;
390	struct ieee80211_sub_if_data *sdata;
391	struct ieee80211_bss_conf *bss_conf;
392	struct ieee80211_if_managed *ifmgd;
393	int c = 0;
394
395	/* Make sure it's our interface that got changed */
396	if (!wdev)
397		return NOTIFY_DONE;
398
399	if (wdev->wiphy != local->hw.wiphy)
400		return NOTIFY_DONE;
401
402	sdata = IEEE80211_DEV_TO_SUB_IF(ndev);
403	bss_conf = &sdata->vif.bss_conf;
404
405	/* ARP filtering is only supported in managed mode */
406	if (sdata->vif.type != NL80211_IFTYPE_STATION)
407		return NOTIFY_DONE;
408
409	idev = __in_dev_get_rtnl(sdata->dev);
410	if (!idev)
411		return NOTIFY_DONE;
412
413	ifmgd = &sdata->u.mgd;
414	mutex_lock(&ifmgd->mtx);
415
416	/* Copy the addresses to the bss_conf list */
417	ifa = idev->ifa_list;
418	while (c < IEEE80211_BSS_ARP_ADDR_LIST_LEN && ifa) {
419		bss_conf->arp_addr_list[c] = ifa->ifa_address;
420		ifa = ifa->ifa_next;
421		c++;
422	}
423
424	/* If not all addresses fit the list, disable filtering */
425	if (ifa) {
426		sdata->arp_filter_state = false;
427		c = 0;
428	} else {
429		sdata->arp_filter_state = true;
430	}
431	bss_conf->arp_addr_cnt = c;
432
433	/* Configure driver only if associated (which also implies it is up) */
434	if (ifmgd->associated) {
435		bss_conf->arp_filter_enabled = sdata->arp_filter_state;
436		ieee80211_bss_info_change_notify(sdata,
437						 BSS_CHANGED_ARP_FILTER);
438	}
439
440	mutex_unlock(&ifmgd->mtx);
441
442	return NOTIFY_DONE;
443}
444#endif
445
446static int ieee80211_napi_poll(struct napi_struct *napi, int budget)
447{
448	struct ieee80211_local *local =
449		container_of(napi, struct ieee80211_local, napi);
450
451	return local->ops->napi_poll(&local->hw, budget);
452}
453
454void ieee80211_napi_schedule(struct ieee80211_hw *hw)
455{
456	struct ieee80211_local *local = hw_to_local(hw);
457
458	napi_schedule(&local->napi);
459}
460EXPORT_SYMBOL(ieee80211_napi_schedule);
461
462void ieee80211_napi_complete(struct ieee80211_hw *hw)
463{
464	struct ieee80211_local *local = hw_to_local(hw);
465
466	napi_complete(&local->napi);
467}
468EXPORT_SYMBOL(ieee80211_napi_complete);
469
470/* There isn't a lot of sense in it, but you can transmit anything you like */
471static const struct ieee80211_txrx_stypes
472ieee80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = {
473	[NL80211_IFTYPE_ADHOC] = {
474		.tx = 0xffff,
475		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
476			BIT(IEEE80211_STYPE_AUTH >> 4) |
477			BIT(IEEE80211_STYPE_DEAUTH >> 4),
478	},
479	[NL80211_IFTYPE_STATION] = {
480		.tx = 0xffff,
481		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
482			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
483	},
484	[NL80211_IFTYPE_AP] = {
485		.tx = 0xffff,
486		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
487			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
488			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
489			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
490			BIT(IEEE80211_STYPE_AUTH >> 4) |
491			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
492			BIT(IEEE80211_STYPE_ACTION >> 4),
493	},
494	[NL80211_IFTYPE_AP_VLAN] = {
495		/* copy AP */
496		.tx = 0xffff,
497		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
498			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
499			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
500			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
501			BIT(IEEE80211_STYPE_AUTH >> 4) |
502			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
503			BIT(IEEE80211_STYPE_ACTION >> 4),
504	},
505	[NL80211_IFTYPE_P2P_CLIENT] = {
506		.tx = 0xffff,
507		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
508			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
509	},
510	[NL80211_IFTYPE_P2P_GO] = {
511		.tx = 0xffff,
512		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
513			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
514			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
515			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
516			BIT(IEEE80211_STYPE_AUTH >> 4) |
517			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
518			BIT(IEEE80211_STYPE_ACTION >> 4),
519	},
520	[NL80211_IFTYPE_MESH_POINT] = {
521		.tx = 0xffff,
522		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
523			BIT(IEEE80211_STYPE_AUTH >> 4) |
524			BIT(IEEE80211_STYPE_DEAUTH >> 4),
525	},
526	[NL80211_IFTYPE_P2P_DEVICE] = {
527		.tx = 0xffff,
528		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
529			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
530	},
531};
532
533static const struct ieee80211_ht_cap mac80211_ht_capa_mod_mask = {
534	.ampdu_params_info = IEEE80211_HT_AMPDU_PARM_FACTOR |
535			     IEEE80211_HT_AMPDU_PARM_DENSITY,
536
537	.cap_info = cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
538				IEEE80211_HT_CAP_MAX_AMSDU |
539				IEEE80211_HT_CAP_SGI_40),
540	.mcs = {
541		.rx_mask = { 0xff, 0xff, 0xff, 0xff, 0xff,
542			     0xff, 0xff, 0xff, 0xff, 0xff, },
543	},
544};
545
546struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
547					const struct ieee80211_ops *ops)
548{
549	struct ieee80211_local *local;
550	int priv_size, i;
551	struct wiphy *wiphy;
552	bool use_chanctx;
553
554	if (WARN_ON(!ops->tx || !ops->start || !ops->stop || !ops->config ||
555		    !ops->add_interface || !ops->remove_interface ||
556		    !ops->configure_filter))
557		return NULL;
558
559	if (WARN_ON(ops->sta_state && (ops->sta_add || ops->sta_remove)))
560		return NULL;
561
562	/* check all or no channel context operations exist */
563	i = !!ops->add_chanctx + !!ops->remove_chanctx +
564	    !!ops->change_chanctx + !!ops->assign_vif_chanctx +
565	    !!ops->unassign_vif_chanctx;
566	if (WARN_ON(i != 0 && i != 5))
567		return NULL;
568	use_chanctx = i == 5;
569
570	/* Ensure 32-byte alignment of our private data and hw private data.
571	 * We use the wiphy priv data for both our ieee80211_local and for
572	 * the driver's private data
573	 *
574	 * In memory it'll be like this:
575	 *
576	 * +-------------------------+
577	 * | struct wiphy	    |
578	 * +-------------------------+
579	 * | struct ieee80211_local  |
580	 * +-------------------------+
581	 * | driver's private data   |
582	 * +-------------------------+
583	 *
584	 */
585	priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len;
586
587	wiphy = wiphy_new(&mac80211_config_ops, priv_size);
588
589	if (!wiphy)
590		return NULL;
591
592	wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes;
593
594	wiphy->privid = mac80211_wiphy_privid;
595
596	wiphy->flags |= WIPHY_FLAG_NETNS_OK |
597			WIPHY_FLAG_4ADDR_AP |
598			WIPHY_FLAG_4ADDR_STATION |
599			WIPHY_FLAG_REPORTS_OBSS |
600			WIPHY_FLAG_OFFCHAN_TX;
601
602	if (ops->remain_on_channel)
603		wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
604
605	wiphy->features |= NL80211_FEATURE_SK_TX_STATUS |
606			   NL80211_FEATURE_SAE |
607			   NL80211_FEATURE_HT_IBSS |
608			   NL80211_FEATURE_VIF_TXPOWER;
609
610	if (!ops->hw_scan)
611		wiphy->features |= NL80211_FEATURE_LOW_PRIORITY_SCAN |
612				   NL80211_FEATURE_AP_SCAN;
613
614
615	if (!ops->set_key)
616		wiphy->flags |= WIPHY_FLAG_IBSS_RSN;
617
618	wiphy->bss_priv_size = sizeof(struct ieee80211_bss);
619
620	local = wiphy_priv(wiphy);
621
622	local->hw.wiphy = wiphy;
623
624	local->hw.priv = (char *)local + ALIGN(sizeof(*local), NETDEV_ALIGN);
625
626	local->ops = ops;
627	local->use_chanctx = use_chanctx;
628
629	/* set up some defaults */
630	local->hw.queues = 1;
631	local->hw.max_rates = 1;
632	local->hw.max_report_rates = 0;
633	local->hw.max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
634	local->hw.max_tx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
635	local->hw.offchannel_tx_hw_queue = IEEE80211_INVAL_HW_QUEUE;
636	local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
637	local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
638	local->hw.radiotap_mcs_details = IEEE80211_RADIOTAP_MCS_HAVE_MCS |
639					 IEEE80211_RADIOTAP_MCS_HAVE_GI |
640					 IEEE80211_RADIOTAP_MCS_HAVE_BW;
641	local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
642	wiphy->ht_capa_mod_mask = &mac80211_ht_capa_mod_mask;
643
644	INIT_LIST_HEAD(&local->interfaces);
645
646	__hw_addr_init(&local->mc_list);
647
648	mutex_init(&local->iflist_mtx);
649	mutex_init(&local->mtx);
650
651	mutex_init(&local->key_mtx);
652	spin_lock_init(&local->filter_lock);
653	spin_lock_init(&local->queue_stop_reason_lock);
654
655	INIT_LIST_HEAD(&local->chanctx_list);
656	mutex_init(&local->chanctx_mtx);
657
658	/*
659	 * The rx_skb_queue is only accessed from tasklets,
660	 * but other SKB queues are used from within IRQ
661	 * context. Therefore, this one needs a different
662	 * locking class so our direct, non-irq-safe use of
663	 * the queue's lock doesn't throw lockdep warnings.
664	 */
665	skb_queue_head_init_class(&local->rx_skb_queue,
666				  &ieee80211_rx_skb_queue_class);
667
668	INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);
669
670	INIT_WORK(&local->restart_work, ieee80211_restart_work);
671
672	INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter);
673	local->smps_mode = IEEE80211_SMPS_OFF;
674
675	INIT_WORK(&local->dynamic_ps_enable_work,
676		  ieee80211_dynamic_ps_enable_work);
677	INIT_WORK(&local->dynamic_ps_disable_work,
678		  ieee80211_dynamic_ps_disable_work);
679	setup_timer(&local->dynamic_ps_timer,
680		    ieee80211_dynamic_ps_timer, (unsigned long) local);
681
682	INIT_WORK(&local->sched_scan_stopped_work,
683		  ieee80211_sched_scan_stopped_work);
684
685	spin_lock_init(&local->ack_status_lock);
686	idr_init(&local->ack_status_frames);
687	/* preallocate at least one entry */
688	idr_pre_get(&local->ack_status_frames, GFP_KERNEL);
689
690	sta_info_init(local);
691
692	for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
693		skb_queue_head_init(&local->pending[i]);
694		atomic_set(&local->agg_queue_stop[i], 0);
695	}
696	tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
697		     (unsigned long)local);
698
699	tasklet_init(&local->tasklet,
700		     ieee80211_tasklet_handler,
701		     (unsigned long) local);
702
703	skb_queue_head_init(&local->skb_queue);
704	skb_queue_head_init(&local->skb_queue_unreliable);
705
706	/* init dummy netdev for use w/ NAPI */
707	init_dummy_netdev(&local->napi_dev);
708
709	ieee80211_led_names(local);
710
711	ieee80211_roc_setup(local);
712
713	return &local->hw;
714}
715EXPORT_SYMBOL(ieee80211_alloc_hw);
716
717int ieee80211_register_hw(struct ieee80211_hw *hw)
718{
719	struct ieee80211_local *local = hw_to_local(hw);
720	int result, i;
721	enum ieee80211_band band;
722	int channels, max_bitrates;
723	bool supp_ht, supp_vht;
724	netdev_features_t feature_whitelist;
725	static const u32 cipher_suites[] = {
726		/* keep WEP first, it may be removed below */
727		WLAN_CIPHER_SUITE_WEP40,
728		WLAN_CIPHER_SUITE_WEP104,
729		WLAN_CIPHER_SUITE_TKIP,
730		WLAN_CIPHER_SUITE_CCMP,
731
732		/* keep last -- depends on hw flags! */
733		WLAN_CIPHER_SUITE_AES_CMAC
734	};
735
736	if (hw->flags & IEEE80211_HW_QUEUE_CONTROL &&
737	    (local->hw.offchannel_tx_hw_queue == IEEE80211_INVAL_HW_QUEUE ||
738	     local->hw.offchannel_tx_hw_queue >= local->hw.queues))
739		return -EINVAL;
740
741#ifdef CONFIG_PM
742	if ((hw->wiphy->wowlan.flags || hw->wiphy->wowlan.n_patterns) &&
743	    (!local->ops->suspend || !local->ops->resume))
744		return -EINVAL;
745#endif
746
747	if ((hw->flags & IEEE80211_HW_SCAN_WHILE_IDLE) && !local->ops->hw_scan)
748		return -EINVAL;
749
750	if (!local->use_chanctx) {
751		for (i = 0; i < local->hw.wiphy->n_iface_combinations; i++) {
752			const struct ieee80211_iface_combination *comb;
753
754			comb = &local->hw.wiphy->iface_combinations[i];
755
756			if (comb->num_different_channels > 1)
757				return -EINVAL;
758		}
759	} else {
760		/*
761		 * WDS is currently prohibited when channel contexts are used
762		 * because there's no clear definition of which channel WDS
763		 * type interfaces use
764		 */
765		if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_WDS))
766			return -EINVAL;
767	}
768
769	/* Only HW csum features are currently compatible with mac80211 */
770	feature_whitelist = NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
771			    NETIF_F_HW_CSUM;
772	if (WARN_ON(hw->netdev_features & ~feature_whitelist))
773		return -EINVAL;
774
775	if (hw->max_report_rates == 0)
776		hw->max_report_rates = hw->max_rates;
777
778	local->rx_chains = 1;
779
780	/*
781	 * generic code guarantees at least one band,
782	 * set this very early because much code assumes
783	 * that hw.conf.channel is assigned
784	 */
785	channels = 0;
786	max_bitrates = 0;
787	supp_ht = false;
788	supp_vht = false;
789	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
790		struct ieee80211_supported_band *sband;
791
792		sband = local->hw.wiphy->bands[band];
793		if (!sband)
794			continue;
795		if (!local->use_chanctx && !local->_oper_channel) {
796			/* init channel we're on */
797			local->hw.conf.channel =
798			local->_oper_channel = &sband->channels[0];
799			local->hw.conf.channel_type = NL80211_CHAN_NO_HT;
800		}
801		cfg80211_chandef_create(&local->monitor_chandef,
802					&sband->channels[0],
803					NL80211_CHAN_NO_HT);
804		channels += sband->n_channels;
805
806		if (max_bitrates < sband->n_bitrates)
807			max_bitrates = sband->n_bitrates;
808		supp_ht = supp_ht || sband->ht_cap.ht_supported;
809		supp_vht = supp_vht || sband->vht_cap.vht_supported;
810
811		if (sband->ht_cap.ht_supported)
812			local->rx_chains =
813				max(ieee80211_mcs_to_chains(&sband->ht_cap.mcs),
814				    local->rx_chains);
815
816		/* TODO: consider VHT for RX chains, hopefully it's the same */
817	}
818
819	local->int_scan_req = kzalloc(sizeof(*local->int_scan_req) +
820				      sizeof(void *) * channels, GFP_KERNEL);
821	if (!local->int_scan_req)
822		return -ENOMEM;
823
824	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
825		if (!local->hw.wiphy->bands[band])
826			continue;
827		local->int_scan_req->rates[band] = (u32) -1;
828	}
829
830	/* if low-level driver supports AP, we also support VLAN */
831	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP)) {
832		hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN);
833		hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_AP_VLAN);
834	}
835
836	/* mac80211 always supports monitor */
837	hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR);
838	hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR);
839
840	/* mac80211 doesn't support more than one IBSS interface right now */
841	for (i = 0; i < hw->wiphy->n_iface_combinations; i++) {
842		const struct ieee80211_iface_combination *c;
843		int j;
844
845		c = &hw->wiphy->iface_combinations[i];
846
847		for (j = 0; j < c->n_limits; j++)
848			if ((c->limits[j].types & BIT(NL80211_IFTYPE_ADHOC)) &&
849			    c->limits[j].max > 1)
850				return -EINVAL;
851	}
852
853#ifndef CONFIG_MAC80211_MESH
854	/* mesh depends on Kconfig, but drivers should set it if they want */
855	local->hw.wiphy->interface_modes &= ~BIT(NL80211_IFTYPE_MESH_POINT);
856#endif
857
858	/* if the underlying driver supports mesh, mac80211 will (at least)
859	 * provide routing of mesh authentication frames to userspace */
860	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_MESH_POINT))
861		local->hw.wiphy->flags |= WIPHY_FLAG_MESH_AUTH;
862
863	/* mac80211 supports control port protocol changing */
864	local->hw.wiphy->flags |= WIPHY_FLAG_CONTROL_PORT_PROTOCOL;
865
866	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
867		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
868	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
869		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC;
870
871	WARN((local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)
872	     && (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK),
873	     "U-APSD not supported with HW_PS_NULLFUNC_STACK\n");
874
875	/*
876	 * Calculate scan IE length -- we need this to alloc
877	 * memory and to subtract from the driver limit. It
878	 * includes the DS Params, (extended) supported rates, and HT
879	 * information -- SSID is the driver's responsibility.
880	 */
881	local->scan_ies_len = 4 + max_bitrates /* (ext) supp rates */ +
882		3 /* DS Params */;
883	if (supp_ht)
884		local->scan_ies_len += 2 + sizeof(struct ieee80211_ht_cap);
885
886	if (supp_vht) {
887		local->scan_ies_len +=
888			2 + sizeof(struct ieee80211_vht_cap);
889
890		/*
891		 * (for now at least), drivers wanting to use VHT must
892		 * support channel contexts, as they contain all the
893		 * necessary VHT information and the global hw config
894		 * doesn't (yet)
895		 */
896		if (WARN_ON(!local->use_chanctx)) {
897			result = -EINVAL;
898			goto fail_wiphy_register;
899		}
900	}
901
902	if (!local->ops->hw_scan) {
903		/* For hw_scan, driver needs to set these up. */
904		local->hw.wiphy->max_scan_ssids = 4;
905		local->hw.wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN;
906	}
907
908	/*
909	 * If the driver supports any scan IEs, then assume the
910	 * limit includes the IEs mac80211 will add, otherwise
911	 * leave it at zero and let the driver sort it out; we
912	 * still pass our IEs to the driver but userspace will
913	 * not be allowed to in that case.
914	 */
915	if (local->hw.wiphy->max_scan_ie_len)
916		local->hw.wiphy->max_scan_ie_len -= local->scan_ies_len;
917
918	/* Set up cipher suites unless driver already did */
919	if (!local->hw.wiphy->cipher_suites) {
920		local->hw.wiphy->cipher_suites = cipher_suites;
921		local->hw.wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
922		if (!(local->hw.flags & IEEE80211_HW_MFP_CAPABLE))
923			local->hw.wiphy->n_cipher_suites--;
924	}
925	if (IS_ERR(local->wep_tx_tfm) || IS_ERR(local->wep_rx_tfm)) {
926		if (local->hw.wiphy->cipher_suites == cipher_suites) {
927			local->hw.wiphy->cipher_suites += 2;
928			local->hw.wiphy->n_cipher_suites -= 2;
929		} else {
930			u32 *suites;
931			int r, w = 0;
932
933			/* Filter out WEP */
934
935			suites = kmemdup(
936				local->hw.wiphy->cipher_suites,
937				sizeof(u32) * local->hw.wiphy->n_cipher_suites,
938				GFP_KERNEL);
939			if (!suites)
940				return -ENOMEM;
941			for (r = 0; r < local->hw.wiphy->n_cipher_suites; r++) {
942				u32 suite = local->hw.wiphy->cipher_suites[r];
943				if (suite == WLAN_CIPHER_SUITE_WEP40 ||
944				    suite == WLAN_CIPHER_SUITE_WEP104)
945					continue;
946				suites[w++] = suite;
947			}
948			local->hw.wiphy->cipher_suites = suites;
949			local->hw.wiphy->n_cipher_suites = w;
950			local->wiphy_ciphers_allocated = true;
951		}
952	}
953
954	if (!local->ops->remain_on_channel)
955		local->hw.wiphy->max_remain_on_channel_duration = 5000;
956
957	if (local->ops->sched_scan_start)
958		local->hw.wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN;
959
960	/* mac80211 based drivers don't support internal TDLS setup */
961	if (local->hw.wiphy->flags & WIPHY_FLAG_SUPPORTS_TDLS)
962		local->hw.wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP;
963
964	result = wiphy_register(local->hw.wiphy);
965	if (result < 0)
966		goto fail_wiphy_register;
967
968	/*
969	 * We use the number of queues for feature tests (QoS, HT) internally
970	 * so restrict them appropriately.
971	 */
972	if (hw->queues > IEEE80211_MAX_QUEUES)
973		hw->queues = IEEE80211_MAX_QUEUES;
974
975	local->workqueue =
976		alloc_ordered_workqueue(wiphy_name(local->hw.wiphy), 0);
977	if (!local->workqueue) {
978		result = -ENOMEM;
979		goto fail_workqueue;
980	}
981
982	/*
983	 * The hardware needs headroom for sending the frame,
984	 * and we need some headroom for passing the frame to monitor
985	 * interfaces, but never both at the same time.
986	 */
987	local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom,
988				   IEEE80211_TX_STATUS_HEADROOM);
989
990	debugfs_hw_add(local);
991
992	/*
993	 * if the driver doesn't specify a max listen interval we
994	 * use 5 which should be a safe default
995	 */
996	if (local->hw.max_listen_interval == 0)
997		local->hw.max_listen_interval = 5;
998
999	local->hw.conf.listen_interval = local->hw.max_listen_interval;
1000
1001	local->dynamic_ps_forced_timeout = -1;
1002
1003	result = ieee80211_wep_init(local);
1004	if (result < 0)
1005		wiphy_debug(local->hw.wiphy, "Failed to initialize wep: %d\n",
1006			    result);
1007
1008	ieee80211_led_init(local);
1009
1010	rtnl_lock();
1011
1012	result = ieee80211_init_rate_ctrl_alg(local,
1013					      hw->rate_control_algorithm);
1014	if (result < 0) {
1015		wiphy_debug(local->hw.wiphy,
1016			    "Failed to initialize rate control algorithm\n");
1017		goto fail_rate;
1018	}
1019
1020	/* add one default STA interface if supported */
1021	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_STATION)) {
1022		result = ieee80211_if_add(local, "wlan%d", NULL,
1023					  NL80211_IFTYPE_STATION, NULL);
1024		if (result)
1025			wiphy_warn(local->hw.wiphy,
1026				   "Failed to add default virtual iface\n");
1027	}
1028
1029	rtnl_unlock();
1030
1031	local->network_latency_notifier.notifier_call =
1032		ieee80211_max_network_latency;
1033	result = pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY,
1034				     &local->network_latency_notifier);
1035	if (result) {
1036		rtnl_lock();
1037		goto fail_pm_qos;
1038	}
1039
1040#ifdef CONFIG_INET
1041	local->ifa_notifier.notifier_call = ieee80211_ifa_changed;
1042	result = register_inetaddr_notifier(&local->ifa_notifier);
1043	if (result)
1044		goto fail_ifa;
1045#endif
1046
1047	netif_napi_add(&local->napi_dev, &local->napi, ieee80211_napi_poll,
1048			local->hw.napi_weight);
1049
1050	return 0;
1051
1052#ifdef CONFIG_INET
1053 fail_ifa:
1054	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
1055			       &local->network_latency_notifier);
1056	rtnl_lock();
1057#endif
1058 fail_pm_qos:
1059	ieee80211_led_exit(local);
1060	ieee80211_remove_interfaces(local);
1061 fail_rate:
1062	rtnl_unlock();
1063	ieee80211_wep_free(local);
1064	sta_info_stop(local);
1065	destroy_workqueue(local->workqueue);
1066 fail_workqueue:
1067	wiphy_unregister(local->hw.wiphy);
1068 fail_wiphy_register:
1069	if (local->wiphy_ciphers_allocated)
1070		kfree(local->hw.wiphy->cipher_suites);
1071	kfree(local->int_scan_req);
1072	return result;
1073}
1074EXPORT_SYMBOL(ieee80211_register_hw);
1075
1076void ieee80211_unregister_hw(struct ieee80211_hw *hw)
1077{
1078	struct ieee80211_local *local = hw_to_local(hw);
1079
1080	tasklet_kill(&local->tx_pending_tasklet);
1081	tasklet_kill(&local->tasklet);
1082
1083	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
1084			       &local->network_latency_notifier);
1085#ifdef CONFIG_INET
1086	unregister_inetaddr_notifier(&local->ifa_notifier);
1087#endif
1088
1089	rtnl_lock();
1090
1091	/*
1092	 * At this point, interface list manipulations are fine
1093	 * because the driver cannot be handing us frames any
1094	 * more and the tasklet is killed.
1095	 */
1096	ieee80211_remove_interfaces(local);
1097
1098	rtnl_unlock();
1099
1100	cancel_work_sync(&local->restart_work);
1101	cancel_work_sync(&local->reconfig_filter);
1102
1103	ieee80211_clear_tx_pending(local);
1104	rate_control_deinitialize(local);
1105
1106	if (skb_queue_len(&local->skb_queue) ||
1107	    skb_queue_len(&local->skb_queue_unreliable))
1108		wiphy_warn(local->hw.wiphy, "skb_queue not empty\n");
1109	skb_queue_purge(&local->skb_queue);
1110	skb_queue_purge(&local->skb_queue_unreliable);
1111	skb_queue_purge(&local->rx_skb_queue);
1112
1113	destroy_workqueue(local->workqueue);
1114	wiphy_unregister(local->hw.wiphy);
1115	sta_info_stop(local);
1116	ieee80211_wep_free(local);
1117	ieee80211_led_exit(local);
1118	kfree(local->int_scan_req);
1119}
1120EXPORT_SYMBOL(ieee80211_unregister_hw);
1121
1122static int ieee80211_free_ack_frame(int id, void *p, void *data)
1123{
1124	WARN_ONCE(1, "Have pending ack frames!\n");
1125	kfree_skb(p);
1126	return 0;
1127}
1128
1129void ieee80211_free_hw(struct ieee80211_hw *hw)
1130{
1131	struct ieee80211_local *local = hw_to_local(hw);
1132
1133	mutex_destroy(&local->iflist_mtx);
1134	mutex_destroy(&local->mtx);
1135
1136	if (local->wiphy_ciphers_allocated)
1137		kfree(local->hw.wiphy->cipher_suites);
1138
1139	idr_for_each(&local->ack_status_frames,
1140		     ieee80211_free_ack_frame, NULL);
1141	idr_destroy(&local->ack_status_frames);
1142
1143	wiphy_free(local->hw.wiphy);
1144}
1145EXPORT_SYMBOL(ieee80211_free_hw);
1146
1147static int __init ieee80211_init(void)
1148{
1149	struct sk_buff *skb;
1150	int ret;
1151
1152	BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb));
1153	BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) +
1154		     IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb));
1155
1156	ret = rc80211_minstrel_init();
1157	if (ret)
1158		return ret;
1159
1160	ret = rc80211_minstrel_ht_init();
1161	if (ret)
1162		goto err_minstrel;
1163
1164	ret = rc80211_pid_init();
1165	if (ret)
1166		goto err_pid;
1167
1168	ret = ieee80211_iface_init();
1169	if (ret)
1170		goto err_netdev;
1171
1172	return 0;
1173 err_netdev:
1174	rc80211_pid_exit();
1175 err_pid:
1176	rc80211_minstrel_ht_exit();
1177 err_minstrel:
1178	rc80211_minstrel_exit();
1179
1180	return ret;
1181}
1182
1183static void __exit ieee80211_exit(void)
1184{
1185	rc80211_pid_exit();
1186	rc80211_minstrel_ht_exit();
1187	rc80211_minstrel_exit();
1188
1189	if (mesh_allocated)
1190		ieee80211s_stop();
1191
1192	ieee80211_iface_exit();
1193
1194	rcu_barrier();
1195}
1196
1197
1198subsys_initcall(ieee80211_init);
1199module_exit(ieee80211_exit);
1200
1201MODULE_DESCRIPTION("IEEE 802.11 subsystem");
1202MODULE_LICENSE("GPL");
1203