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