xref: /openbmc/linux/net/mac80211/sta_info.c (revision fa962b92120bb70693a4db545f89067eb3373294)
1f0706e82SJiri Benc /*
2f0706e82SJiri Benc  * Copyright 2002-2005, Instant802 Networks, Inc.
3f0706e82SJiri Benc  * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
4d98ad83eSJohannes Berg  * Copyright 2013-2014  Intel Mobile Communications GmbH
5f59374ebSSara Sharon  * Copyright (C) 2015 - 2016 Intel Deutschland GmbH
6f0706e82SJiri Benc  *
7f0706e82SJiri Benc  * This program is free software; you can redistribute it and/or modify
8f0706e82SJiri Benc  * it under the terms of the GNU General Public License version 2 as
9f0706e82SJiri Benc  * published by the Free Software Foundation.
10f0706e82SJiri Benc  */
11f0706e82SJiri Benc 
12f0706e82SJiri Benc #include <linux/module.h>
13f0706e82SJiri Benc #include <linux/init.h>
14888d04dfSFelix Fietkau #include <linux/etherdevice.h>
15f0706e82SJiri Benc #include <linux/netdevice.h>
16f0706e82SJiri Benc #include <linux/types.h>
17f0706e82SJiri Benc #include <linux/slab.h>
18f0706e82SJiri Benc #include <linux/skbuff.h>
19f0706e82SJiri Benc #include <linux/if_arp.h>
200d174406SJohannes Berg #include <linux/timer.h>
21d0709a65SJohannes Berg #include <linux/rtnetlink.h>
22f0706e82SJiri Benc 
23f0706e82SJiri Benc #include <net/mac80211.h>
24f0706e82SJiri Benc #include "ieee80211_i.h"
2524487981SJohannes Berg #include "driver-ops.h"
262c8dccc7SJohannes Berg #include "rate.h"
27f0706e82SJiri Benc #include "sta_info.h"
28e9f207f0SJiri Benc #include "debugfs_sta.h"
29ee385855SLuis Carlos Cobo #include "mesh.h"
30ce662b44SJohannes Berg #include "wme.h"
31f0706e82SJiri Benc 
32d0709a65SJohannes Berg /**
33d0709a65SJohannes Berg  * DOC: STA information lifetime rules
34d0709a65SJohannes Berg  *
35d0709a65SJohannes Berg  * STA info structures (&struct sta_info) are managed in a hash table
36d0709a65SJohannes Berg  * for faster lookup and a list for iteration. They are managed using
37d0709a65SJohannes Berg  * RCU, i.e. access to the list and hash table is protected by RCU.
38d0709a65SJohannes Berg  *
3934e89507SJohannes Berg  * Upon allocating a STA info structure with sta_info_alloc(), the caller
4034e89507SJohannes Berg  * owns that structure. It must then insert it into the hash table using
4134e89507SJohannes Berg  * either sta_info_insert() or sta_info_insert_rcu(); only in the latter
4234e89507SJohannes Berg  * case (which acquires an rcu read section but must not be called from
4334e89507SJohannes Berg  * within one) will the pointer still be valid after the call. Note that
4434e89507SJohannes Berg  * the caller may not do much with the STA info before inserting it, in
4534e89507SJohannes Berg  * particular, it may not start any mesh peer link management or add
4634e89507SJohannes Berg  * encryption keys.
4793e5deb1SJohannes Berg  *
4893e5deb1SJohannes Berg  * When the insertion fails (sta_info_insert()) returns non-zero), the
4993e5deb1SJohannes Berg  * structure will have been freed by sta_info_insert()!
50d0709a65SJohannes Berg  *
5134e89507SJohannes Berg  * Station entries are added by mac80211 when you establish a link with a
527e189a12SLuis R. Rodriguez  * peer. This means different things for the different type of interfaces
537e189a12SLuis R. Rodriguez  * we support. For a regular station this mean we add the AP sta when we
5425985edcSLucas De Marchi  * receive an association response from the AP. For IBSS this occurs when
5534e89507SJohannes Berg  * get to know about a peer on the same IBSS. For WDS we add the sta for
5625985edcSLucas De Marchi  * the peer immediately upon device open. When using AP mode we add stations
5734e89507SJohannes Berg  * for each respective station upon request from userspace through nl80211.
587e189a12SLuis R. Rodriguez  *
5934e89507SJohannes Berg  * In order to remove a STA info structure, various sta_info_destroy_*()
6034e89507SJohannes Berg  * calls are available.
61d0709a65SJohannes Berg  *
6234e89507SJohannes Berg  * There is no concept of ownership on a STA entry, each structure is
6334e89507SJohannes Berg  * owned by the global hash table/list until it is removed. All users of
6434e89507SJohannes Berg  * the structure need to be RCU protected so that the structure won't be
6534e89507SJohannes Berg  * freed before they are done using it.
66d0709a65SJohannes Berg  */
67f0706e82SJiri Benc 
687bedd0cfSJohannes Berg static const struct rhashtable_params sta_rht_params = {
697bedd0cfSJohannes Berg 	.nelem_hint = 3, /* start small */
70b6bf8c68SBen Greear 	.insecure_elasticity = true, /* Disable chain-length checks. */
71caf22d31SJohannes Berg 	.automatic_shrinking = true,
727bedd0cfSJohannes Berg 	.head_offset = offsetof(struct sta_info, hash_node),
73ac100ce5SJohannes Berg 	.key_offset = offsetof(struct sta_info, addr),
747bedd0cfSJohannes Berg 	.key_len = ETH_ALEN,
757bedd0cfSJohannes Berg 	.hashfn = sta_addr_hash,
76ebd82b39SJohannes Berg 	.max_size = CONFIG_MAC80211_STA_HASH_MAX_SIZE,
777bedd0cfSJohannes Berg };
787bedd0cfSJohannes Berg 
794d33960bSJohannes Berg /* Caller must hold local->sta_mtx */
80be8755e1SMichael Wu static int sta_info_hash_del(struct ieee80211_local *local,
81f0706e82SJiri Benc 			     struct sta_info *sta)
82f0706e82SJiri Benc {
837bedd0cfSJohannes Berg 	return rhashtable_remove_fast(&local->sta_hash, &sta->hash_node,
847bedd0cfSJohannes Berg 				      sta_rht_params);
85f0706e82SJiri Benc }
86f0706e82SJiri Benc 
875108ca82SJohannes Berg static void __cleanup_single_sta(struct sta_info *sta)
88b22cfcfcSEliad Peller {
89b22cfcfcSEliad Peller 	int ac, i;
90b22cfcfcSEliad Peller 	struct tid_ampdu_tx *tid_tx;
91b22cfcfcSEliad Peller 	struct ieee80211_sub_if_data *sdata = sta->sdata;
92b22cfcfcSEliad Peller 	struct ieee80211_local *local = sdata->local;
93*fa962b92SMichal Kazior 	struct fq *fq = &local->fq;
94d012a605SMarco Porsch 	struct ps_data *ps;
95b22cfcfcSEliad Peller 
96e3685e03SJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_PS_STA) ||
975ac2e350SJohannes Berg 	    test_sta_flag(sta, WLAN_STA_PS_DRIVER) ||
985ac2e350SJohannes Berg 	    test_sta_flag(sta, WLAN_STA_PS_DELIVER)) {
99d012a605SMarco Porsch 		if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
100d012a605SMarco Porsch 		    sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
101d012a605SMarco Porsch 			ps = &sdata->bss->ps;
1023f52b7e3SMarco Porsch 		else if (ieee80211_vif_is_mesh(&sdata->vif))
1033f52b7e3SMarco Porsch 			ps = &sdata->u.mesh.ps;
104d012a605SMarco Porsch 		else
105d012a605SMarco Porsch 			return;
106b22cfcfcSEliad Peller 
107b22cfcfcSEliad Peller 		clear_sta_flag(sta, WLAN_STA_PS_STA);
108e3685e03SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
1095ac2e350SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DELIVER);
110b22cfcfcSEliad Peller 
111d012a605SMarco Porsch 		atomic_dec(&ps->num_sta_ps);
112b22cfcfcSEliad Peller 	}
113b22cfcfcSEliad Peller 
114ba8c3d6fSFelix Fietkau 	if (sta->sta.txq[0]) {
115ba8c3d6fSFelix Fietkau 		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
116ba8c3d6fSFelix Fietkau 			struct txq_info *txqi = to_txq_info(sta->sta.txq[i]);
117ba8c3d6fSFelix Fietkau 
118*fa962b92SMichal Kazior 			spin_lock_bh(&fq->lock);
119*fa962b92SMichal Kazior 			ieee80211_txq_purge(local, txqi);
120*fa962b92SMichal Kazior 			spin_unlock_bh(&fq->lock);
121ba8c3d6fSFelix Fietkau 		}
122ba8c3d6fSFelix Fietkau 	}
123ba8c3d6fSFelix Fietkau 
124b22cfcfcSEliad Peller 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
125b22cfcfcSEliad Peller 		local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]);
1261f98ab7fSFelix Fietkau 		ieee80211_purge_tx_queue(&local->hw, &sta->ps_tx_buf[ac]);
1271f98ab7fSFelix Fietkau 		ieee80211_purge_tx_queue(&local->hw, &sta->tx_filtered[ac]);
128b22cfcfcSEliad Peller 	}
129b22cfcfcSEliad Peller 
13045b5028eSThomas Pedersen 	if (ieee80211_vif_is_mesh(&sdata->vif))
13145b5028eSThomas Pedersen 		mesh_sta_cleanup(sta);
132b22cfcfcSEliad Peller 
1335ac2e350SJohannes Berg 	cancel_work_sync(&sta->drv_deliver_wk);
134b22cfcfcSEliad Peller 
135b22cfcfcSEliad Peller 	/*
136b22cfcfcSEliad Peller 	 * Destroy aggregation state here. It would be nice to wait for the
137b22cfcfcSEliad Peller 	 * driver to finish aggregation stop and then clean up, but for now
138b22cfcfcSEliad Peller 	 * drivers have to handle aggregation stop being requested, followed
139b22cfcfcSEliad Peller 	 * directly by station destruction.
140b22cfcfcSEliad Peller 	 */
1415a306f58SJohannes Berg 	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
142661eb381SJohannes Berg 		kfree(sta->ampdu_mlme.tid_start_tx[i]);
143b22cfcfcSEliad Peller 		tid_tx = rcu_dereference_raw(sta->ampdu_mlme.tid_tx[i]);
144b22cfcfcSEliad Peller 		if (!tid_tx)
145b22cfcfcSEliad Peller 			continue;
1461f98ab7fSFelix Fietkau 		ieee80211_purge_tx_queue(&local->hw, &tid_tx->pending);
147b22cfcfcSEliad Peller 		kfree(tid_tx);
148b22cfcfcSEliad Peller 	}
1495108ca82SJohannes Berg }
150b22cfcfcSEliad Peller 
1515108ca82SJohannes Berg static void cleanup_single_sta(struct sta_info *sta)
1525108ca82SJohannes Berg {
1535108ca82SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1545108ca82SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1555108ca82SJohannes Berg 
1565108ca82SJohannes Berg 	__cleanup_single_sta(sta);
157b22cfcfcSEliad Peller 	sta_info_free(local, sta);
158b22cfcfcSEliad Peller }
159b22cfcfcSEliad Peller 
160d0709a65SJohannes Berg /* protected by RCU */
161abe60632SJohannes Berg struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata,
162abe60632SJohannes Berg 			      const u8 *addr)
16343ba7e95SJohannes Berg {
164abe60632SJohannes Berg 	struct ieee80211_local *local = sdata->local;
16560f4b626SJohannes Berg 	struct sta_info *sta;
16660f4b626SJohannes Berg 	struct rhash_head *tmp;
16760f4b626SJohannes Berg 	const struct bucket_table *tbl;
16843ba7e95SJohannes Berg 
16960f4b626SJohannes Berg 	rcu_read_lock();
17060f4b626SJohannes Berg 	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);
17160f4b626SJohannes Berg 
17260f4b626SJohannes Berg 	for_each_sta_info(local, tbl, addr, sta, tmp) {
17360f4b626SJohannes Berg 		if (sta->sdata == sdata) {
17460f4b626SJohannes Berg 			rcu_read_unlock();
17560f4b626SJohannes Berg 			/* this is safe as the caller must already hold
17660f4b626SJohannes Berg 			 * another rcu read section or the mutex
17760f4b626SJohannes Berg 			 */
17860f4b626SJohannes Berg 			return sta;
17960f4b626SJohannes Berg 		}
18060f4b626SJohannes Berg 	}
18160f4b626SJohannes Berg 	rcu_read_unlock();
18260f4b626SJohannes Berg 	return NULL;
18343ba7e95SJohannes Berg }
18443ba7e95SJohannes Berg 
1850e5ded5aSFelix Fietkau /*
1860e5ded5aSFelix Fietkau  * Get sta info either from the specified interface
1870e5ded5aSFelix Fietkau  * or from one of its vlans
1880e5ded5aSFelix Fietkau  */
1890e5ded5aSFelix Fietkau struct sta_info *sta_info_get_bss(struct ieee80211_sub_if_data *sdata,
1900e5ded5aSFelix Fietkau 				  const u8 *addr)
1910e5ded5aSFelix Fietkau {
1920e5ded5aSFelix Fietkau 	struct ieee80211_local *local = sdata->local;
1930e5ded5aSFelix Fietkau 	struct sta_info *sta;
1947bedd0cfSJohannes Berg 	struct rhash_head *tmp;
1957bedd0cfSJohannes Berg 	const struct bucket_table *tbl;
1960e5ded5aSFelix Fietkau 
1977bedd0cfSJohannes Berg 	rcu_read_lock();
1987bedd0cfSJohannes Berg 	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);
1997bedd0cfSJohannes Berg 
2007bedd0cfSJohannes Berg 	for_each_sta_info(local, tbl, addr, sta, tmp) {
2017bedd0cfSJohannes Berg 		if (sta->sdata == sdata ||
2027bedd0cfSJohannes Berg 		    (sta->sdata->bss && sta->sdata->bss == sdata->bss)) {
2037bedd0cfSJohannes Berg 			rcu_read_unlock();
2047bedd0cfSJohannes Berg 			/* this is safe as the caller must already hold
2057bedd0cfSJohannes Berg 			 * another rcu read section or the mutex
2067bedd0cfSJohannes Berg 			 */
2070e5ded5aSFelix Fietkau 			return sta;
2080e5ded5aSFelix Fietkau 		}
2097bedd0cfSJohannes Berg 	}
2107bedd0cfSJohannes Berg 	rcu_read_unlock();
2117bedd0cfSJohannes Berg 	return NULL;
2127bedd0cfSJohannes Berg }
2130e5ded5aSFelix Fietkau 
2143b53fde8SJohannes Berg struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata,
2153b53fde8SJohannes Berg 				     int idx)
216ee385855SLuis Carlos Cobo {
2173b53fde8SJohannes Berg 	struct ieee80211_local *local = sdata->local;
218ee385855SLuis Carlos Cobo 	struct sta_info *sta;
219ee385855SLuis Carlos Cobo 	int i = 0;
220ee385855SLuis Carlos Cobo 
221d0709a65SJohannes Berg 	list_for_each_entry_rcu(sta, &local->sta_list, list) {
2223b53fde8SJohannes Berg 		if (sdata != sta->sdata)
2232a8ca29aSLuis Carlos Cobo 			continue;
224ee385855SLuis Carlos Cobo 		if (i < idx) {
225ee385855SLuis Carlos Cobo 			++i;
226ee385855SLuis Carlos Cobo 			continue;
227ee385855SLuis Carlos Cobo 		}
2282a8ca29aSLuis Carlos Cobo 		return sta;
229ee385855SLuis Carlos Cobo 	}
230ee385855SLuis Carlos Cobo 
231ee385855SLuis Carlos Cobo 	return NULL;
232ee385855SLuis Carlos Cobo }
233f0706e82SJiri Benc 
23493e5deb1SJohannes Berg /**
235d9a7ddb0SJohannes Berg  * sta_info_free - free STA
23693e5deb1SJohannes Berg  *
2376ef307bcSRandy Dunlap  * @local: pointer to the global information
23893e5deb1SJohannes Berg  * @sta: STA info to free
23993e5deb1SJohannes Berg  *
24093e5deb1SJohannes Berg  * This function must undo everything done by sta_info_alloc()
241d9a7ddb0SJohannes Berg  * that may happen before sta_info_insert(). It may only be
242d9a7ddb0SJohannes Berg  * called when sta_info_insert() has not been attempted (and
243d9a7ddb0SJohannes Berg  * if that fails, the station is freed anyway.)
24493e5deb1SJohannes Berg  */
245d9a7ddb0SJohannes Berg void sta_info_free(struct ieee80211_local *local, struct sta_info *sta)
24693e5deb1SJohannes Berg {
247889cbb91SJohannes Berg 	if (sta->rate_ctrl)
2484b7679a5SJohannes Berg 		rate_control_free_sta(sta);
24993e5deb1SJohannes Berg 
250bdcbd8e0SJohannes Berg 	sta_dbg(sta->sdata, "Destroyed STA %pM\n", sta->sta.addr);
25193e5deb1SJohannes Berg 
252ba8c3d6fSFelix Fietkau 	if (sta->sta.txq[0])
253ba8c3d6fSFelix Fietkau 		kfree(to_txq_info(sta->sta.txq[0]));
25453d04525SFelix Fietkau 	kfree(rcu_dereference_raw(sta->sta.rates));
255433f5bc1SJohannes Berg #ifdef CONFIG_MAC80211_MESH
256433f5bc1SJohannes Berg 	kfree(sta->mesh);
257433f5bc1SJohannes Berg #endif
258c9c5962bSJohannes Berg 	free_percpu(sta->pcpu_rx_stats);
25993e5deb1SJohannes Berg 	kfree(sta);
26093e5deb1SJohannes Berg }
26193e5deb1SJohannes Berg 
2624d33960bSJohannes Berg /* Caller must hold local->sta_mtx */
26362b14b24SJohannes Berg static int sta_info_hash_add(struct ieee80211_local *local,
264d0709a65SJohannes Berg 			     struct sta_info *sta)
265f0706e82SJiri Benc {
26662b14b24SJohannes Berg 	return rhashtable_insert_fast(&local->sta_hash, &sta->hash_node,
2677bedd0cfSJohannes Berg 				      sta_rht_params);
268f0706e82SJiri Benc }
269f0706e82SJiri Benc 
2705ac2e350SJohannes Berg static void sta_deliver_ps_frames(struct work_struct *wk)
271af818581SJohannes Berg {
272af818581SJohannes Berg 	struct sta_info *sta;
273af818581SJohannes Berg 
2745ac2e350SJohannes Berg 	sta = container_of(wk, struct sta_info, drv_deliver_wk);
275af818581SJohannes Berg 
276af818581SJohannes Berg 	if (sta->dead)
277af818581SJohannes Berg 		return;
278af818581SJohannes Berg 
27954420473SHelmut Schaa 	local_bh_disable();
2805ac2e350SJohannes Berg 	if (!test_sta_flag(sta, WLAN_STA_PS_STA))
281af818581SJohannes Berg 		ieee80211_sta_ps_deliver_wakeup(sta);
2825ac2e350SJohannes Berg 	else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL))
283af818581SJohannes Berg 		ieee80211_sta_ps_deliver_poll_response(sta);
2845ac2e350SJohannes Berg 	else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD))
28547086fc5SJohannes Berg 		ieee80211_sta_ps_deliver_uapsd(sta);
286ce662b44SJohannes Berg 	local_bh_enable();
287af818581SJohannes Berg }
288af818581SJohannes Berg 
289af65cd96SJohannes Berg static int sta_prepare_rate_control(struct ieee80211_local *local,
290af65cd96SJohannes Berg 				    struct sta_info *sta, gfp_t gfp)
291af65cd96SJohannes Berg {
29230686bf7SJohannes Berg 	if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL))
293af65cd96SJohannes Berg 		return 0;
294af65cd96SJohannes Berg 
295889cbb91SJohannes Berg 	sta->rate_ctrl = local->rate_ctrl;
296af65cd96SJohannes Berg 	sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl,
29735c347acSJohannes Berg 						     sta, gfp);
298889cbb91SJohannes Berg 	if (!sta->rate_ctrl_priv)
299af65cd96SJohannes Berg 		return -ENOMEM;
300af65cd96SJohannes Berg 
301af65cd96SJohannes Berg 	return 0;
302af65cd96SJohannes Berg }
303af65cd96SJohannes Berg 
30473651ee6SJohannes Berg struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata,
30556544160SJohannes Berg 				const u8 *addr, gfp_t gfp)
306f0706e82SJiri Benc {
307d0709a65SJohannes Berg 	struct ieee80211_local *local = sdata->local;
308ba8c3d6fSFelix Fietkau 	struct ieee80211_hw *hw = &local->hw;
309f0706e82SJiri Benc 	struct sta_info *sta;
31016c5f15cSRon Rindjunsky 	int i;
311f0706e82SJiri Benc 
312ba8c3d6fSFelix Fietkau 	sta = kzalloc(sizeof(*sta) + hw->sta_data_size, gfp);
313f0706e82SJiri Benc 	if (!sta)
31473651ee6SJohannes Berg 		return NULL;
315f0706e82SJiri Benc 
316c9c5962bSJohannes Berg 	if (ieee80211_hw_check(hw, USES_RSS)) {
317c9c5962bSJohannes Berg 		sta->pcpu_rx_stats =
318c9c5962bSJohannes Berg 			alloc_percpu(struct ieee80211_sta_rx_stats);
319c9c5962bSJohannes Berg 		if (!sta->pcpu_rx_stats)
320c9c5962bSJohannes Berg 			goto free;
321c9c5962bSJohannes Berg 	}
322c9c5962bSJohannes Berg 
32307346f81SJohannes Berg 	spin_lock_init(&sta->lock);
3241d147bfaSEmmanuel Grumbach 	spin_lock_init(&sta->ps_lock);
3255ac2e350SJohannes Berg 	INIT_WORK(&sta->drv_deliver_wk, sta_deliver_ps_frames);
32667c282c0SJohannes Berg 	INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work);
327a93e3644SJohannes Berg 	mutex_init(&sta->ampdu_mlme.mtx);
32887f59c70SThomas Pedersen #ifdef CONFIG_MAC80211_MESH
329433f5bc1SJohannes Berg 	if (ieee80211_vif_is_mesh(&sdata->vif)) {
330433f5bc1SJohannes Berg 		sta->mesh = kzalloc(sizeof(*sta->mesh), gfp);
331433f5bc1SJohannes Berg 		if (!sta->mesh)
332433f5bc1SJohannes Berg 			goto free;
333433f5bc1SJohannes Berg 		spin_lock_init(&sta->mesh->plink_lock);
33487f59c70SThomas Pedersen 		if (ieee80211_vif_is_mesh(&sdata->vif) &&
33587f59c70SThomas Pedersen 		    !sdata->u.mesh.user_mpm)
336433f5bc1SJohannes Berg 			init_timer(&sta->mesh->plink_timer);
337433f5bc1SJohannes Berg 		sta->mesh->nonpeer_pm = NL80211_MESH_POWER_ACTIVE;
338433f5bc1SJohannes Berg 	}
33987f59c70SThomas Pedersen #endif
34007346f81SJohannes Berg 
341ac100ce5SJohannes Berg 	memcpy(sta->addr, addr, ETH_ALEN);
34217741cdcSJohannes Berg 	memcpy(sta->sta.addr, addr, ETH_ALEN);
343d0709a65SJohannes Berg 	sta->local = local;
344d0709a65SJohannes Berg 	sta->sdata = sdata;
345e5a9f8d0SJohannes Berg 	sta->rx_stats.last_rx = jiffies;
346f0706e82SJiri Benc 
3470f9c5a61SJohannes Berg 	u64_stats_init(&sta->rx_stats.syncp);
3480f9c5a61SJohannes Berg 
34971ec375cSJohannes Berg 	sta->sta_state = IEEE80211_STA_NONE;
35071ec375cSJohannes Berg 
351b6da911bSLiad Kaufman 	/* Mark TID as unreserved */
352b6da911bSLiad Kaufman 	sta->reserved_tid = IEEE80211_TID_UNRESERVED;
353b6da911bSLiad Kaufman 
35484b00607SArnd Bergmann 	sta->last_connected = ktime_get_seconds();
3550be6ed13SJohannes Berg 	ewma_signal_init(&sta->rx_stats_avg.signal);
3560be6ed13SJohannes Berg 	for (i = 0; i < ARRAY_SIZE(sta->rx_stats_avg.chain_signal); i++)
3570be6ed13SJohannes Berg 		ewma_signal_init(&sta->rx_stats_avg.chain_signal[i]);
358541a45a1SBruno Randolf 
359ba8c3d6fSFelix Fietkau 	if (local->ops->wake_tx_queue) {
360ba8c3d6fSFelix Fietkau 		void *txq_data;
361ba8c3d6fSFelix Fietkau 		int size = sizeof(struct txq_info) +
362ba8c3d6fSFelix Fietkau 			   ALIGN(hw->txq_data_size, sizeof(void *));
363ba8c3d6fSFelix Fietkau 
364ba8c3d6fSFelix Fietkau 		txq_data = kcalloc(ARRAY_SIZE(sta->sta.txq), size, gfp);
365ba8c3d6fSFelix Fietkau 		if (!txq_data)
366ba8c3d6fSFelix Fietkau 			goto free;
367ba8c3d6fSFelix Fietkau 
368ba8c3d6fSFelix Fietkau 		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
369ba8c3d6fSFelix Fietkau 			struct txq_info *txq = txq_data + i * size;
370ba8c3d6fSFelix Fietkau 
371*fa962b92SMichal Kazior 			ieee80211_txq_init(sdata, sta, txq, i);
372abfbc3afSJohannes Berg 		}
373ba8c3d6fSFelix Fietkau 	}
374ba8c3d6fSFelix Fietkau 
375ba8c3d6fSFelix Fietkau 	if (sta_prepare_rate_control(local, sta, gfp))
376ba8c3d6fSFelix Fietkau 		goto free_txq;
377f0706e82SJiri Benc 
3785a306f58SJohannes Berg 	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
379a622ab72SJohannes Berg 		/*
380a622ab72SJohannes Berg 		 * timer_to_tid must be initialized with identity mapping
381a622ab72SJohannes Berg 		 * to enable session_timer's data differentiation. See
382a622ab72SJohannes Berg 		 * sta_rx_agg_session_timer_expired for usage.
383a622ab72SJohannes Berg 		 */
38416c5f15cSRon Rindjunsky 		sta->timer_to_tid[i] = i;
38516c5f15cSRon Rindjunsky 	}
386948d887dSJohannes Berg 	for (i = 0; i < IEEE80211_NUM_ACS; i++) {
387948d887dSJohannes Berg 		skb_queue_head_init(&sta->ps_tx_buf[i]);
388948d887dSJohannes Berg 		skb_queue_head_init(&sta->tx_filtered[i]);
389948d887dSJohannes Berg 	}
39073651ee6SJohannes Berg 
3915a306f58SJohannes Berg 	for (i = 0; i < IEEE80211_NUM_TIDS; i++)
3924be929beSAlexey Dobriyan 		sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX);
393cccaec98SSenthil Balasubramanian 
394af0ed69bSJohannes Berg 	sta->sta.smps_mode = IEEE80211_SMPS_OFF;
395687da132SEmmanuel Grumbach 	if (sdata->vif.type == NL80211_IFTYPE_AP ||
396687da132SEmmanuel Grumbach 	    sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
397687da132SEmmanuel Grumbach 		struct ieee80211_supported_band *sband =
398ba8c3d6fSFelix Fietkau 			hw->wiphy->bands[ieee80211_get_sdata_band(sdata)];
399687da132SEmmanuel Grumbach 		u8 smps = (sband->ht_cap.cap & IEEE80211_HT_CAP_SM_PS) >>
400687da132SEmmanuel Grumbach 				IEEE80211_HT_CAP_SM_PS_SHIFT;
401687da132SEmmanuel Grumbach 		/*
402687da132SEmmanuel Grumbach 		 * Assume that hostapd advertises our caps in the beacon and
403687da132SEmmanuel Grumbach 		 * this is the known_smps_mode for a station that just assciated
404687da132SEmmanuel Grumbach 		 */
405687da132SEmmanuel Grumbach 		switch (smps) {
406687da132SEmmanuel Grumbach 		case WLAN_HT_SMPS_CONTROL_DISABLED:
407687da132SEmmanuel Grumbach 			sta->known_smps_mode = IEEE80211_SMPS_OFF;
408687da132SEmmanuel Grumbach 			break;
409687da132SEmmanuel Grumbach 		case WLAN_HT_SMPS_CONTROL_STATIC:
410687da132SEmmanuel Grumbach 			sta->known_smps_mode = IEEE80211_SMPS_STATIC;
411687da132SEmmanuel Grumbach 			break;
412687da132SEmmanuel Grumbach 		case WLAN_HT_SMPS_CONTROL_DYNAMIC:
413687da132SEmmanuel Grumbach 			sta->known_smps_mode = IEEE80211_SMPS_DYNAMIC;
414687da132SEmmanuel Grumbach 			break;
415687da132SEmmanuel Grumbach 		default:
416687da132SEmmanuel Grumbach 			WARN_ON(1);
417687da132SEmmanuel Grumbach 		}
418687da132SEmmanuel Grumbach 	}
419af0ed69bSJohannes Berg 
4206e0456b5SFelix Fietkau 	sta->sta.max_rc_amsdu_len = IEEE80211_MAX_MPDU_LEN_HT_BA;
4216e0456b5SFelix Fietkau 
422bdcbd8e0SJohannes Berg 	sta_dbg(sdata, "Allocated STA %pM\n", sta->sta.addr);
423ef04a297SJohannes Berg 
424abfbc3afSJohannes Berg 	return sta;
425ba8c3d6fSFelix Fietkau 
426ba8c3d6fSFelix Fietkau free_txq:
427ba8c3d6fSFelix Fietkau 	if (sta->sta.txq[0])
428ba8c3d6fSFelix Fietkau 		kfree(to_txq_info(sta->sta.txq[0]));
429ba8c3d6fSFelix Fietkau free:
430433f5bc1SJohannes Berg #ifdef CONFIG_MAC80211_MESH
431433f5bc1SJohannes Berg 	kfree(sta->mesh);
432433f5bc1SJohannes Berg #endif
433ba8c3d6fSFelix Fietkau 	kfree(sta);
434ba8c3d6fSFelix Fietkau 	return NULL;
43573651ee6SJohannes Berg }
43673651ee6SJohannes Berg 
4378c71df7aSGuy Eilam static int sta_info_insert_check(struct sta_info *sta)
43834e89507SJohannes Berg {
43934e89507SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
44034e89507SJohannes Berg 
44103e4497eSJohannes Berg 	/*
44203e4497eSJohannes Berg 	 * Can't be a WARN_ON because it can be triggered through a race:
44303e4497eSJohannes Berg 	 * something inserts a STA (on one CPU) without holding the RTNL
44403e4497eSJohannes Berg 	 * and another CPU turns off the net device.
44503e4497eSJohannes Berg 	 */
4468c71df7aSGuy Eilam 	if (unlikely(!ieee80211_sdata_running(sdata)))
4478c71df7aSGuy Eilam 		return -ENETDOWN;
44803e4497eSJohannes Berg 
449b203ca39SJoe Perches 	if (WARN_ON(ether_addr_equal(sta->sta.addr, sdata->vif.addr) ||
4508c71df7aSGuy Eilam 		    is_multicast_ether_addr(sta->sta.addr)))
4518c71df7aSGuy Eilam 		return -EINVAL;
4528c71df7aSGuy Eilam 
45331104891SJohannes Berg 	/* Strictly speaking this isn't necessary as we hold the mutex, but
45431104891SJohannes Berg 	 * the rhashtable code can't really deal with that distinction. We
45531104891SJohannes Berg 	 * do require the mutex for correctness though.
45631104891SJohannes Berg 	 */
45731104891SJohannes Berg 	rcu_read_lock();
45831104891SJohannes Berg 	lockdep_assert_held(&sdata->local->sta_mtx);
45931104891SJohannes Berg 	if (ieee80211_hw_check(&sdata->local->hw, NEEDS_UNIQUE_STA_ADDR) &&
46031104891SJohannes Berg 	    ieee80211_find_sta_by_ifaddr(&sdata->local->hw, sta->addr, NULL)) {
46131104891SJohannes Berg 		rcu_read_unlock();
46231104891SJohannes Berg 		return -ENOTUNIQ;
46331104891SJohannes Berg 	}
46431104891SJohannes Berg 	rcu_read_unlock();
46531104891SJohannes Berg 
4668c71df7aSGuy Eilam 	return 0;
46793e5deb1SJohannes Berg }
46844213b5eSJohannes Berg 
469f09603a2SJohannes Berg static int sta_info_insert_drv_state(struct ieee80211_local *local,
470f09603a2SJohannes Berg 				     struct ieee80211_sub_if_data *sdata,
471f09603a2SJohannes Berg 				     struct sta_info *sta)
472f09603a2SJohannes Berg {
473f09603a2SJohannes Berg 	enum ieee80211_sta_state state;
474f09603a2SJohannes Berg 	int err = 0;
475f09603a2SJohannes Berg 
476f09603a2SJohannes Berg 	for (state = IEEE80211_STA_NOTEXIST; state < sta->sta_state; state++) {
477f09603a2SJohannes Berg 		err = drv_sta_state(local, sdata, sta, state, state + 1);
478f09603a2SJohannes Berg 		if (err)
479f09603a2SJohannes Berg 			break;
480f09603a2SJohannes Berg 	}
481f09603a2SJohannes Berg 
482f09603a2SJohannes Berg 	if (!err) {
483a4ec45a4SJohannes Berg 		/*
484a4ec45a4SJohannes Berg 		 * Drivers using legacy sta_add/sta_remove callbacks only
485a4ec45a4SJohannes Berg 		 * get uploaded set to true after sta_add is called.
486a4ec45a4SJohannes Berg 		 */
487a4ec45a4SJohannes Berg 		if (!local->ops->sta_add)
488f09603a2SJohannes Berg 			sta->uploaded = true;
489f09603a2SJohannes Berg 		return 0;
490f09603a2SJohannes Berg 	}
491f09603a2SJohannes Berg 
492f09603a2SJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
493bdcbd8e0SJohannes Berg 		sdata_info(sdata,
494bdcbd8e0SJohannes Berg 			   "failed to move IBSS STA %pM to state %d (%d) - keeping it anyway\n",
495bdcbd8e0SJohannes Berg 			   sta->sta.addr, state + 1, err);
496f09603a2SJohannes Berg 		err = 0;
497f09603a2SJohannes Berg 	}
498f09603a2SJohannes Berg 
499f09603a2SJohannes Berg 	/* unwind on error */
500f09603a2SJohannes Berg 	for (; state > IEEE80211_STA_NOTEXIST; state--)
501f09603a2SJohannes Berg 		WARN_ON(drv_sta_state(local, sdata, sta, state, state - 1));
502f09603a2SJohannes Berg 
503f09603a2SJohannes Berg 	return err;
504f09603a2SJohannes Berg }
505f09603a2SJohannes Berg 
50634e89507SJohannes Berg /*
5078c71df7aSGuy Eilam  * should be called with sta_mtx locked
5088c71df7aSGuy Eilam  * this function replaces the mutex lock
5098c71df7aSGuy Eilam  * with a RCU lock
5108c71df7aSGuy Eilam  */
5114d33960bSJohannes Berg static int sta_info_insert_finish(struct sta_info *sta) __acquires(RCU)
5128c71df7aSGuy Eilam {
5138c71df7aSGuy Eilam 	struct ieee80211_local *local = sta->local;
5148c71df7aSGuy Eilam 	struct ieee80211_sub_if_data *sdata = sta->sdata;
5150ef049dcSArnd Bergmann 	struct station_info *sinfo;
5168c71df7aSGuy Eilam 	int err = 0;
5178c71df7aSGuy Eilam 
5188c71df7aSGuy Eilam 	lockdep_assert_held(&local->sta_mtx);
5198c71df7aSGuy Eilam 
5200ef049dcSArnd Bergmann 	sinfo = kzalloc(sizeof(struct station_info), GFP_KERNEL);
5210ef049dcSArnd Bergmann 	if (!sinfo) {
5220ef049dcSArnd Bergmann 		err = -ENOMEM;
5230ef049dcSArnd Bergmann 		goto out_err;
5240ef049dcSArnd Bergmann 	}
5250ef049dcSArnd Bergmann 
5267852e361SJohannes Berg 	/* check if STA exists already */
5277852e361SJohannes Berg 	if (sta_info_get_bss(sdata, sta->sta.addr)) {
5284d33960bSJohannes Berg 		err = -EEXIST;
5294d33960bSJohannes Berg 		goto out_err;
53034e89507SJohannes Berg 	}
53134e89507SJohannes Berg 
5324d33960bSJohannes Berg 	local->num_sta++;
5334d33960bSJohannes Berg 	local->sta_generation++;
5344d33960bSJohannes Berg 	smp_mb();
5354d33960bSJohannes Berg 
5365108ca82SJohannes Berg 	/* simplify things and don't accept BA sessions yet */
5375108ca82SJohannes Berg 	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
5385108ca82SJohannes Berg 
5394d33960bSJohannes Berg 	/* make the station visible */
54062b14b24SJohannes Berg 	err = sta_info_hash_add(local, sta);
54162b14b24SJohannes Berg 	if (err)
54262b14b24SJohannes Berg 		goto out_drop_sta;
5434d33960bSJohannes Berg 
5442bad7748SArik Nemtsov 	list_add_tail_rcu(&sta->list, &local->sta_list);
54583d5cc01SJohannes Berg 
5465108ca82SJohannes Berg 	/* notify driver */
5475108ca82SJohannes Berg 	err = sta_info_insert_drv_state(local, sdata, sta);
5485108ca82SJohannes Berg 	if (err)
5495108ca82SJohannes Berg 		goto out_remove;
5505108ca82SJohannes Berg 
55183d5cc01SJohannes Berg 	set_sta_flag(sta, WLAN_STA_INSERTED);
5525108ca82SJohannes Berg 	/* accept BA sessions now */
5535108ca82SJohannes Berg 	clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
5544d33960bSJohannes Berg 
5554d33960bSJohannes Berg 	ieee80211_sta_debugfs_add(sta);
5564d33960bSJohannes Berg 	rate_control_add_sta_debugfs(sta);
5574d33960bSJohannes Berg 
5580ef049dcSArnd Bergmann 	sinfo->generation = local->sta_generation;
5590ef049dcSArnd Bergmann 	cfg80211_new_sta(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL);
5600ef049dcSArnd Bergmann 	kfree(sinfo);
561d0709a65SJohannes Berg 
562bdcbd8e0SJohannes Berg 	sta_dbg(sdata, "Inserted STA %pM\n", sta->sta.addr);
563f0706e82SJiri Benc 
56434e89507SJohannes Berg 	/* move reference to rcu-protected */
56534e89507SJohannes Berg 	rcu_read_lock();
56634e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
567e9f207f0SJiri Benc 
56873651ee6SJohannes Berg 	if (ieee80211_vif_is_mesh(&sdata->vif))
56973651ee6SJohannes Berg 		mesh_accept_plinks_update(sdata);
57073651ee6SJohannes Berg 
57173651ee6SJohannes Berg 	return 0;
5725108ca82SJohannes Berg  out_remove:
5735108ca82SJohannes Berg 	sta_info_hash_del(local, sta);
5745108ca82SJohannes Berg 	list_del_rcu(&sta->list);
57562b14b24SJohannes Berg  out_drop_sta:
5765108ca82SJohannes Berg 	local->num_sta--;
5775108ca82SJohannes Berg 	synchronize_net();
5785108ca82SJohannes Berg 	__cleanup_single_sta(sta);
5794d33960bSJohannes Berg  out_err:
5804d33960bSJohannes Berg 	mutex_unlock(&local->sta_mtx);
581ea32f065SSudip Mukherjee 	kfree(sinfo);
5824d33960bSJohannes Berg 	rcu_read_lock();
5834d33960bSJohannes Berg 	return err;
5848c71df7aSGuy Eilam }
5858c71df7aSGuy Eilam 
5868c71df7aSGuy Eilam int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU)
5878c71df7aSGuy Eilam {
5888c71df7aSGuy Eilam 	struct ieee80211_local *local = sta->local;
589308f7fcfSZhao, Gang 	int err;
5908c71df7aSGuy Eilam 
5914d33960bSJohannes Berg 	might_sleep();
5924d33960bSJohannes Berg 
59331104891SJohannes Berg 	mutex_lock(&local->sta_mtx);
59431104891SJohannes Berg 
5958c71df7aSGuy Eilam 	err = sta_info_insert_check(sta);
5968c71df7aSGuy Eilam 	if (err) {
59731104891SJohannes Berg 		mutex_unlock(&local->sta_mtx);
5988c71df7aSGuy Eilam 		rcu_read_lock();
5998c71df7aSGuy Eilam 		goto out_free;
6008c71df7aSGuy Eilam 	}
6018c71df7aSGuy Eilam 
6024d33960bSJohannes Berg 	err = sta_info_insert_finish(sta);
6038c71df7aSGuy Eilam 	if (err)
604004c872eSJohannes Berg 		goto out_free;
605d0709a65SJohannes Berg 
606004c872eSJohannes Berg 	return 0;
60793e5deb1SJohannes Berg  out_free:
608d9a7ddb0SJohannes Berg 	sta_info_free(local, sta);
60993e5deb1SJohannes Berg 	return err;
610f0706e82SJiri Benc }
611f0706e82SJiri Benc 
61234e89507SJohannes Berg int sta_info_insert(struct sta_info *sta)
61334e89507SJohannes Berg {
61434e89507SJohannes Berg 	int err = sta_info_insert_rcu(sta);
61534e89507SJohannes Berg 
61634e89507SJohannes Berg 	rcu_read_unlock();
61734e89507SJohannes Berg 
61834e89507SJohannes Berg 	return err;
61934e89507SJohannes Berg }
62034e89507SJohannes Berg 
621d012a605SMarco Porsch static inline void __bss_tim_set(u8 *tim, u16 id)
622004c872eSJohannes Berg {
623004c872eSJohannes Berg 	/*
624004c872eSJohannes Berg 	 * This format has been mandated by the IEEE specifications,
625004c872eSJohannes Berg 	 * so this line may not be changed to use the __set_bit() format.
626004c872eSJohannes Berg 	 */
627d012a605SMarco Porsch 	tim[id / 8] |= (1 << (id % 8));
628004c872eSJohannes Berg }
629004c872eSJohannes Berg 
630d012a605SMarco Porsch static inline void __bss_tim_clear(u8 *tim, u16 id)
631004c872eSJohannes Berg {
632004c872eSJohannes Berg 	/*
633004c872eSJohannes Berg 	 * This format has been mandated by the IEEE specifications,
634004c872eSJohannes Berg 	 * so this line may not be changed to use the __clear_bit() format.
635004c872eSJohannes Berg 	 */
636d012a605SMarco Porsch 	tim[id / 8] &= ~(1 << (id % 8));
637004c872eSJohannes Berg }
638004c872eSJohannes Berg 
6393d5839b6SIlan Peer static inline bool __bss_tim_get(u8 *tim, u16 id)
6403d5839b6SIlan Peer {
6413d5839b6SIlan Peer 	/*
6423d5839b6SIlan Peer 	 * This format has been mandated by the IEEE specifications,
6433d5839b6SIlan Peer 	 * so this line may not be changed to use the test_bit() format.
6443d5839b6SIlan Peer 	 */
6453d5839b6SIlan Peer 	return tim[id / 8] & (1 << (id % 8));
6463d5839b6SIlan Peer }
6473d5839b6SIlan Peer 
648948d887dSJohannes Berg static unsigned long ieee80211_tids_for_ac(int ac)
649004c872eSJohannes Berg {
650948d887dSJohannes Berg 	/* If we ever support TIDs > 7, this obviously needs to be adjusted */
651948d887dSJohannes Berg 	switch (ac) {
652948d887dSJohannes Berg 	case IEEE80211_AC_VO:
653948d887dSJohannes Berg 		return BIT(6) | BIT(7);
654948d887dSJohannes Berg 	case IEEE80211_AC_VI:
655948d887dSJohannes Berg 		return BIT(4) | BIT(5);
656948d887dSJohannes Berg 	case IEEE80211_AC_BE:
657948d887dSJohannes Berg 		return BIT(0) | BIT(3);
658948d887dSJohannes Berg 	case IEEE80211_AC_BK:
659948d887dSJohannes Berg 		return BIT(1) | BIT(2);
660948d887dSJohannes Berg 	default:
661948d887dSJohannes Berg 		WARN_ON(1);
662948d887dSJohannes Berg 		return 0;
663d0709a65SJohannes Berg 	}
664004c872eSJohannes Berg }
665004c872eSJohannes Berg 
6669b7a86f3SJohannes Berg static void __sta_info_recalc_tim(struct sta_info *sta, bool ignore_pending)
667004c872eSJohannes Berg {
668c868cb35SJohannes Berg 	struct ieee80211_local *local = sta->local;
669d012a605SMarco Porsch 	struct ps_data *ps;
670948d887dSJohannes Berg 	bool indicate_tim = false;
671948d887dSJohannes Berg 	u8 ignore_for_tim = sta->sta.uapsd_queues;
672948d887dSJohannes Berg 	int ac;
673a69bd8e6SBob Copeland 	u16 id = sta->sta.aid;
674004c872eSJohannes Berg 
675d012a605SMarco Porsch 	if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
676d012a605SMarco Porsch 	    sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
677c868cb35SJohannes Berg 		if (WARN_ON_ONCE(!sta->sdata->bss))
678c868cb35SJohannes Berg 			return;
6793e122be0SJohannes Berg 
680d012a605SMarco Porsch 		ps = &sta->sdata->bss->ps;
6813f52b7e3SMarco Porsch #ifdef CONFIG_MAC80211_MESH
6823f52b7e3SMarco Porsch 	} else if (ieee80211_vif_is_mesh(&sta->sdata->vif)) {
6833f52b7e3SMarco Porsch 		ps = &sta->sdata->u.mesh.ps;
6843f52b7e3SMarco Porsch #endif
685d012a605SMarco Porsch 	} else {
686d012a605SMarco Porsch 		return;
687d012a605SMarco Porsch 	}
688d012a605SMarco Porsch 
689c868cb35SJohannes Berg 	/* No need to do anything if the driver does all */
69030686bf7SJohannes Berg 	if (ieee80211_hw_check(&local->hw, AP_LINK_PS))
691c868cb35SJohannes Berg 		return;
692004c872eSJohannes Berg 
693c868cb35SJohannes Berg 	if (sta->dead)
694c868cb35SJohannes Berg 		goto done;
6953e122be0SJohannes Berg 
696948d887dSJohannes Berg 	/*
697948d887dSJohannes Berg 	 * If all ACs are delivery-enabled then we should build
698948d887dSJohannes Berg 	 * the TIM bit for all ACs anyway; if only some are then
699948d887dSJohannes Berg 	 * we ignore those and build the TIM bit using only the
700948d887dSJohannes Berg 	 * non-enabled ones.
701948d887dSJohannes Berg 	 */
702948d887dSJohannes Berg 	if (ignore_for_tim == BIT(IEEE80211_NUM_ACS) - 1)
703948d887dSJohannes Berg 		ignore_for_tim = 0;
704948d887dSJohannes Berg 
7059b7a86f3SJohannes Berg 	if (ignore_pending)
7069b7a86f3SJohannes Berg 		ignore_for_tim = BIT(IEEE80211_NUM_ACS) - 1;
7079b7a86f3SJohannes Berg 
708948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
709948d887dSJohannes Berg 		unsigned long tids;
710948d887dSJohannes Berg 
711948d887dSJohannes Berg 		if (ignore_for_tim & BIT(ac))
712948d887dSJohannes Berg 			continue;
713948d887dSJohannes Berg 
714948d887dSJohannes Berg 		indicate_tim |= !skb_queue_empty(&sta->tx_filtered[ac]) ||
715948d887dSJohannes Berg 				!skb_queue_empty(&sta->ps_tx_buf[ac]);
716948d887dSJohannes Berg 		if (indicate_tim)
717948d887dSJohannes Berg 			break;
718948d887dSJohannes Berg 
719948d887dSJohannes Berg 		tids = ieee80211_tids_for_ac(ac);
720948d887dSJohannes Berg 
721948d887dSJohannes Berg 		indicate_tim |=
722948d887dSJohannes Berg 			sta->driver_buffered_tids & tids;
723ba8c3d6fSFelix Fietkau 		indicate_tim |=
724ba8c3d6fSFelix Fietkau 			sta->txq_buffered_tids & tids;
725004c872eSJohannes Berg 	}
726004c872eSJohannes Berg 
727c868cb35SJohannes Berg  done:
72865f704a5SJohannes Berg 	spin_lock_bh(&local->tim_lock);
729004c872eSJohannes Berg 
7303d5839b6SIlan Peer 	if (indicate_tim == __bss_tim_get(ps->tim, id))
7313d5839b6SIlan Peer 		goto out_unlock;
7323d5839b6SIlan Peer 
733948d887dSJohannes Berg 	if (indicate_tim)
734d012a605SMarco Porsch 		__bss_tim_set(ps->tim, id);
735c868cb35SJohannes Berg 	else
736d012a605SMarco Porsch 		__bss_tim_clear(ps->tim, id);
7373e122be0SJohannes Berg 
7389b7a86f3SJohannes Berg 	if (local->ops->set_tim && !WARN_ON(sta->dead)) {
739c868cb35SJohannes Berg 		local->tim_in_locked_section = true;
740948d887dSJohannes Berg 		drv_set_tim(local, &sta->sta, indicate_tim);
741c868cb35SJohannes Berg 		local->tim_in_locked_section = false;
742004c872eSJohannes Berg 	}
743004c872eSJohannes Berg 
7443d5839b6SIlan Peer out_unlock:
74565f704a5SJohannes Berg 	spin_unlock_bh(&local->tim_lock);
746004c872eSJohannes Berg }
747004c872eSJohannes Berg 
7489b7a86f3SJohannes Berg void sta_info_recalc_tim(struct sta_info *sta)
7499b7a86f3SJohannes Berg {
7509b7a86f3SJohannes Berg 	__sta_info_recalc_tim(sta, false);
7519b7a86f3SJohannes Berg }
7529b7a86f3SJohannes Berg 
753cd0b8d89SJohannes Berg static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb)
754f0706e82SJiri Benc {
755e039fa4aSJohannes Berg 	struct ieee80211_tx_info *info;
756f0706e82SJiri Benc 	int timeout;
757f0706e82SJiri Benc 
758f0706e82SJiri Benc 	if (!skb)
759cd0b8d89SJohannes Berg 		return false;
760f0706e82SJiri Benc 
761e039fa4aSJohannes Berg 	info = IEEE80211_SKB_CB(skb);
762f0706e82SJiri Benc 
763f0706e82SJiri Benc 	/* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */
76457c4d7b4SJohannes Berg 	timeout = (sta->listen_interval *
76557c4d7b4SJohannes Berg 		   sta->sdata->vif.bss_conf.beacon_int *
76657c4d7b4SJohannes Berg 		   32 / 15625) * HZ;
767f0706e82SJiri Benc 	if (timeout < STA_TX_BUFFER_EXPIRE)
768f0706e82SJiri Benc 		timeout = STA_TX_BUFFER_EXPIRE;
769e039fa4aSJohannes Berg 	return time_after(jiffies, info->control.jiffies + timeout);
770f0706e82SJiri Benc }
771f0706e82SJiri Benc 
772f0706e82SJiri Benc 
773948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local,
774948d887dSJohannes Berg 						struct sta_info *sta, int ac)
775f0706e82SJiri Benc {
776f0706e82SJiri Benc 	unsigned long flags;
777f0706e82SJiri Benc 	struct sk_buff *skb;
778f0706e82SJiri Benc 
77960750397SJohannes Berg 	/*
78060750397SJohannes Berg 	 * First check for frames that should expire on the filtered
78160750397SJohannes Berg 	 * queue. Frames here were rejected by the driver and are on
78260750397SJohannes Berg 	 * a separate queue to avoid reordering with normal PS-buffered
78360750397SJohannes Berg 	 * frames. They also aren't accounted for right now in the
78460750397SJohannes Berg 	 * total_ps_buffered counter.
78560750397SJohannes Berg 	 */
786f0706e82SJiri Benc 	for (;;) {
787948d887dSJohannes Berg 		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
788948d887dSJohannes Berg 		skb = skb_peek(&sta->tx_filtered[ac]);
78957c4d7b4SJohannes Berg 		if (sta_info_buffer_expired(sta, skb))
790948d887dSJohannes Berg 			skb = __skb_dequeue(&sta->tx_filtered[ac]);
791836341a7SJohannes Berg 		else
792f0706e82SJiri Benc 			skb = NULL;
793948d887dSJohannes Berg 		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
794f0706e82SJiri Benc 
79560750397SJohannes Berg 		/*
79660750397SJohannes Berg 		 * Frames are queued in order, so if this one
79760750397SJohannes Berg 		 * hasn't expired yet we can stop testing. If
79860750397SJohannes Berg 		 * we actually reached the end of the queue we
79960750397SJohannes Berg 		 * also need to stop, of course.
80060750397SJohannes Berg 		 */
80160750397SJohannes Berg 		if (!skb)
80260750397SJohannes Berg 			break;
803d4fa14cdSFelix Fietkau 		ieee80211_free_txskb(&local->hw, skb);
80460750397SJohannes Berg 	}
80560750397SJohannes Berg 
80660750397SJohannes Berg 	/*
80760750397SJohannes Berg 	 * Now also check the normal PS-buffered queue, this will
80860750397SJohannes Berg 	 * only find something if the filtered queue was emptied
80960750397SJohannes Berg 	 * since the filtered frames are all before the normal PS
81060750397SJohannes Berg 	 * buffered frames.
81160750397SJohannes Berg 	 */
812f0706e82SJiri Benc 	for (;;) {
813948d887dSJohannes Berg 		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
814948d887dSJohannes Berg 		skb = skb_peek(&sta->ps_tx_buf[ac]);
815f0706e82SJiri Benc 		if (sta_info_buffer_expired(sta, skb))
816948d887dSJohannes Berg 			skb = __skb_dequeue(&sta->ps_tx_buf[ac]);
817f0706e82SJiri Benc 		else
818f0706e82SJiri Benc 			skb = NULL;
819948d887dSJohannes Berg 		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
820f0706e82SJiri Benc 
82160750397SJohannes Berg 		/*
82260750397SJohannes Berg 		 * frames are queued in order, so if this one
82360750397SJohannes Berg 		 * hasn't expired yet (or we reached the end of
82460750397SJohannes Berg 		 * the queue) we can stop testing
82560750397SJohannes Berg 		 */
826836341a7SJohannes Berg 		if (!skb)
827836341a7SJohannes Berg 			break;
828836341a7SJohannes Berg 
829f0706e82SJiri Benc 		local->total_ps_buffered--;
830bdcbd8e0SJohannes Berg 		ps_dbg(sta->sdata, "Buffered frame expired (STA %pM)\n",
831bdcbd8e0SJohannes Berg 		       sta->sta.addr);
832d4fa14cdSFelix Fietkau 		ieee80211_free_txskb(&local->hw, skb);
833f0706e82SJiri Benc 	}
8343393a608SJuuso Oikarinen 
83560750397SJohannes Berg 	/*
83660750397SJohannes Berg 	 * Finally, recalculate the TIM bit for this station -- it might
83760750397SJohannes Berg 	 * now be clear because the station was too slow to retrieve its
83860750397SJohannes Berg 	 * frames.
83960750397SJohannes Berg 	 */
84060750397SJohannes Berg 	sta_info_recalc_tim(sta);
84160750397SJohannes Berg 
84260750397SJohannes Berg 	/*
84360750397SJohannes Berg 	 * Return whether there are any frames still buffered, this is
84460750397SJohannes Berg 	 * used to check whether the cleanup timer still needs to run,
84560750397SJohannes Berg 	 * if there are no frames we don't need to rearm the timer.
84660750397SJohannes Berg 	 */
847948d887dSJohannes Berg 	return !(skb_queue_empty(&sta->ps_tx_buf[ac]) &&
848948d887dSJohannes Berg 		 skb_queue_empty(&sta->tx_filtered[ac]));
849948d887dSJohannes Berg }
850948d887dSJohannes Berg 
851948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered(struct ieee80211_local *local,
852948d887dSJohannes Berg 					     struct sta_info *sta)
853948d887dSJohannes Berg {
854948d887dSJohannes Berg 	bool have_buffered = false;
855948d887dSJohannes Berg 	int ac;
856948d887dSJohannes Berg 
8573f52b7e3SMarco Porsch 	/* This is only necessary for stations on BSS/MBSS interfaces */
8583f52b7e3SMarco Porsch 	if (!sta->sdata->bss &&
8593f52b7e3SMarco Porsch 	    !ieee80211_vif_is_mesh(&sta->sdata->vif))
860948d887dSJohannes Berg 		return false;
861948d887dSJohannes Berg 
862948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
863948d887dSJohannes Berg 		have_buffered |=
864948d887dSJohannes Berg 			sta_info_cleanup_expire_buffered_ac(local, sta, ac);
865948d887dSJohannes Berg 
866948d887dSJohannes Berg 	return have_buffered;
867f0706e82SJiri Benc }
868f0706e82SJiri Benc 
869d778207bSJohannes Berg static int __must_check __sta_info_destroy_part1(struct sta_info *sta)
87034e89507SJohannes Berg {
87134e89507SJohannes Berg 	struct ieee80211_local *local;
87234e89507SJohannes Berg 	struct ieee80211_sub_if_data *sdata;
8736d10e46bSJohannes Berg 	int ret;
87434e89507SJohannes Berg 
87534e89507SJohannes Berg 	might_sleep();
87634e89507SJohannes Berg 
87734e89507SJohannes Berg 	if (!sta)
87834e89507SJohannes Berg 		return -ENOENT;
87934e89507SJohannes Berg 
88034e89507SJohannes Berg 	local = sta->local;
88134e89507SJohannes Berg 	sdata = sta->sdata;
88234e89507SJohannes Berg 
88383d5cc01SJohannes Berg 	lockdep_assert_held(&local->sta_mtx);
88483d5cc01SJohannes Berg 
885098a6070SJohannes Berg 	/*
886098a6070SJohannes Berg 	 * Before removing the station from the driver and
887098a6070SJohannes Berg 	 * rate control, it might still start new aggregation
888098a6070SJohannes Berg 	 * sessions -- block that to make sure the tear-down
889098a6070SJohannes Berg 	 * will be sufficient.
890098a6070SJohannes Berg 	 */
891c2c98fdeSJohannes Berg 	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
892c82c4a80SJohannes Berg 	ieee80211_sta_tear_down_BA_sessions(sta, AGG_STOP_DESTROY_STA);
893098a6070SJohannes Berg 
894f59374ebSSara Sharon 	/*
895f59374ebSSara Sharon 	 * Before removing the station from the driver there might be pending
896f59374ebSSara Sharon 	 * rx frames on RSS queues sent prior to the disassociation - wait for
897f59374ebSSara Sharon 	 * all such frames to be processed.
898f59374ebSSara Sharon 	 */
899f59374ebSSara Sharon 	drv_sync_rx_queues(local, sta);
900f59374ebSSara Sharon 
90134e89507SJohannes Berg 	ret = sta_info_hash_del(local, sta);
902b01711beSJohannes Berg 	if (WARN_ON(ret))
90334e89507SJohannes Berg 		return ret;
90434e89507SJohannes Berg 
905a7a6bdd0SArik Nemtsov 	/*
906a7a6bdd0SArik Nemtsov 	 * for TDLS peers, make sure to return to the base channel before
907a7a6bdd0SArik Nemtsov 	 * removal.
908a7a6bdd0SArik Nemtsov 	 */
909a7a6bdd0SArik Nemtsov 	if (test_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL)) {
910a7a6bdd0SArik Nemtsov 		drv_tdls_cancel_channel_switch(local, sdata, &sta->sta);
911a7a6bdd0SArik Nemtsov 		clear_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL);
912a7a6bdd0SArik Nemtsov 	}
913a7a6bdd0SArik Nemtsov 
914794454ceSArik Nemtsov 	list_del_rcu(&sta->list);
915ef044763SEliad Peller 	sta->removed = true;
9164d33960bSJohannes Berg 
9176a9d1b91SJohannes Berg 	drv_sta_pre_rcu_remove(local, sta->sdata, sta);
9186a9d1b91SJohannes Berg 
919a710c816SJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
920a710c816SJohannes Berg 	    rcu_access_pointer(sdata->u.vlan.sta) == sta)
921a710c816SJohannes Berg 		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
922a710c816SJohannes Berg 
923d778207bSJohannes Berg 	return 0;
924d778207bSJohannes Berg }
925d778207bSJohannes Berg 
926d778207bSJohannes Berg static void __sta_info_destroy_part2(struct sta_info *sta)
927d778207bSJohannes Berg {
928d778207bSJohannes Berg 	struct ieee80211_local *local = sta->local;
929d778207bSJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
9300ef049dcSArnd Bergmann 	struct station_info *sinfo;
931d778207bSJohannes Berg 	int ret;
932d778207bSJohannes Berg 
933d778207bSJohannes Berg 	/*
934d778207bSJohannes Berg 	 * NOTE: This assumes at least synchronize_net() was done
935d778207bSJohannes Berg 	 *	 after _part1 and before _part2!
936d778207bSJohannes Berg 	 */
937d778207bSJohannes Berg 
938d778207bSJohannes Berg 	might_sleep();
939d778207bSJohannes Berg 	lockdep_assert_held(&local->sta_mtx);
940d778207bSJohannes Berg 
941c8782078SJohannes Berg 	/* now keys can no longer be reached */
9426d10e46bSJohannes Berg 	ieee80211_free_sta_keys(local, sta);
94334e89507SJohannes Berg 
9449b7a86f3SJohannes Berg 	/* disable TIM bit - last chance to tell driver */
9459b7a86f3SJohannes Berg 	__sta_info_recalc_tim(sta, true);
9469b7a86f3SJohannes Berg 
94734e89507SJohannes Berg 	sta->dead = true;
94834e89507SJohannes Berg 
94934e89507SJohannes Berg 	local->num_sta--;
95034e89507SJohannes Berg 	local->sta_generation++;
95134e89507SJohannes Berg 
95283d5cc01SJohannes Berg 	while (sta->sta_state > IEEE80211_STA_NONE) {
953f09603a2SJohannes Berg 		ret = sta_info_move_state(sta, sta->sta_state - 1);
954f09603a2SJohannes Berg 		if (ret) {
95583d5cc01SJohannes Berg 			WARN_ON_ONCE(1);
95683d5cc01SJohannes Berg 			break;
95783d5cc01SJohannes Berg 		}
95883d5cc01SJohannes Berg 	}
959d9a7ddb0SJohannes Berg 
960f09603a2SJohannes Berg 	if (sta->uploaded) {
961f09603a2SJohannes Berg 		ret = drv_sta_state(local, sdata, sta, IEEE80211_STA_NONE,
962f09603a2SJohannes Berg 				    IEEE80211_STA_NOTEXIST);
963f09603a2SJohannes Berg 		WARN_ON_ONCE(ret != 0);
964f09603a2SJohannes Berg 	}
96534e89507SJohannes Berg 
966bdcbd8e0SJohannes Berg 	sta_dbg(sdata, "Removed STA %pM\n", sta->sta.addr);
967bdcbd8e0SJohannes Berg 
9680ef049dcSArnd Bergmann 	sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
9690ef049dcSArnd Bergmann 	if (sinfo)
9700ef049dcSArnd Bergmann 		sta_set_sinfo(sta, sinfo);
9710ef049dcSArnd Bergmann 	cfg80211_del_sta_sinfo(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL);
9720ef049dcSArnd Bergmann 	kfree(sinfo);
973ec15e68bSJouni Malinen 
97434e89507SJohannes Berg 	rate_control_remove_sta_debugfs(sta);
97534e89507SJohannes Berg 	ieee80211_sta_debugfs_remove(sta);
97634e89507SJohannes Berg 
977d34ba216SJohannes Berg 	cleanup_single_sta(sta);
978d778207bSJohannes Berg }
979d778207bSJohannes Berg 
980d778207bSJohannes Berg int __must_check __sta_info_destroy(struct sta_info *sta)
981d778207bSJohannes Berg {
982d778207bSJohannes Berg 	int err = __sta_info_destroy_part1(sta);
983d778207bSJohannes Berg 
984d778207bSJohannes Berg 	if (err)
985d778207bSJohannes Berg 		return err;
986d778207bSJohannes Berg 
987d778207bSJohannes Berg 	synchronize_net();
988d778207bSJohannes Berg 
989d778207bSJohannes Berg 	__sta_info_destroy_part2(sta);
99034e89507SJohannes Berg 
99134e89507SJohannes Berg 	return 0;
99234e89507SJohannes Berg }
99334e89507SJohannes Berg 
99434e89507SJohannes Berg int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr)
99534e89507SJohannes Berg {
99634e89507SJohannes Berg 	struct sta_info *sta;
99734e89507SJohannes Berg 	int ret;
99834e89507SJohannes Berg 
99934e89507SJohannes Berg 	mutex_lock(&sdata->local->sta_mtx);
10007852e361SJohannes Berg 	sta = sta_info_get(sdata, addr);
100134e89507SJohannes Berg 	ret = __sta_info_destroy(sta);
100234e89507SJohannes Berg 	mutex_unlock(&sdata->local->sta_mtx);
100334e89507SJohannes Berg 
100434e89507SJohannes Berg 	return ret;
100534e89507SJohannes Berg }
100634e89507SJohannes Berg 
100734e89507SJohannes Berg int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata,
100834e89507SJohannes Berg 			      const u8 *addr)
100934e89507SJohannes Berg {
101034e89507SJohannes Berg 	struct sta_info *sta;
101134e89507SJohannes Berg 	int ret;
101234e89507SJohannes Berg 
101334e89507SJohannes Berg 	mutex_lock(&sdata->local->sta_mtx);
10147852e361SJohannes Berg 	sta = sta_info_get_bss(sdata, addr);
101534e89507SJohannes Berg 	ret = __sta_info_destroy(sta);
101634e89507SJohannes Berg 	mutex_unlock(&sdata->local->sta_mtx);
101734e89507SJohannes Berg 
101834e89507SJohannes Berg 	return ret;
101934e89507SJohannes Berg }
1020f0706e82SJiri Benc 
1021f0706e82SJiri Benc static void sta_info_cleanup(unsigned long data)
1022f0706e82SJiri Benc {
1023f0706e82SJiri Benc 	struct ieee80211_local *local = (struct ieee80211_local *) data;
1024f0706e82SJiri Benc 	struct sta_info *sta;
10253393a608SJuuso Oikarinen 	bool timer_needed = false;
1026f0706e82SJiri Benc 
1027d0709a65SJohannes Berg 	rcu_read_lock();
1028d0709a65SJohannes Berg 	list_for_each_entry_rcu(sta, &local->sta_list, list)
10293393a608SJuuso Oikarinen 		if (sta_info_cleanup_expire_buffered(local, sta))
10303393a608SJuuso Oikarinen 			timer_needed = true;
1031d0709a65SJohannes Berg 	rcu_read_unlock();
1032f0706e82SJiri Benc 
10335bb644a0SJohannes Berg 	if (local->quiescing)
10345bb644a0SJohannes Berg 		return;
10355bb644a0SJohannes Berg 
10363393a608SJuuso Oikarinen 	if (!timer_needed)
10373393a608SJuuso Oikarinen 		return;
10383393a608SJuuso Oikarinen 
103926d59535SJohannes Berg 	mod_timer(&local->sta_cleanup,
104026d59535SJohannes Berg 		  round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL));
1041f0706e82SJiri Benc }
1042f0706e82SJiri Benc 
10437bedd0cfSJohannes Berg u32 sta_addr_hash(const void *key, u32 length, u32 seed)
1044f0706e82SJiri Benc {
10457bedd0cfSJohannes Berg 	return jhash(key, ETH_ALEN, seed);
10467bedd0cfSJohannes Berg }
10477bedd0cfSJohannes Berg 
10487bedd0cfSJohannes Berg int sta_info_init(struct ieee80211_local *local)
10497bedd0cfSJohannes Berg {
10507bedd0cfSJohannes Berg 	int err;
10517bedd0cfSJohannes Berg 
10527bedd0cfSJohannes Berg 	err = rhashtable_init(&local->sta_hash, &sta_rht_params);
10537bedd0cfSJohannes Berg 	if (err)
10547bedd0cfSJohannes Berg 		return err;
10557bedd0cfSJohannes Berg 
10564d33960bSJohannes Berg 	spin_lock_init(&local->tim_lock);
105734e89507SJohannes Berg 	mutex_init(&local->sta_mtx);
1058f0706e82SJiri Benc 	INIT_LIST_HEAD(&local->sta_list);
1059f0706e82SJiri Benc 
1060b24b8a24SPavel Emelyanov 	setup_timer(&local->sta_cleanup, sta_info_cleanup,
1061b24b8a24SPavel Emelyanov 		    (unsigned long)local);
10627bedd0cfSJohannes Berg 	return 0;
1063f0706e82SJiri Benc }
1064f0706e82SJiri Benc 
1065f0706e82SJiri Benc void sta_info_stop(struct ieee80211_local *local)
1066f0706e82SJiri Benc {
1067a56f992cSJohannes Berg 	del_timer_sync(&local->sta_cleanup);
10687bedd0cfSJohannes Berg 	rhashtable_destroy(&local->sta_hash);
1069f0706e82SJiri Benc }
1070f0706e82SJiri Benc 
1071051007d9SJohannes Berg 
1072e716251dSJohannes Berg int __sta_info_flush(struct ieee80211_sub_if_data *sdata, bool vlans)
1073f0706e82SJiri Benc {
1074b998e8bbSJohannes Berg 	struct ieee80211_local *local = sdata->local;
1075f0706e82SJiri Benc 	struct sta_info *sta, *tmp;
1076d778207bSJohannes Berg 	LIST_HEAD(free_list);
107744213b5eSJohannes Berg 	int ret = 0;
1078f0706e82SJiri Benc 
1079d0709a65SJohannes Berg 	might_sleep();
1080d0709a65SJohannes Berg 
1081e716251dSJohannes Berg 	WARN_ON(vlans && sdata->vif.type != NL80211_IFTYPE_AP);
1082e716251dSJohannes Berg 	WARN_ON(vlans && !sdata->bss);
1083e716251dSJohannes Berg 
108434e89507SJohannes Berg 	mutex_lock(&local->sta_mtx);
108534e89507SJohannes Berg 	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1086e716251dSJohannes Berg 		if (sdata == sta->sdata ||
1087e716251dSJohannes Berg 		    (vlans && sdata->bss == sta->sdata->bss)) {
1088d778207bSJohannes Berg 			if (!WARN_ON(__sta_info_destroy_part1(sta)))
1089d778207bSJohannes Berg 				list_add(&sta->free_list, &free_list);
109034316837SJohannes Berg 			ret++;
109134316837SJohannes Berg 		}
109234e89507SJohannes Berg 	}
1093d778207bSJohannes Berg 
1094d778207bSJohannes Berg 	if (!list_empty(&free_list)) {
1095d778207bSJohannes Berg 		synchronize_net();
1096d778207bSJohannes Berg 		list_for_each_entry_safe(sta, tmp, &free_list, free_list)
1097d778207bSJohannes Berg 			__sta_info_destroy_part2(sta);
1098d778207bSJohannes Berg 	}
109934e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
110044213b5eSJohannes Berg 
1101051007d9SJohannes Berg 	return ret;
1102051007d9SJohannes Berg }
1103051007d9SJohannes Berg 
110424723d1bSJohannes Berg void ieee80211_sta_expire(struct ieee80211_sub_if_data *sdata,
110524723d1bSJohannes Berg 			  unsigned long exp_time)
110624723d1bSJohannes Berg {
110724723d1bSJohannes Berg 	struct ieee80211_local *local = sdata->local;
110824723d1bSJohannes Berg 	struct sta_info *sta, *tmp;
110924723d1bSJohannes Berg 
111034e89507SJohannes Berg 	mutex_lock(&local->sta_mtx);
1111e46a2cf9SMohammed Shafi Shajakhan 
1112e46a2cf9SMohammed Shafi Shajakhan 	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1113b8da6b6aSJohannes Berg 		unsigned long last_active = ieee80211_sta_last_active(sta);
1114b8da6b6aSJohannes Berg 
1115ec2b774eSMarek Lindner 		if (sdata != sta->sdata)
1116ec2b774eSMarek Lindner 			continue;
1117ec2b774eSMarek Lindner 
1118b8da6b6aSJohannes Berg 		if (time_is_before_jiffies(last_active + exp_time)) {
1119eea57d42SMohammed Shafi Shajakhan 			sta_dbg(sta->sdata, "expiring inactive STA %pM\n",
1120bdcbd8e0SJohannes Berg 				sta->sta.addr);
11213f52b7e3SMarco Porsch 
11223f52b7e3SMarco Porsch 			if (ieee80211_vif_is_mesh(&sdata->vif) &&
11233f52b7e3SMarco Porsch 			    test_sta_flag(sta, WLAN_STA_PS_STA))
11243f52b7e3SMarco Porsch 				atomic_dec(&sdata->u.mesh.ps.num_sta_ps);
11253f52b7e3SMarco Porsch 
112634e89507SJohannes Berg 			WARN_ON(__sta_info_destroy(sta));
112724723d1bSJohannes Berg 		}
1128e46a2cf9SMohammed Shafi Shajakhan 	}
1129e46a2cf9SMohammed Shafi Shajakhan 
113034e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
113124723d1bSJohannes Berg }
113217741cdcSJohannes Berg 
1133686b9cb9SBen Greear struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
1134686b9cb9SBen Greear 						   const u8 *addr,
1135686b9cb9SBen Greear 						   const u8 *localaddr)
113617741cdcSJohannes Berg {
11377bedd0cfSJohannes Berg 	struct ieee80211_local *local = hw_to_local(hw);
11387bedd0cfSJohannes Berg 	struct sta_info *sta;
11397bedd0cfSJohannes Berg 	struct rhash_head *tmp;
11407bedd0cfSJohannes Berg 	const struct bucket_table *tbl;
11417bedd0cfSJohannes Berg 
11427bedd0cfSJohannes Berg 	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);
114317741cdcSJohannes Berg 
1144686b9cb9SBen Greear 	/*
1145686b9cb9SBen Greear 	 * Just return a random station if localaddr is NULL
1146686b9cb9SBen Greear 	 * ... first in list.
1147686b9cb9SBen Greear 	 */
11487bedd0cfSJohannes Berg 	for_each_sta_info(local, tbl, addr, sta, tmp) {
1149686b9cb9SBen Greear 		if (localaddr &&
1150b203ca39SJoe Perches 		    !ether_addr_equal(sta->sdata->vif.addr, localaddr))
1151686b9cb9SBen Greear 			continue;
1152f7c65594SJohannes Berg 		if (!sta->uploaded)
1153f7c65594SJohannes Berg 			return NULL;
115417741cdcSJohannes Berg 		return &sta->sta;
1155f7c65594SJohannes Berg 	}
1156f7c65594SJohannes Berg 
1157abe60632SJohannes Berg 	return NULL;
115817741cdcSJohannes Berg }
1159686b9cb9SBen Greear EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
11605ed176e1SJohannes Berg 
11615ed176e1SJohannes Berg struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif,
11625ed176e1SJohannes Berg 					 const u8 *addr)
11635ed176e1SJohannes Berg {
1164f7c65594SJohannes Berg 	struct sta_info *sta;
11655ed176e1SJohannes Berg 
11665ed176e1SJohannes Berg 	if (!vif)
11675ed176e1SJohannes Berg 		return NULL;
11685ed176e1SJohannes Berg 
1169f7c65594SJohannes Berg 	sta = sta_info_get_bss(vif_to_sdata(vif), addr);
1170f7c65594SJohannes Berg 	if (!sta)
1171f7c65594SJohannes Berg 		return NULL;
11725ed176e1SJohannes Berg 
1173f7c65594SJohannes Berg 	if (!sta->uploaded)
1174f7c65594SJohannes Berg 		return NULL;
1175f7c65594SJohannes Berg 
1176f7c65594SJohannes Berg 	return &sta->sta;
11775ed176e1SJohannes Berg }
117817741cdcSJohannes Berg EXPORT_SYMBOL(ieee80211_find_sta);
1179af818581SJohannes Berg 
1180e3685e03SJohannes Berg /* powersave support code */
1181e3685e03SJohannes Berg void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta)
118250a9432dSJohannes Berg {
1183608383bfSHelmut Schaa 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1184e3685e03SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1185e3685e03SJohannes Berg 	struct sk_buff_head pending;
1186ba8c3d6fSFelix Fietkau 	int filtered = 0, buffered = 0, ac, i;
1187e3685e03SJohannes Berg 	unsigned long flags;
1188d012a605SMarco Porsch 	struct ps_data *ps;
1189d012a605SMarco Porsch 
11903918edb0SFelix Fietkau 	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
11913918edb0SFelix Fietkau 		sdata = container_of(sdata->bss, struct ieee80211_sub_if_data,
11923918edb0SFelix Fietkau 				     u.ap);
11933918edb0SFelix Fietkau 
11943918edb0SFelix Fietkau 	if (sdata->vif.type == NL80211_IFTYPE_AP)
1195d012a605SMarco Porsch 		ps = &sdata->bss->ps;
11963f52b7e3SMarco Porsch 	else if (ieee80211_vif_is_mesh(&sdata->vif))
11973f52b7e3SMarco Porsch 		ps = &sdata->u.mesh.ps;
1198d012a605SMarco Porsch 	else
1199d012a605SMarco Porsch 		return;
120050a9432dSJohannes Berg 
1201c2c98fdeSJohannes Berg 	clear_sta_flag(sta, WLAN_STA_SP);
120247086fc5SJohannes Berg 
12035a306f58SJohannes Berg 	BUILD_BUG_ON(BITS_TO_LONGS(IEEE80211_NUM_TIDS) > 1);
1204948d887dSJohannes Berg 	sta->driver_buffered_tids = 0;
1205ba8c3d6fSFelix Fietkau 	sta->txq_buffered_tids = 0;
1206948d887dSJohannes Berg 
120730686bf7SJohannes Berg 	if (!ieee80211_hw_check(&local->hw, AP_LINK_PS))
120812375ef9SJohannes Berg 		drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta);
1209af818581SJohannes Berg 
1210ba8c3d6fSFelix Fietkau 	if (sta->sta.txq[0]) {
1211ba8c3d6fSFelix Fietkau 		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
1212ba8c3d6fSFelix Fietkau 			struct txq_info *txqi = to_txq_info(sta->sta.txq[i]);
1213ba8c3d6fSFelix Fietkau 
1214*fa962b92SMichal Kazior 			if (!txqi->tin.backlog_packets)
1215ba8c3d6fSFelix Fietkau 				continue;
1216ba8c3d6fSFelix Fietkau 
1217ba8c3d6fSFelix Fietkau 			drv_wake_tx_queue(local, txqi);
1218ba8c3d6fSFelix Fietkau 		}
1219ba8c3d6fSFelix Fietkau 	}
1220ba8c3d6fSFelix Fietkau 
1221948d887dSJohannes Berg 	skb_queue_head_init(&pending);
1222af818581SJohannes Berg 
12231d147bfaSEmmanuel Grumbach 	/* sync with ieee80211_tx_h_unicast_ps_buf */
12241d147bfaSEmmanuel Grumbach 	spin_lock(&sta->ps_lock);
1225af818581SJohannes Berg 	/* Send all buffered frames to the station */
1226948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1227948d887dSJohannes Berg 		int count = skb_queue_len(&pending), tmp;
1228948d887dSJohannes Berg 
1229987c285cSArik Nemtsov 		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
1230948d887dSJohannes Berg 		skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending);
1231987c285cSArik Nemtsov 		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
1232948d887dSJohannes Berg 		tmp = skb_queue_len(&pending);
1233948d887dSJohannes Berg 		filtered += tmp - count;
1234948d887dSJohannes Berg 		count = tmp;
1235948d887dSJohannes Berg 
1236987c285cSArik Nemtsov 		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
1237948d887dSJohannes Berg 		skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending);
1238987c285cSArik Nemtsov 		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
1239948d887dSJohannes Berg 		tmp = skb_queue_len(&pending);
1240948d887dSJohannes Berg 		buffered += tmp - count;
1241948d887dSJohannes Berg 	}
1242948d887dSJohannes Berg 
1243e3685e03SJohannes Berg 	ieee80211_add_pending_skbs(local, &pending);
12445ac2e350SJohannes Berg 
12455ac2e350SJohannes Berg 	/* now we're no longer in the deliver code */
12465ac2e350SJohannes Berg 	clear_sta_flag(sta, WLAN_STA_PS_DELIVER);
12475ac2e350SJohannes Berg 
12485ac2e350SJohannes Berg 	/* The station might have polled and then woken up before we responded,
12495ac2e350SJohannes Berg 	 * so clear these flags now to avoid them sticking around.
12505ac2e350SJohannes Berg 	 */
12515ac2e350SJohannes Berg 	clear_sta_flag(sta, WLAN_STA_PSPOLL);
12525ac2e350SJohannes Berg 	clear_sta_flag(sta, WLAN_STA_UAPSD);
12531d147bfaSEmmanuel Grumbach 	spin_unlock(&sta->ps_lock);
1254948d887dSJohannes Berg 
1255e3685e03SJohannes Berg 	atomic_dec(&ps->num_sta_ps);
1256e3685e03SJohannes Berg 
1257687da132SEmmanuel Grumbach 	/* This station just woke up and isn't aware of our SMPS state */
1258062f1d6dSChun-Yeow Yeoh 	if (!ieee80211_vif_is_mesh(&sdata->vif) &&
1259062f1d6dSChun-Yeow Yeoh 	    !ieee80211_smps_is_restrictive(sta->known_smps_mode,
1260687da132SEmmanuel Grumbach 					   sdata->smps_mode) &&
1261687da132SEmmanuel Grumbach 	    sta->known_smps_mode != sdata->bss->req_smps &&
1262687da132SEmmanuel Grumbach 	    sta_info_tx_streams(sta) != 1) {
1263687da132SEmmanuel Grumbach 		ht_dbg(sdata,
1264687da132SEmmanuel Grumbach 		       "%pM just woke up and MIMO capable - update SMPS\n",
1265687da132SEmmanuel Grumbach 		       sta->sta.addr);
1266687da132SEmmanuel Grumbach 		ieee80211_send_smps_action(sdata, sdata->bss->req_smps,
1267687da132SEmmanuel Grumbach 					   sta->sta.addr,
1268687da132SEmmanuel Grumbach 					   sdata->vif.bss_conf.bssid);
1269687da132SEmmanuel Grumbach 	}
1270687da132SEmmanuel Grumbach 
1271af818581SJohannes Berg 	local->total_ps_buffered -= buffered;
1272af818581SJohannes Berg 
1273c868cb35SJohannes Berg 	sta_info_recalc_tim(sta);
1274c868cb35SJohannes Berg 
1275bdcbd8e0SJohannes Berg 	ps_dbg(sdata,
1276bdcbd8e0SJohannes Berg 	       "STA %pM aid %d sending %d filtered/%d PS frames since STA not sleeping anymore\n",
1277bdcbd8e0SJohannes Berg 	       sta->sta.addr, sta->sta.aid, filtered, buffered);
127817c18bf8SJohannes Berg 
127917c18bf8SJohannes Berg 	ieee80211_check_fast_xmit(sta);
1280af818581SJohannes Berg }
1281af818581SJohannes Berg 
12820ead2510SEmmanuel Grumbach static void ieee80211_send_null_response(struct sta_info *sta, int tid,
1283b77cf4f8SJohannes Berg 					 enum ieee80211_frame_release_type reason,
12840ead2510SEmmanuel Grumbach 					 bool call_driver, bool more_data)
1285ce662b44SJohannes Berg {
12860ead2510SEmmanuel Grumbach 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1287ce662b44SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1288ce662b44SJohannes Berg 	struct ieee80211_qos_hdr *nullfunc;
1289ce662b44SJohannes Berg 	struct sk_buff *skb;
1290ce662b44SJohannes Berg 	int size = sizeof(*nullfunc);
1291ce662b44SJohannes Berg 	__le16 fc;
1292a74a8c84SJohannes Berg 	bool qos = sta->sta.wme;
1293ce662b44SJohannes Berg 	struct ieee80211_tx_info *info;
129455de908aSJohannes Berg 	struct ieee80211_chanctx_conf *chanctx_conf;
1295ce662b44SJohannes Berg 
1296ce662b44SJohannes Berg 	if (qos) {
1297ce662b44SJohannes Berg 		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
1298ce662b44SJohannes Berg 				 IEEE80211_STYPE_QOS_NULLFUNC |
1299ce662b44SJohannes Berg 				 IEEE80211_FCTL_FROMDS);
1300ce662b44SJohannes Berg 	} else {
1301ce662b44SJohannes Berg 		size -= 2;
1302ce662b44SJohannes Berg 		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
1303ce662b44SJohannes Berg 				 IEEE80211_STYPE_NULLFUNC |
1304ce662b44SJohannes Berg 				 IEEE80211_FCTL_FROMDS);
1305ce662b44SJohannes Berg 	}
1306ce662b44SJohannes Berg 
1307ce662b44SJohannes Berg 	skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
1308ce662b44SJohannes Berg 	if (!skb)
1309ce662b44SJohannes Berg 		return;
1310ce662b44SJohannes Berg 
1311ce662b44SJohannes Berg 	skb_reserve(skb, local->hw.extra_tx_headroom);
1312ce662b44SJohannes Berg 
1313ce662b44SJohannes Berg 	nullfunc = (void *) skb_put(skb, size);
1314ce662b44SJohannes Berg 	nullfunc->frame_control = fc;
1315ce662b44SJohannes Berg 	nullfunc->duration_id = 0;
1316ce662b44SJohannes Berg 	memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
1317ce662b44SJohannes Berg 	memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
1318ce662b44SJohannes Berg 	memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
1319864a6040SJohannes Berg 	nullfunc->seq_ctrl = 0;
1320ce662b44SJohannes Berg 
1321ce662b44SJohannes Berg 	skb->priority = tid;
1322ce662b44SJohannes Berg 	skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]);
132359b66255SJohannes Berg 	if (qos) {
1324ce662b44SJohannes Berg 		nullfunc->qos_ctrl = cpu_to_le16(tid);
1325ce662b44SJohannes Berg 
13260ead2510SEmmanuel Grumbach 		if (reason == IEEE80211_FRAME_RELEASE_UAPSD) {
1327ce662b44SJohannes Berg 			nullfunc->qos_ctrl |=
1328ce662b44SJohannes Berg 				cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
13290ead2510SEmmanuel Grumbach 			if (more_data)
13300ead2510SEmmanuel Grumbach 				nullfunc->frame_control |=
13310ead2510SEmmanuel Grumbach 					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
13320ead2510SEmmanuel Grumbach 		}
1333ce662b44SJohannes Berg 	}
1334ce662b44SJohannes Berg 
1335ce662b44SJohannes Berg 	info = IEEE80211_SKB_CB(skb);
1336ce662b44SJohannes Berg 
1337ce662b44SJohannes Berg 	/*
1338ce662b44SJohannes Berg 	 * Tell TX path to send this frame even though the
1339ce662b44SJohannes Berg 	 * STA may still remain is PS mode after this frame
1340deeaee19SJohannes Berg 	 * exchange. Also set EOSP to indicate this packet
1341deeaee19SJohannes Berg 	 * ends the poll/service period.
1342ce662b44SJohannes Berg 	 */
134302f2f1a9SJohannes Berg 	info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER |
1344deeaee19SJohannes Berg 		       IEEE80211_TX_STATUS_EOSP |
1345ce662b44SJohannes Berg 		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1346ce662b44SJohannes Berg 
13476b127c71SSujith Manoharan 	info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;
13486b127c71SSujith Manoharan 
1349b77cf4f8SJohannes Berg 	if (call_driver)
1350b77cf4f8SJohannes Berg 		drv_allow_buffered_frames(local, sta, BIT(tid), 1,
1351b77cf4f8SJohannes Berg 					  reason, false);
135240b96408SJohannes Berg 
135389afe614SJohannes Berg 	skb->dev = sdata->dev;
135489afe614SJohannes Berg 
135555de908aSJohannes Berg 	rcu_read_lock();
135655de908aSJohannes Berg 	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
135755de908aSJohannes Berg 	if (WARN_ON(!chanctx_conf)) {
135855de908aSJohannes Berg 		rcu_read_unlock();
135955de908aSJohannes Berg 		kfree_skb(skb);
136055de908aSJohannes Berg 		return;
136155de908aSJohannes Berg 	}
136255de908aSJohannes Berg 
136373c4e195SJohannes Berg 	info->band = chanctx_conf->def.chan->band;
13647c10770fSJohannes Berg 	ieee80211_xmit(sdata, sta, skb);
136555de908aSJohannes Berg 	rcu_read_unlock();
1366ce662b44SJohannes Berg }
1367ce662b44SJohannes Berg 
13680a1cb809SJohannes Berg static int find_highest_prio_tid(unsigned long tids)
13690a1cb809SJohannes Berg {
13700a1cb809SJohannes Berg 	/* lower 3 TIDs aren't ordered perfectly */
13710a1cb809SJohannes Berg 	if (tids & 0xF8)
13720a1cb809SJohannes Berg 		return fls(tids) - 1;
13730a1cb809SJohannes Berg 	/* TID 0 is BE just like TID 3 */
13740a1cb809SJohannes Berg 	if (tids & BIT(0))
13750a1cb809SJohannes Berg 		return 0;
13760a1cb809SJohannes Berg 	return fls(tids) - 1;
13770a1cb809SJohannes Berg }
13780a1cb809SJohannes Berg 
13790ead2510SEmmanuel Grumbach /* Indicates if the MORE_DATA bit should be set in the last
13800ead2510SEmmanuel Grumbach  * frame obtained by ieee80211_sta_ps_get_frames.
13810ead2510SEmmanuel Grumbach  * Note that driver_release_tids is relevant only if
13820ead2510SEmmanuel Grumbach  * reason = IEEE80211_FRAME_RELEASE_PSPOLL
13830ead2510SEmmanuel Grumbach  */
13840ead2510SEmmanuel Grumbach static bool
13850ead2510SEmmanuel Grumbach ieee80211_sta_ps_more_data(struct sta_info *sta, u8 ignored_acs,
13860ead2510SEmmanuel Grumbach 			   enum ieee80211_frame_release_type reason,
13870ead2510SEmmanuel Grumbach 			   unsigned long driver_release_tids)
13880ead2510SEmmanuel Grumbach {
13890ead2510SEmmanuel Grumbach 	int ac;
13900ead2510SEmmanuel Grumbach 
13910ead2510SEmmanuel Grumbach 	/* If the driver has data on more than one TID then
13920ead2510SEmmanuel Grumbach 	 * certainly there's more data if we release just a
13930ead2510SEmmanuel Grumbach 	 * single frame now (from a single TID). This will
13940ead2510SEmmanuel Grumbach 	 * only happen for PS-Poll.
13950ead2510SEmmanuel Grumbach 	 */
13960ead2510SEmmanuel Grumbach 	if (reason == IEEE80211_FRAME_RELEASE_PSPOLL &&
13970ead2510SEmmanuel Grumbach 	    hweight16(driver_release_tids) > 1)
13980ead2510SEmmanuel Grumbach 		return true;
13990ead2510SEmmanuel Grumbach 
14000ead2510SEmmanuel Grumbach 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
14010ead2510SEmmanuel Grumbach 		if (ignored_acs & BIT(ac))
14020ead2510SEmmanuel Grumbach 			continue;
14030ead2510SEmmanuel Grumbach 
14040ead2510SEmmanuel Grumbach 		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
14050ead2510SEmmanuel Grumbach 		    !skb_queue_empty(&sta->ps_tx_buf[ac]))
14060ead2510SEmmanuel Grumbach 			return true;
14070ead2510SEmmanuel Grumbach 	}
14080ead2510SEmmanuel Grumbach 
14090ead2510SEmmanuel Grumbach 	return false;
14100ead2510SEmmanuel Grumbach }
14110ead2510SEmmanuel Grumbach 
141247086fc5SJohannes Berg static void
14130ead2510SEmmanuel Grumbach ieee80211_sta_ps_get_frames(struct sta_info *sta, int n_frames, u8 ignored_acs,
14140ead2510SEmmanuel Grumbach 			    enum ieee80211_frame_release_type reason,
14150ead2510SEmmanuel Grumbach 			    struct sk_buff_head *frames,
14160ead2510SEmmanuel Grumbach 			    unsigned long *driver_release_tids)
1417af818581SJohannes Berg {
1418af818581SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1419af818581SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1420948d887dSJohannes Berg 	int ac;
1421af818581SJohannes Berg 
1422f9f760b4SJohannes Berg 	/* Get response frame(s) and more data bit for the last one. */
1423948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
14244049e09aSJohannes Berg 		unsigned long tids;
14254049e09aSJohannes Berg 
142647086fc5SJohannes Berg 		if (ignored_acs & BIT(ac))
1427948d887dSJohannes Berg 			continue;
1428948d887dSJohannes Berg 
14294049e09aSJohannes Berg 		tids = ieee80211_tids_for_ac(ac);
14304049e09aSJohannes Berg 
1431f9f760b4SJohannes Berg 		/* if we already have frames from software, then we can't also
1432f9f760b4SJohannes Berg 		 * release from hardware queues
1433f9f760b4SJohannes Berg 		 */
14340ead2510SEmmanuel Grumbach 		if (skb_queue_empty(frames)) {
14350ead2510SEmmanuel Grumbach 			*driver_release_tids |=
14360ead2510SEmmanuel Grumbach 				sta->driver_buffered_tids & tids;
14370ead2510SEmmanuel Grumbach 			*driver_release_tids |= sta->txq_buffered_tids & tids;
1438ba8c3d6fSFelix Fietkau 		}
1439f9f760b4SJohannes Berg 
14400ead2510SEmmanuel Grumbach 		if (!*driver_release_tids) {
144147086fc5SJohannes Berg 			struct sk_buff *skb;
144247086fc5SJohannes Berg 
144347086fc5SJohannes Berg 			while (n_frames > 0) {
1444948d887dSJohannes Berg 				skb = skb_dequeue(&sta->tx_filtered[ac]);
1445948d887dSJohannes Berg 				if (!skb) {
144647086fc5SJohannes Berg 					skb = skb_dequeue(
144747086fc5SJohannes Berg 						&sta->ps_tx_buf[ac]);
1448af818581SJohannes Berg 					if (skb)
1449af818581SJohannes Berg 						local->total_ps_buffered--;
1450af818581SJohannes Berg 				}
145147086fc5SJohannes Berg 				if (!skb)
145247086fc5SJohannes Berg 					break;
145347086fc5SJohannes Berg 				n_frames--;
14540ead2510SEmmanuel Grumbach 				__skb_queue_tail(frames, skb);
145547086fc5SJohannes Berg 			}
1456948d887dSJohannes Berg 		}
1457948d887dSJohannes Berg 
14580ead2510SEmmanuel Grumbach 		/* If we have more frames buffered on this AC, then abort the
14590ead2510SEmmanuel Grumbach 		 * loop since we can't send more data from other ACs before
14600ead2510SEmmanuel Grumbach 		 * the buffered frames from this.
14614049e09aSJohannes Berg 		 */
1462948d887dSJohannes Berg 		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
14630ead2510SEmmanuel Grumbach 		    !skb_queue_empty(&sta->ps_tx_buf[ac]))
1464948d887dSJohannes Berg 			break;
1465948d887dSJohannes Berg 	}
1466948d887dSJohannes Berg }
1467af818581SJohannes Berg 
14680ead2510SEmmanuel Grumbach static void
14690ead2510SEmmanuel Grumbach ieee80211_sta_ps_deliver_response(struct sta_info *sta,
14700ead2510SEmmanuel Grumbach 				  int n_frames, u8 ignored_acs,
14710ead2510SEmmanuel Grumbach 				  enum ieee80211_frame_release_type reason)
14720ead2510SEmmanuel Grumbach {
14730ead2510SEmmanuel Grumbach 	struct ieee80211_sub_if_data *sdata = sta->sdata;
14740ead2510SEmmanuel Grumbach 	struct ieee80211_local *local = sdata->local;
14750ead2510SEmmanuel Grumbach 	unsigned long driver_release_tids = 0;
14760ead2510SEmmanuel Grumbach 	struct sk_buff_head frames;
14770ead2510SEmmanuel Grumbach 	bool more_data;
14780ead2510SEmmanuel Grumbach 
14790ead2510SEmmanuel Grumbach 	/* Service or PS-Poll period starts */
14800ead2510SEmmanuel Grumbach 	set_sta_flag(sta, WLAN_STA_SP);
14810ead2510SEmmanuel Grumbach 
14820ead2510SEmmanuel Grumbach 	__skb_queue_head_init(&frames);
14830ead2510SEmmanuel Grumbach 
14840ead2510SEmmanuel Grumbach 	ieee80211_sta_ps_get_frames(sta, n_frames, ignored_acs, reason,
14850ead2510SEmmanuel Grumbach 				    &frames, &driver_release_tids);
14860ead2510SEmmanuel Grumbach 
14870ead2510SEmmanuel Grumbach 	more_data = ieee80211_sta_ps_more_data(sta, ignored_acs, reason, driver_release_tids);
14880ead2510SEmmanuel Grumbach 
14891a57081aSEmmanuel Grumbach 	if (driver_release_tids && reason == IEEE80211_FRAME_RELEASE_PSPOLL)
14900ead2510SEmmanuel Grumbach 		driver_release_tids =
14910ead2510SEmmanuel Grumbach 			BIT(find_highest_prio_tid(driver_release_tids));
14920ead2510SEmmanuel Grumbach 
1493f9f760b4SJohannes Berg 	if (skb_queue_empty(&frames) && !driver_release_tids) {
1494ce662b44SJohannes Berg 		int tid;
14954049e09aSJohannes Berg 
1496ce662b44SJohannes Berg 		/*
1497ce662b44SJohannes Berg 		 * For PS-Poll, this can only happen due to a race condition
1498ce662b44SJohannes Berg 		 * when we set the TIM bit and the station notices it, but
1499ce662b44SJohannes Berg 		 * before it can poll for the frame we expire it.
1500ce662b44SJohannes Berg 		 *
1501ce662b44SJohannes Berg 		 * For uAPSD, this is said in the standard (11.2.1.5 h):
1502ce662b44SJohannes Berg 		 *	At each unscheduled SP for a non-AP STA, the AP shall
1503ce662b44SJohannes Berg 		 *	attempt to transmit at least one MSDU or MMPDU, but no
1504ce662b44SJohannes Berg 		 *	more than the value specified in the Max SP Length field
1505ce662b44SJohannes Berg 		 *	in the QoS Capability element from delivery-enabled ACs,
1506ce662b44SJohannes Berg 		 *	that are destined for the non-AP STA.
1507ce662b44SJohannes Berg 		 *
1508ce662b44SJohannes Berg 		 * Since we have no other MSDU/MMPDU, transmit a QoS null frame.
1509ce662b44SJohannes Berg 		 */
1510ce662b44SJohannes Berg 
1511ce662b44SJohannes Berg 		/* This will evaluate to 1, 3, 5 or 7. */
1512ce662b44SJohannes Berg 		tid = 7 - ((ffs(~ignored_acs) - 1) << 1);
1513ce662b44SJohannes Berg 
15140ead2510SEmmanuel Grumbach 		ieee80211_send_null_response(sta, tid, reason, true, false);
1515f9f760b4SJohannes Berg 	} else if (!driver_release_tids) {
151647086fc5SJohannes Berg 		struct sk_buff_head pending;
151747086fc5SJohannes Berg 		struct sk_buff *skb;
151840b96408SJohannes Berg 		int num = 0;
151940b96408SJohannes Berg 		u16 tids = 0;
1520b77cf4f8SJohannes Berg 		bool need_null = false;
152147086fc5SJohannes Berg 
152247086fc5SJohannes Berg 		skb_queue_head_init(&pending);
152347086fc5SJohannes Berg 
152447086fc5SJohannes Berg 		while ((skb = __skb_dequeue(&frames))) {
1525af818581SJohannes Berg 			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
152647086fc5SJohannes Berg 			struct ieee80211_hdr *hdr = (void *) skb->data;
152740b96408SJohannes Berg 			u8 *qoshdr = NULL;
152840b96408SJohannes Berg 
152940b96408SJohannes Berg 			num++;
1530af818581SJohannes Berg 
1531af818581SJohannes Berg 			/*
153247086fc5SJohannes Berg 			 * Tell TX path to send this frame even though the
153347086fc5SJohannes Berg 			 * STA may still remain is PS mode after this frame
153447086fc5SJohannes Berg 			 * exchange.
1535af818581SJohannes Berg 			 */
15366b127c71SSujith Manoharan 			info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER;
15376b127c71SSujith Manoharan 			info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;
1538af818581SJohannes Berg 
153947086fc5SJohannes Berg 			/*
154047086fc5SJohannes Berg 			 * Use MoreData flag to indicate whether there are
154147086fc5SJohannes Berg 			 * more buffered frames for this STA
154247086fc5SJohannes Berg 			 */
154324b9c373SJanusz.Dziedzic@tieto.com 			if (more_data || !skb_queue_empty(&frames))
154447086fc5SJohannes Berg 				hdr->frame_control |=
154547086fc5SJohannes Berg 					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
154624b9c373SJanusz.Dziedzic@tieto.com 			else
154724b9c373SJanusz.Dziedzic@tieto.com 				hdr->frame_control &=
154824b9c373SJanusz.Dziedzic@tieto.com 					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
1549af818581SJohannes Berg 
155040b96408SJohannes Berg 			if (ieee80211_is_data_qos(hdr->frame_control) ||
155140b96408SJohannes Berg 			    ieee80211_is_qos_nullfunc(hdr->frame_control))
155240b96408SJohannes Berg 				qoshdr = ieee80211_get_qos_ctl(hdr);
155340b96408SJohannes Berg 
1554b77cf4f8SJohannes Berg 			tids |= BIT(skb->priority);
1555b77cf4f8SJohannes Berg 
1556b77cf4f8SJohannes Berg 			__skb_queue_tail(&pending, skb);
1557b77cf4f8SJohannes Berg 
1558b77cf4f8SJohannes Berg 			/* end service period after last frame or add one */
1559b77cf4f8SJohannes Berg 			if (!skb_queue_empty(&frames))
1560b77cf4f8SJohannes Berg 				continue;
1561b77cf4f8SJohannes Berg 
1562b77cf4f8SJohannes Berg 			if (reason != IEEE80211_FRAME_RELEASE_UAPSD) {
1563b77cf4f8SJohannes Berg 				/* for PS-Poll, there's only one frame */
1564b77cf4f8SJohannes Berg 				info->flags |= IEEE80211_TX_STATUS_EOSP |
1565b77cf4f8SJohannes Berg 					       IEEE80211_TX_CTL_REQ_TX_STATUS;
1566b77cf4f8SJohannes Berg 				break;
1567b77cf4f8SJohannes Berg 			}
1568b77cf4f8SJohannes Berg 
1569b77cf4f8SJohannes Berg 			/* For uAPSD, things are a bit more complicated. If the
1570b77cf4f8SJohannes Berg 			 * last frame has a QoS header (i.e. is a QoS-data or
1571b77cf4f8SJohannes Berg 			 * QoS-nulldata frame) then just set the EOSP bit there
1572b77cf4f8SJohannes Berg 			 * and be done.
1573b77cf4f8SJohannes Berg 			 * If the frame doesn't have a QoS header (which means
1574b77cf4f8SJohannes Berg 			 * it should be a bufferable MMPDU) then we can't set
1575b77cf4f8SJohannes Berg 			 * the EOSP bit in the QoS header; add a QoS-nulldata
1576b77cf4f8SJohannes Berg 			 * frame to the list to send it after the MMPDU.
1577b77cf4f8SJohannes Berg 			 *
1578b77cf4f8SJohannes Berg 			 * Note that this code is only in the mac80211-release
1579b77cf4f8SJohannes Berg 			 * code path, we assume that the driver will not buffer
1580b77cf4f8SJohannes Berg 			 * anything but QoS-data frames, or if it does, will
1581b77cf4f8SJohannes Berg 			 * create the QoS-nulldata frame by itself if needed.
1582b77cf4f8SJohannes Berg 			 *
1583b77cf4f8SJohannes Berg 			 * Cf. 802.11-2012 10.2.1.10 (c).
1584b77cf4f8SJohannes Berg 			 */
1585b77cf4f8SJohannes Berg 			if (qoshdr) {
158640b96408SJohannes Berg 				*qoshdr |= IEEE80211_QOS_CTL_EOSP;
1587deeaee19SJohannes Berg 
158847086fc5SJohannes Berg 				info->flags |= IEEE80211_TX_STATUS_EOSP |
158947086fc5SJohannes Berg 					       IEEE80211_TX_CTL_REQ_TX_STATUS;
1590b77cf4f8SJohannes Berg 			} else {
1591b77cf4f8SJohannes Berg 				/* The standard isn't completely clear on this
1592b77cf4f8SJohannes Berg 				 * as it says the more-data bit should be set
1593b77cf4f8SJohannes Berg 				 * if there are more BUs. The QoS-Null frame
1594b77cf4f8SJohannes Berg 				 * we're about to send isn't buffered yet, we
1595b77cf4f8SJohannes Berg 				 * only create it below, but let's pretend it
1596b77cf4f8SJohannes Berg 				 * was buffered just in case some clients only
1597b77cf4f8SJohannes Berg 				 * expect more-data=0 when eosp=1.
1598b77cf4f8SJohannes Berg 				 */
1599b77cf4f8SJohannes Berg 				hdr->frame_control |=
1600b77cf4f8SJohannes Berg 					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
1601b77cf4f8SJohannes Berg 				need_null = true;
1602b77cf4f8SJohannes Berg 				num++;
160352a3f20cSMarco Porsch 			}
1604b77cf4f8SJohannes Berg 			break;
160547086fc5SJohannes Berg 		}
160647086fc5SJohannes Berg 
160740b96408SJohannes Berg 		drv_allow_buffered_frames(local, sta, tids, num,
160840b96408SJohannes Berg 					  reason, more_data);
160940b96408SJohannes Berg 
161047086fc5SJohannes Berg 		ieee80211_add_pending_skbs(local, &pending);
1611af818581SJohannes Berg 
1612b77cf4f8SJohannes Berg 		if (need_null)
1613b77cf4f8SJohannes Berg 			ieee80211_send_null_response(
16140ead2510SEmmanuel Grumbach 				sta, find_highest_prio_tid(tids),
16150ead2510SEmmanuel Grumbach 				reason, false, false);
1616b77cf4f8SJohannes Berg 
1617c868cb35SJohannes Berg 		sta_info_recalc_tim(sta);
1618af818581SJohannes Berg 	} else {
1619ba8c3d6fSFelix Fietkau 		unsigned long tids = sta->txq_buffered_tids & driver_release_tids;
1620ba8c3d6fSFelix Fietkau 		int tid;
1621ba8c3d6fSFelix Fietkau 
1622af818581SJohannes Berg 		/*
16234049e09aSJohannes Berg 		 * We need to release a frame that is buffered somewhere in the
16244049e09aSJohannes Berg 		 * driver ... it'll have to handle that.
1625f9f760b4SJohannes Berg 		 * Note that the driver also has to check the number of frames
1626f9f760b4SJohannes Berg 		 * on the TIDs we're releasing from - if there are more than
1627f9f760b4SJohannes Berg 		 * n_frames it has to set the more-data bit (if we didn't ask
1628f9f760b4SJohannes Berg 		 * it to set it anyway due to other buffered frames); if there
1629f9f760b4SJohannes Berg 		 * are fewer than n_frames it has to make sure to adjust that
1630f9f760b4SJohannes Berg 		 * to allow the service period to end properly.
1631af818581SJohannes Berg 		 */
16324049e09aSJohannes Berg 		drv_release_buffered_frames(local, sta, driver_release_tids,
163347086fc5SJohannes Berg 					    n_frames, reason, more_data);
16344049e09aSJohannes Berg 
16354049e09aSJohannes Berg 		/*
16364049e09aSJohannes Berg 		 * Note that we don't recalculate the TIM bit here as it would
16374049e09aSJohannes Berg 		 * most likely have no effect at all unless the driver told us
1638f9f760b4SJohannes Berg 		 * that the TID(s) became empty before returning here from the
16394049e09aSJohannes Berg 		 * release function.
1640f9f760b4SJohannes Berg 		 * Either way, however, when the driver tells us that the TID(s)
1641ba8c3d6fSFelix Fietkau 		 * became empty or we find that a txq became empty, we'll do the
1642ba8c3d6fSFelix Fietkau 		 * TIM recalculation.
16434049e09aSJohannes Berg 		 */
1644ba8c3d6fSFelix Fietkau 
1645ba8c3d6fSFelix Fietkau 		if (!sta->sta.txq[0])
1646ba8c3d6fSFelix Fietkau 			return;
1647ba8c3d6fSFelix Fietkau 
1648ba8c3d6fSFelix Fietkau 		for (tid = 0; tid < ARRAY_SIZE(sta->sta.txq); tid++) {
1649ba8c3d6fSFelix Fietkau 			struct txq_info *txqi = to_txq_info(sta->sta.txq[tid]);
1650ba8c3d6fSFelix Fietkau 
1651*fa962b92SMichal Kazior 			if (!(tids & BIT(tid)) || txqi->tin.backlog_packets)
1652ba8c3d6fSFelix Fietkau 				continue;
1653ba8c3d6fSFelix Fietkau 
1654ba8c3d6fSFelix Fietkau 			sta_info_recalc_tim(sta);
1655ba8c3d6fSFelix Fietkau 			break;
1656ba8c3d6fSFelix Fietkau 		}
1657af818581SJohannes Berg 	}
1658af818581SJohannes Berg }
1659af818581SJohannes Berg 
1660af818581SJohannes Berg void ieee80211_sta_ps_deliver_poll_response(struct sta_info *sta)
1661af818581SJohannes Berg {
166247086fc5SJohannes Berg 	u8 ignore_for_response = sta->sta.uapsd_queues;
1663af818581SJohannes Berg 
1664af818581SJohannes Berg 	/*
166547086fc5SJohannes Berg 	 * If all ACs are delivery-enabled then we should reply
166647086fc5SJohannes Berg 	 * from any of them, if only some are enabled we reply
166747086fc5SJohannes Berg 	 * only from the non-enabled ones.
1668af818581SJohannes Berg 	 */
166947086fc5SJohannes Berg 	if (ignore_for_response == BIT(IEEE80211_NUM_ACS) - 1)
167047086fc5SJohannes Berg 		ignore_for_response = 0;
1671af818581SJohannes Berg 
167247086fc5SJohannes Berg 	ieee80211_sta_ps_deliver_response(sta, 1, ignore_for_response,
167347086fc5SJohannes Berg 					  IEEE80211_FRAME_RELEASE_PSPOLL);
1674af818581SJohannes Berg }
167547086fc5SJohannes Berg 
167647086fc5SJohannes Berg void ieee80211_sta_ps_deliver_uapsd(struct sta_info *sta)
167747086fc5SJohannes Berg {
167847086fc5SJohannes Berg 	int n_frames = sta->sta.max_sp;
167947086fc5SJohannes Berg 	u8 delivery_enabled = sta->sta.uapsd_queues;
168047086fc5SJohannes Berg 
168147086fc5SJohannes Berg 	/*
168247086fc5SJohannes Berg 	 * If we ever grow support for TSPEC this might happen if
168347086fc5SJohannes Berg 	 * the TSPEC update from hostapd comes in between a trigger
168447086fc5SJohannes Berg 	 * frame setting WLAN_STA_UAPSD in the RX path and this
168547086fc5SJohannes Berg 	 * actually getting called.
168647086fc5SJohannes Berg 	 */
168747086fc5SJohannes Berg 	if (!delivery_enabled)
168847086fc5SJohannes Berg 		return;
168947086fc5SJohannes Berg 
169047086fc5SJohannes Berg 	switch (sta->sta.max_sp) {
169147086fc5SJohannes Berg 	case 1:
169247086fc5SJohannes Berg 		n_frames = 2;
169347086fc5SJohannes Berg 		break;
169447086fc5SJohannes Berg 	case 2:
169547086fc5SJohannes Berg 		n_frames = 4;
169647086fc5SJohannes Berg 		break;
169747086fc5SJohannes Berg 	case 3:
169847086fc5SJohannes Berg 		n_frames = 6;
169947086fc5SJohannes Berg 		break;
170047086fc5SJohannes Berg 	case 0:
170147086fc5SJohannes Berg 		/* XXX: what is a good value? */
170213a8098aSAndrei Otcheretianski 		n_frames = 128;
170347086fc5SJohannes Berg 		break;
170447086fc5SJohannes Berg 	}
170547086fc5SJohannes Berg 
170647086fc5SJohannes Berg 	ieee80211_sta_ps_deliver_response(sta, n_frames, ~delivery_enabled,
170747086fc5SJohannes Berg 					  IEEE80211_FRAME_RELEASE_UAPSD);
1708af818581SJohannes Berg }
1709af818581SJohannes Berg 
1710af818581SJohannes Berg void ieee80211_sta_block_awake(struct ieee80211_hw *hw,
1711af818581SJohannes Berg 			       struct ieee80211_sta *pubsta, bool block)
1712af818581SJohannes Berg {
1713af818581SJohannes Berg 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
1714af818581SJohannes Berg 
1715b5878a2dSJohannes Berg 	trace_api_sta_block_awake(sta->local, pubsta, block);
1716b5878a2dSJohannes Berg 
17175ac2e350SJohannes Berg 	if (block) {
1718c2c98fdeSJohannes Berg 		set_sta_flag(sta, WLAN_STA_PS_DRIVER);
171917c18bf8SJohannes Berg 		ieee80211_clear_fast_xmit(sta);
17205ac2e350SJohannes Berg 		return;
17215ac2e350SJohannes Berg 	}
17225ac2e350SJohannes Berg 
17235ac2e350SJohannes Berg 	if (!test_sta_flag(sta, WLAN_STA_PS_DRIVER))
17245ac2e350SJohannes Berg 		return;
17255ac2e350SJohannes Berg 
17265ac2e350SJohannes Berg 	if (!test_sta_flag(sta, WLAN_STA_PS_STA)) {
17275ac2e350SJohannes Berg 		set_sta_flag(sta, WLAN_STA_PS_DELIVER);
17285ac2e350SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
17295ac2e350SJohannes Berg 		ieee80211_queue_work(hw, &sta->drv_deliver_wk);
17305ac2e350SJohannes Berg 	} else if (test_sta_flag(sta, WLAN_STA_PSPOLL) ||
17315ac2e350SJohannes Berg 		   test_sta_flag(sta, WLAN_STA_UAPSD)) {
17325ac2e350SJohannes Berg 		/* must be asleep in this case */
17335ac2e350SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
17345ac2e350SJohannes Berg 		ieee80211_queue_work(hw, &sta->drv_deliver_wk);
17355ac2e350SJohannes Berg 	} else {
17365ac2e350SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
173717c18bf8SJohannes Berg 		ieee80211_check_fast_xmit(sta);
17385ac2e350SJohannes Berg 	}
1739af818581SJohannes Berg }
1740af818581SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_block_awake);
1741dcf55fb5SFelix Fietkau 
1742e943789eSJohannes Berg void ieee80211_sta_eosp(struct ieee80211_sta *pubsta)
174337fbd908SJohannes Berg {
174437fbd908SJohannes Berg 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
174537fbd908SJohannes Berg 	struct ieee80211_local *local = sta->local;
174637fbd908SJohannes Berg 
174737fbd908SJohannes Berg 	trace_api_eosp(local, pubsta);
174837fbd908SJohannes Berg 
174937fbd908SJohannes Berg 	clear_sta_flag(sta, WLAN_STA_SP);
175037fbd908SJohannes Berg }
1751e943789eSJohannes Berg EXPORT_SYMBOL(ieee80211_sta_eosp);
175237fbd908SJohannes Berg 
17530ead2510SEmmanuel Grumbach void ieee80211_send_eosp_nullfunc(struct ieee80211_sta *pubsta, int tid)
17540ead2510SEmmanuel Grumbach {
17550ead2510SEmmanuel Grumbach 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
17560ead2510SEmmanuel Grumbach 	enum ieee80211_frame_release_type reason;
17570ead2510SEmmanuel Grumbach 	bool more_data;
17580ead2510SEmmanuel Grumbach 
17590ead2510SEmmanuel Grumbach 	trace_api_send_eosp_nullfunc(sta->local, pubsta, tid);
17600ead2510SEmmanuel Grumbach 
17610ead2510SEmmanuel Grumbach 	reason = IEEE80211_FRAME_RELEASE_UAPSD;
17620ead2510SEmmanuel Grumbach 	more_data = ieee80211_sta_ps_more_data(sta, ~sta->sta.uapsd_queues,
17630ead2510SEmmanuel Grumbach 					       reason, 0);
17640ead2510SEmmanuel Grumbach 
17650ead2510SEmmanuel Grumbach 	ieee80211_send_null_response(sta, tid, reason, false, more_data);
17660ead2510SEmmanuel Grumbach }
17670ead2510SEmmanuel Grumbach EXPORT_SYMBOL(ieee80211_send_eosp_nullfunc);
17680ead2510SEmmanuel Grumbach 
1769042ec453SJohannes Berg void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta,
1770042ec453SJohannes Berg 				u8 tid, bool buffered)
1771dcf55fb5SFelix Fietkau {
1772dcf55fb5SFelix Fietkau 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
1773dcf55fb5SFelix Fietkau 
17745a306f58SJohannes Berg 	if (WARN_ON(tid >= IEEE80211_NUM_TIDS))
1775042ec453SJohannes Berg 		return;
1776042ec453SJohannes Berg 
17771b000789SJohannes Berg 	trace_api_sta_set_buffered(sta->local, pubsta, tid, buffered);
17781b000789SJohannes Berg 
1779948d887dSJohannes Berg 	if (buffered)
1780948d887dSJohannes Berg 		set_bit(tid, &sta->driver_buffered_tids);
1781948d887dSJohannes Berg 	else
1782948d887dSJohannes Berg 		clear_bit(tid, &sta->driver_buffered_tids);
1783948d887dSJohannes Berg 
1784c868cb35SJohannes Berg 	sta_info_recalc_tim(sta);
1785dcf55fb5SFelix Fietkau }
1786042ec453SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_set_buffered);
1787d9a7ddb0SJohannes Berg 
178852cfa1d6SAyala Beker static void
178952cfa1d6SAyala Beker ieee80211_recalc_p2p_go_ps_allowed(struct ieee80211_sub_if_data *sdata)
179052cfa1d6SAyala Beker {
179152cfa1d6SAyala Beker 	struct ieee80211_local *local = sdata->local;
179252cfa1d6SAyala Beker 	bool allow_p2p_go_ps = sdata->vif.p2p;
179352cfa1d6SAyala Beker 	struct sta_info *sta;
179452cfa1d6SAyala Beker 
179552cfa1d6SAyala Beker 	rcu_read_lock();
179652cfa1d6SAyala Beker 	list_for_each_entry_rcu(sta, &local->sta_list, list) {
179752cfa1d6SAyala Beker 		if (sdata != sta->sdata ||
179852cfa1d6SAyala Beker 		    !test_sta_flag(sta, WLAN_STA_ASSOC))
179952cfa1d6SAyala Beker 			continue;
180052cfa1d6SAyala Beker 		if (!sta->sta.support_p2p_ps) {
180152cfa1d6SAyala Beker 			allow_p2p_go_ps = false;
180252cfa1d6SAyala Beker 			break;
180352cfa1d6SAyala Beker 		}
180452cfa1d6SAyala Beker 	}
180552cfa1d6SAyala Beker 	rcu_read_unlock();
180652cfa1d6SAyala Beker 
180752cfa1d6SAyala Beker 	if (allow_p2p_go_ps != sdata->vif.bss_conf.allow_p2p_go_ps) {
180852cfa1d6SAyala Beker 		sdata->vif.bss_conf.allow_p2p_go_ps = allow_p2p_go_ps;
180952cfa1d6SAyala Beker 		ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_P2P_PS);
181052cfa1d6SAyala Beker 	}
181152cfa1d6SAyala Beker }
181252cfa1d6SAyala Beker 
181383d5cc01SJohannes Berg int sta_info_move_state(struct sta_info *sta,
1814d9a7ddb0SJohannes Berg 			enum ieee80211_sta_state new_state)
1815d9a7ddb0SJohannes Berg {
18168bf11d8dSJohannes Berg 	might_sleep();
1817d9a7ddb0SJohannes Berg 
1818d9a7ddb0SJohannes Berg 	if (sta->sta_state == new_state)
1819d9a7ddb0SJohannes Berg 		return 0;
1820d9a7ddb0SJohannes Berg 
1821f09603a2SJohannes Berg 	/* check allowed transitions first */
1822f09603a2SJohannes Berg 
1823d9a7ddb0SJohannes Berg 	switch (new_state) {
1824d9a7ddb0SJohannes Berg 	case IEEE80211_STA_NONE:
1825f09603a2SJohannes Berg 		if (sta->sta_state != IEEE80211_STA_AUTH)
1826d9a7ddb0SJohannes Berg 			return -EINVAL;
1827d9a7ddb0SJohannes Berg 		break;
1828d9a7ddb0SJohannes Berg 	case IEEE80211_STA_AUTH:
1829f09603a2SJohannes Berg 		if (sta->sta_state != IEEE80211_STA_NONE &&
1830f09603a2SJohannes Berg 		    sta->sta_state != IEEE80211_STA_ASSOC)
1831d9a7ddb0SJohannes Berg 			return -EINVAL;
1832d9a7ddb0SJohannes Berg 		break;
1833d9a7ddb0SJohannes Berg 	case IEEE80211_STA_ASSOC:
1834f09603a2SJohannes Berg 		if (sta->sta_state != IEEE80211_STA_AUTH &&
1835f09603a2SJohannes Berg 		    sta->sta_state != IEEE80211_STA_AUTHORIZED)
1836d9a7ddb0SJohannes Berg 			return -EINVAL;
1837d9a7ddb0SJohannes Berg 		break;
1838d9a7ddb0SJohannes Berg 	case IEEE80211_STA_AUTHORIZED:
1839f09603a2SJohannes Berg 		if (sta->sta_state != IEEE80211_STA_ASSOC)
1840d9a7ddb0SJohannes Berg 			return -EINVAL;
1841d9a7ddb0SJohannes Berg 		break;
1842d9a7ddb0SJohannes Berg 	default:
1843d9a7ddb0SJohannes Berg 		WARN(1, "invalid state %d", new_state);
1844d9a7ddb0SJohannes Berg 		return -EINVAL;
1845d9a7ddb0SJohannes Berg 	}
1846d9a7ddb0SJohannes Berg 
1847bdcbd8e0SJohannes Berg 	sta_dbg(sta->sdata, "moving STA %pM to state %d\n",
1848bdcbd8e0SJohannes Berg 		sta->sta.addr, new_state);
1849f09603a2SJohannes Berg 
1850f09603a2SJohannes Berg 	/*
1851f09603a2SJohannes Berg 	 * notify the driver before the actual changes so it can
1852f09603a2SJohannes Berg 	 * fail the transition
1853f09603a2SJohannes Berg 	 */
1854f09603a2SJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_INSERTED)) {
1855f09603a2SJohannes Berg 		int err = drv_sta_state(sta->local, sta->sdata, sta,
1856f09603a2SJohannes Berg 					sta->sta_state, new_state);
1857f09603a2SJohannes Berg 		if (err)
1858f09603a2SJohannes Berg 			return err;
1859f09603a2SJohannes Berg 	}
1860f09603a2SJohannes Berg 
1861f09603a2SJohannes Berg 	/* reflect the change in all state variables */
1862f09603a2SJohannes Berg 
1863f09603a2SJohannes Berg 	switch (new_state) {
1864f09603a2SJohannes Berg 	case IEEE80211_STA_NONE:
1865f09603a2SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_AUTH)
1866f09603a2SJohannes Berg 			clear_bit(WLAN_STA_AUTH, &sta->_flags);
1867f09603a2SJohannes Berg 		break;
1868f09603a2SJohannes Berg 	case IEEE80211_STA_AUTH:
1869a7201a6cSIlan Peer 		if (sta->sta_state == IEEE80211_STA_NONE) {
1870f09603a2SJohannes Berg 			set_bit(WLAN_STA_AUTH, &sta->_flags);
1871a7201a6cSIlan Peer 		} else if (sta->sta_state == IEEE80211_STA_ASSOC) {
1872f09603a2SJohannes Berg 			clear_bit(WLAN_STA_ASSOC, &sta->_flags);
1873a7201a6cSIlan Peer 			ieee80211_recalc_min_chandef(sta->sdata);
187452cfa1d6SAyala Beker 			if (!sta->sta.support_p2p_ps)
187552cfa1d6SAyala Beker 				ieee80211_recalc_p2p_go_ps_allowed(sta->sdata);
1876a7201a6cSIlan Peer 		}
1877f09603a2SJohannes Berg 		break;
1878f09603a2SJohannes Berg 	case IEEE80211_STA_ASSOC:
1879f09603a2SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_AUTH) {
1880f09603a2SJohannes Berg 			set_bit(WLAN_STA_ASSOC, &sta->_flags);
1881a7201a6cSIlan Peer 			ieee80211_recalc_min_chandef(sta->sdata);
188252cfa1d6SAyala Beker 			if (!sta->sta.support_p2p_ps)
188352cfa1d6SAyala Beker 				ieee80211_recalc_p2p_go_ps_allowed(sta->sdata);
1884f09603a2SJohannes Berg 		} else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) {
18857e3ed02cSFelix Fietkau 			if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
18867e3ed02cSFelix Fietkau 			    (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
18877e3ed02cSFelix Fietkau 			     !sta->sdata->u.vlan.sta))
18887e3ed02cSFelix Fietkau 				atomic_dec(&sta->sdata->bss->num_mcast_sta);
1889f09603a2SJohannes Berg 			clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
189017c18bf8SJohannes Berg 			ieee80211_clear_fast_xmit(sta);
189149ddf8e6SJohannes Berg 			ieee80211_clear_fast_rx(sta);
1892f09603a2SJohannes Berg 		}
1893f09603a2SJohannes Berg 		break;
1894f09603a2SJohannes Berg 	case IEEE80211_STA_AUTHORIZED:
1895f09603a2SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_ASSOC) {
18967e3ed02cSFelix Fietkau 			if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
18977e3ed02cSFelix Fietkau 			    (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
18987e3ed02cSFelix Fietkau 			     !sta->sdata->u.vlan.sta))
18997e3ed02cSFelix Fietkau 				atomic_inc(&sta->sdata->bss->num_mcast_sta);
1900f09603a2SJohannes Berg 			set_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
190117c18bf8SJohannes Berg 			ieee80211_check_fast_xmit(sta);
190249ddf8e6SJohannes Berg 			ieee80211_check_fast_rx(sta);
1903f09603a2SJohannes Berg 		}
1904f09603a2SJohannes Berg 		break;
1905f09603a2SJohannes Berg 	default:
1906f09603a2SJohannes Berg 		break;
1907f09603a2SJohannes Berg 	}
1908f09603a2SJohannes Berg 
1909d9a7ddb0SJohannes Berg 	sta->sta_state = new_state;
1910d9a7ddb0SJohannes Berg 
1911d9a7ddb0SJohannes Berg 	return 0;
1912d9a7ddb0SJohannes Berg }
1913687da132SEmmanuel Grumbach 
1914687da132SEmmanuel Grumbach u8 sta_info_tx_streams(struct sta_info *sta)
1915687da132SEmmanuel Grumbach {
1916687da132SEmmanuel Grumbach 	struct ieee80211_sta_ht_cap *ht_cap = &sta->sta.ht_cap;
1917687da132SEmmanuel Grumbach 	u8 rx_streams;
1918687da132SEmmanuel Grumbach 
1919687da132SEmmanuel Grumbach 	if (!sta->sta.ht_cap.ht_supported)
1920687da132SEmmanuel Grumbach 		return 1;
1921687da132SEmmanuel Grumbach 
1922687da132SEmmanuel Grumbach 	if (sta->sta.vht_cap.vht_supported) {
1923687da132SEmmanuel Grumbach 		int i;
1924687da132SEmmanuel Grumbach 		u16 tx_mcs_map =
1925687da132SEmmanuel Grumbach 			le16_to_cpu(sta->sta.vht_cap.vht_mcs.tx_mcs_map);
1926687da132SEmmanuel Grumbach 
1927687da132SEmmanuel Grumbach 		for (i = 7; i >= 0; i--)
1928687da132SEmmanuel Grumbach 			if ((tx_mcs_map & (0x3 << (i * 2))) !=
1929687da132SEmmanuel Grumbach 			    IEEE80211_VHT_MCS_NOT_SUPPORTED)
1930687da132SEmmanuel Grumbach 				return i + 1;
1931687da132SEmmanuel Grumbach 	}
1932687da132SEmmanuel Grumbach 
1933687da132SEmmanuel Grumbach 	if (ht_cap->mcs.rx_mask[3])
1934687da132SEmmanuel Grumbach 		rx_streams = 4;
1935687da132SEmmanuel Grumbach 	else if (ht_cap->mcs.rx_mask[2])
1936687da132SEmmanuel Grumbach 		rx_streams = 3;
1937687da132SEmmanuel Grumbach 	else if (ht_cap->mcs.rx_mask[1])
1938687da132SEmmanuel Grumbach 		rx_streams = 2;
1939687da132SEmmanuel Grumbach 	else
1940687da132SEmmanuel Grumbach 		rx_streams = 1;
1941687da132SEmmanuel Grumbach 
1942687da132SEmmanuel Grumbach 	if (!(ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_RX_DIFF))
1943687da132SEmmanuel Grumbach 		return rx_streams;
1944687da132SEmmanuel Grumbach 
1945687da132SEmmanuel Grumbach 	return ((ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK)
1946687da132SEmmanuel Grumbach 			>> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT) + 1;
1947687da132SEmmanuel Grumbach }
1948b7ffbd7eSJohannes Berg 
1949c9c5962bSJohannes Berg static struct ieee80211_sta_rx_stats *
1950c9c5962bSJohannes Berg sta_get_last_rx_stats(struct sta_info *sta)
1951c9c5962bSJohannes Berg {
1952c9c5962bSJohannes Berg 	struct ieee80211_sta_rx_stats *stats = &sta->rx_stats;
1953c9c5962bSJohannes Berg 	struct ieee80211_local *local = sta->local;
1954c9c5962bSJohannes Berg 	int cpu;
1955c9c5962bSJohannes Berg 
1956c9c5962bSJohannes Berg 	if (!ieee80211_hw_check(&local->hw, USES_RSS))
1957c9c5962bSJohannes Berg 		return stats;
1958c9c5962bSJohannes Berg 
1959c9c5962bSJohannes Berg 	for_each_possible_cpu(cpu) {
1960c9c5962bSJohannes Berg 		struct ieee80211_sta_rx_stats *cpustats;
1961c9c5962bSJohannes Berg 
1962c9c5962bSJohannes Berg 		cpustats = per_cpu_ptr(sta->pcpu_rx_stats, cpu);
1963c9c5962bSJohannes Berg 
1964c9c5962bSJohannes Berg 		if (time_after(cpustats->last_rx, stats->last_rx))
1965c9c5962bSJohannes Berg 			stats = cpustats;
1966c9c5962bSJohannes Berg 	}
1967c9c5962bSJohannes Berg 
1968c9c5962bSJohannes Berg 	return stats;
1969c9c5962bSJohannes Berg }
1970c9c5962bSJohannes Berg 
19714f6b1b3dSJohannes Berg static void sta_stats_decode_rate(struct ieee80211_local *local, u16 rate,
19724f6b1b3dSJohannes Berg 				  struct rate_info *rinfo)
1973fbd6ff5cSJohannes Berg {
19744f6b1b3dSJohannes Berg 	rinfo->bw = (rate & STA_STATS_RATE_BW_MASK) >>
19754f6b1b3dSJohannes Berg 		STA_STATS_RATE_BW_SHIFT;
1976fbd6ff5cSJohannes Berg 
19774f6b1b3dSJohannes Berg 	if (rate & STA_STATS_RATE_VHT) {
19784f6b1b3dSJohannes Berg 		rinfo->flags = RATE_INFO_FLAGS_VHT_MCS;
19794f6b1b3dSJohannes Berg 		rinfo->mcs = rate & 0xf;
19804f6b1b3dSJohannes Berg 		rinfo->nss = (rate & 0xf0) >> 4;
19814f6b1b3dSJohannes Berg 	} else if (rate & STA_STATS_RATE_HT) {
19824f6b1b3dSJohannes Berg 		rinfo->flags = RATE_INFO_FLAGS_MCS;
19834f6b1b3dSJohannes Berg 		rinfo->mcs = rate & 0xff;
19844f6b1b3dSJohannes Berg 	} else if (rate & STA_STATS_RATE_LEGACY) {
1985fbd6ff5cSJohannes Berg 		struct ieee80211_supported_band *sband;
1986fbd6ff5cSJohannes Berg 		u16 brate;
19874f6b1b3dSJohannes Berg 		unsigned int shift;
1988fbd6ff5cSJohannes Berg 
19894f6b1b3dSJohannes Berg 		sband = local->hw.wiphy->bands[(rate >> 4) & 0xf];
19904f6b1b3dSJohannes Berg 		brate = sband->bitrates[rate & 0xf].bitrate;
19914f6b1b3dSJohannes Berg 		if (rinfo->bw == RATE_INFO_BW_5)
19924f6b1b3dSJohannes Berg 			shift = 2;
19934f6b1b3dSJohannes Berg 		else if (rinfo->bw == RATE_INFO_BW_10)
19944f6b1b3dSJohannes Berg 			shift = 1;
19954f6b1b3dSJohannes Berg 		else
19964f6b1b3dSJohannes Berg 			shift = 0;
1997fbd6ff5cSJohannes Berg 		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
1998fbd6ff5cSJohannes Berg 	}
1999fbd6ff5cSJohannes Berg 
20004f6b1b3dSJohannes Berg 	if (rate & STA_STATS_RATE_SGI)
2001fbd6ff5cSJohannes Berg 		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
20024f6b1b3dSJohannes Berg }
2003fbd6ff5cSJohannes Berg 
20044f6b1b3dSJohannes Berg static void sta_set_rate_info_rx(struct sta_info *sta, struct rate_info *rinfo)
20054f6b1b3dSJohannes Berg {
2006c9c5962bSJohannes Berg 	u16 rate = ACCESS_ONCE(sta_get_last_rx_stats(sta)->last_rate);
20074f6b1b3dSJohannes Berg 
20084f6b1b3dSJohannes Berg 	if (rate == STA_STATS_RATE_INVALID)
20094f6b1b3dSJohannes Berg 		rinfo->flags = 0;
2010fbd6ff5cSJohannes Berg 	else
20114f6b1b3dSJohannes Berg 		sta_stats_decode_rate(sta->local, rate, rinfo);
2012fbd6ff5cSJohannes Berg }
2013fbd6ff5cSJohannes Berg 
20140f9c5a61SJohannes Berg static void sta_set_tidstats(struct sta_info *sta,
20150f9c5a61SJohannes Berg 			     struct cfg80211_tid_stats *tidstats,
20160f9c5a61SJohannes Berg 			     int tid)
20170f9c5a61SJohannes Berg {
20180f9c5a61SJohannes Berg 	struct ieee80211_local *local = sta->local;
20190f9c5a61SJohannes Berg 
20200f9c5a61SJohannes Berg 	if (!(tidstats->filled & BIT(NL80211_TID_STATS_RX_MSDU))) {
20210f9c5a61SJohannes Berg 		unsigned int start;
20220f9c5a61SJohannes Berg 
20230f9c5a61SJohannes Berg 		do {
20240f9c5a61SJohannes Berg 			start = u64_stats_fetch_begin(&sta->rx_stats.syncp);
20250f9c5a61SJohannes Berg 			tidstats->rx_msdu = sta->rx_stats.msdu[tid];
20260f9c5a61SJohannes Berg 		} while (u64_stats_fetch_retry(&sta->rx_stats.syncp, start));
20270f9c5a61SJohannes Berg 
20280f9c5a61SJohannes Berg 		tidstats->filled |= BIT(NL80211_TID_STATS_RX_MSDU);
20290f9c5a61SJohannes Berg 	}
20300f9c5a61SJohannes Berg 
20310f9c5a61SJohannes Berg 	if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU))) {
20320f9c5a61SJohannes Berg 		tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU);
20330f9c5a61SJohannes Berg 		tidstats->tx_msdu = sta->tx_stats.msdu[tid];
20340f9c5a61SJohannes Berg 	}
20350f9c5a61SJohannes Berg 
20360f9c5a61SJohannes Berg 	if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU_RETRIES)) &&
20370f9c5a61SJohannes Berg 	    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
20380f9c5a61SJohannes Berg 		tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU_RETRIES);
20390f9c5a61SJohannes Berg 		tidstats->tx_msdu_retries = sta->status_stats.msdu_retries[tid];
20400f9c5a61SJohannes Berg 	}
20410f9c5a61SJohannes Berg 
20420f9c5a61SJohannes Berg 	if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU_FAILED)) &&
20430f9c5a61SJohannes Berg 	    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
20440f9c5a61SJohannes Berg 		tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU_FAILED);
20450f9c5a61SJohannes Berg 		tidstats->tx_msdu_failed = sta->status_stats.msdu_failed[tid];
20460f9c5a61SJohannes Berg 	}
20470f9c5a61SJohannes Berg }
20480f9c5a61SJohannes Berg 
2049c9c5962bSJohannes Berg static inline u64 sta_get_stats_bytes(struct ieee80211_sta_rx_stats *rxstats)
2050c9c5962bSJohannes Berg {
2051c9c5962bSJohannes Berg 	unsigned int start;
2052c9c5962bSJohannes Berg 	u64 value;
2053c9c5962bSJohannes Berg 
2054c9c5962bSJohannes Berg 	do {
2055c9c5962bSJohannes Berg 		start = u64_stats_fetch_begin(&rxstats->syncp);
2056c9c5962bSJohannes Berg 		value = rxstats->bytes;
2057c9c5962bSJohannes Berg 	} while (u64_stats_fetch_retry(&rxstats->syncp, start));
2058c9c5962bSJohannes Berg 
2059c9c5962bSJohannes Berg 	return value;
2060c9c5962bSJohannes Berg }
2061c9c5962bSJohannes Berg 
2062b7ffbd7eSJohannes Berg void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
2063b7ffbd7eSJohannes Berg {
2064b7ffbd7eSJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
2065b7ffbd7eSJohannes Berg 	struct ieee80211_local *local = sdata->local;
20669a244409SJohn W. Linville 	struct rate_control_ref *ref = NULL;
2067b7ffbd7eSJohannes Berg 	u32 thr = 0;
2068c9c5962bSJohannes Berg 	int i, ac, cpu;
2069c9c5962bSJohannes Berg 	struct ieee80211_sta_rx_stats *last_rxstats;
2070c9c5962bSJohannes Berg 
2071c9c5962bSJohannes Berg 	last_rxstats = sta_get_last_rx_stats(sta);
2072b7ffbd7eSJohannes Berg 
20739a244409SJohn W. Linville 	if (test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
20749a244409SJohn W. Linville 		ref = local->rate_ctrl;
20759a244409SJohn W. Linville 
2076b7ffbd7eSJohannes Berg 	sinfo->generation = sdata->local->sta_generation;
2077b7ffbd7eSJohannes Berg 
2078225b8189SJohannes Berg 	/* do before driver, so beacon filtering drivers have a
2079225b8189SJohannes Berg 	 * chance to e.g. just add the number of filtered beacons
2080225b8189SJohannes Berg 	 * (or just modify the value entirely, of course)
2081225b8189SJohannes Berg 	 */
2082225b8189SJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_STATION)
2083225b8189SJohannes Berg 		sinfo->rx_beacon = sdata->u.mgd.count_beacon_signal;
2084225b8189SJohannes Berg 
20852b9a7e1bSJohannes Berg 	drv_sta_statistics(local, sdata, &sta->sta, sinfo);
20862b9a7e1bSJohannes Berg 
2087319090bfSJohannes Berg 	sinfo->filled |= BIT(NL80211_STA_INFO_INACTIVE_TIME) |
2088319090bfSJohannes Berg 			 BIT(NL80211_STA_INFO_STA_FLAGS) |
2089319090bfSJohannes Berg 			 BIT(NL80211_STA_INFO_BSS_PARAM) |
2090319090bfSJohannes Berg 			 BIT(NL80211_STA_INFO_CONNECTED_TIME) |
2091976bd9efSJohannes Berg 			 BIT(NL80211_STA_INFO_RX_DROP_MISC);
2092976bd9efSJohannes Berg 
2093976bd9efSJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
2094976bd9efSJohannes Berg 		sinfo->beacon_loss_count = sdata->u.mgd.beacon_loss_count;
2095976bd9efSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_LOSS);
2096976bd9efSJohannes Berg 	}
2097b7ffbd7eSJohannes Berg 
209884b00607SArnd Bergmann 	sinfo->connected_time = ktime_get_seconds() - sta->last_connected;
2099e5a9f8d0SJohannes Berg 	sinfo->inactive_time =
2100b8da6b6aSJohannes Berg 		jiffies_to_msecs(jiffies - ieee80211_sta_last_active(sta));
21012b9a7e1bSJohannes Berg 
2102319090bfSJohannes Berg 	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES64) |
2103319090bfSJohannes Berg 			       BIT(NL80211_STA_INFO_TX_BYTES)))) {
2104b7ffbd7eSJohannes Berg 		sinfo->tx_bytes = 0;
21052b9a7e1bSJohannes Berg 		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
2106e5a9f8d0SJohannes Berg 			sinfo->tx_bytes += sta->tx_stats.bytes[ac];
2107319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64);
2108b7ffbd7eSJohannes Berg 	}
21092b9a7e1bSJohannes Berg 
2110319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_PACKETS))) {
21112b9a7e1bSJohannes Berg 		sinfo->tx_packets = 0;
21122b9a7e1bSJohannes Berg 		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
2113e5a9f8d0SJohannes Berg 			sinfo->tx_packets += sta->tx_stats.packets[ac];
2114319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS);
21152b9a7e1bSJohannes Berg 	}
21162b9a7e1bSJohannes Berg 
2117319090bfSJohannes Berg 	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES64) |
2118319090bfSJohannes Berg 			       BIT(NL80211_STA_INFO_RX_BYTES)))) {
2119c9c5962bSJohannes Berg 		sinfo->rx_bytes += sta_get_stats_bytes(&sta->rx_stats);
21200f9c5a61SJohannes Berg 
2121c9c5962bSJohannes Berg 		if (sta->pcpu_rx_stats) {
2122c9c5962bSJohannes Berg 			for_each_possible_cpu(cpu) {
2123c9c5962bSJohannes Berg 				struct ieee80211_sta_rx_stats *cpurxs;
2124c9c5962bSJohannes Berg 
2125c9c5962bSJohannes Berg 				cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu);
2126c9c5962bSJohannes Berg 				sinfo->rx_bytes += sta_get_stats_bytes(cpurxs);
2127c9c5962bSJohannes Berg 			}
2128c9c5962bSJohannes Berg 		}
2129c9c5962bSJohannes Berg 
2130319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64);
21312b9a7e1bSJohannes Berg 	}
21322b9a7e1bSJohannes Berg 
2133319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_PACKETS))) {
2134e5a9f8d0SJohannes Berg 		sinfo->rx_packets = sta->rx_stats.packets;
2135c9c5962bSJohannes Berg 		if (sta->pcpu_rx_stats) {
2136c9c5962bSJohannes Berg 			for_each_possible_cpu(cpu) {
2137c9c5962bSJohannes Berg 				struct ieee80211_sta_rx_stats *cpurxs;
2138c9c5962bSJohannes Berg 
2139c9c5962bSJohannes Berg 				cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu);
2140c9c5962bSJohannes Berg 				sinfo->rx_packets += cpurxs->packets;
2141c9c5962bSJohannes Berg 			}
2142c9c5962bSJohannes Berg 		}
2143319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS);
21442b9a7e1bSJohannes Berg 	}
21452b9a7e1bSJohannes Berg 
2146319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_RETRIES))) {
2147e5a9f8d0SJohannes Berg 		sinfo->tx_retries = sta->status_stats.retry_count;
2148319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_RETRIES);
21492b9a7e1bSJohannes Berg 	}
21502b9a7e1bSJohannes Berg 
2151319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_FAILED))) {
2152e5a9f8d0SJohannes Berg 		sinfo->tx_failed = sta->status_stats.retry_failed;
2153319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_FAILED);
21542b9a7e1bSJohannes Berg 	}
21552b9a7e1bSJohannes Berg 
2156e5a9f8d0SJohannes Berg 	sinfo->rx_dropped_misc = sta->rx_stats.dropped;
2157c9c5962bSJohannes Berg 	if (sta->pcpu_rx_stats) {
2158c9c5962bSJohannes Berg 		for_each_possible_cpu(cpu) {
2159c9c5962bSJohannes Berg 			struct ieee80211_sta_rx_stats *cpurxs;
2160c9c5962bSJohannes Berg 
2161c9c5962bSJohannes Berg 			cpurxs = per_cpu_ptr(sta->pcpu_rx_stats, cpu);
2162c9c5962bSJohannes Berg 			sinfo->rx_packets += cpurxs->dropped;
2163c9c5962bSJohannes Berg 		}
2164c9c5962bSJohannes Berg 	}
2165b7ffbd7eSJohannes Berg 
2166225b8189SJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
2167225b8189SJohannes Berg 	    !(sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)) {
2168225b8189SJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_RX) |
2169225b8189SJohannes Berg 				 BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG);
2170225b8189SJohannes Berg 		sinfo->rx_beacon_signal_avg = ieee80211_ave_rssi(&sdata->vif);
2171225b8189SJohannes Berg 	}
2172225b8189SJohannes Berg 
217330686bf7SJohannes Berg 	if (ieee80211_hw_check(&sta->local->hw, SIGNAL_DBM) ||
217430686bf7SJohannes Berg 	    ieee80211_hw_check(&sta->local->hw, SIGNAL_UNSPEC)) {
2175319090bfSJohannes Berg 		if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL))) {
2176c9c5962bSJohannes Berg 			sinfo->signal = (s8)last_rxstats->last_signal;
2177319090bfSJohannes Berg 			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL);
2178b7ffbd7eSJohannes Berg 		}
21792b9a7e1bSJohannes Berg 
2180c9c5962bSJohannes Berg 		if (!sta->pcpu_rx_stats &&
2181c9c5962bSJohannes Berg 		    !(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL_AVG))) {
218240d9a38aSJohannes Berg 			sinfo->signal_avg =
21830be6ed13SJohannes Berg 				-ewma_signal_read(&sta->rx_stats_avg.signal);
2184319090bfSJohannes Berg 			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL_AVG);
21852b9a7e1bSJohannes Berg 		}
21862b9a7e1bSJohannes Berg 	}
21872b9a7e1bSJohannes Berg 
2188c9c5962bSJohannes Berg 	/* for the average - if pcpu_rx_stats isn't set - rxstats must point to
2189c9c5962bSJohannes Berg 	 * the sta->rx_stats struct, so the check here is fine with and without
2190c9c5962bSJohannes Berg 	 * pcpu statistics
2191c9c5962bSJohannes Berg 	 */
2192c9c5962bSJohannes Berg 	if (last_rxstats->chains &&
2193319090bfSJohannes Berg 	    !(sinfo->filled & (BIT(NL80211_STA_INFO_CHAIN_SIGNAL) |
2194319090bfSJohannes Berg 			       BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)))) {
2195c9c5962bSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_CHAIN_SIGNAL);
2196c9c5962bSJohannes Berg 		if (!sta->pcpu_rx_stats)
2197c9c5962bSJohannes Berg 			sinfo->filled |= BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG);
2198b7ffbd7eSJohannes Berg 
2199c9c5962bSJohannes Berg 		sinfo->chains = last_rxstats->chains;
2200c9c5962bSJohannes Berg 
2201b7ffbd7eSJohannes Berg 		for (i = 0; i < ARRAY_SIZE(sinfo->chain_signal); i++) {
2202e5a9f8d0SJohannes Berg 			sinfo->chain_signal[i] =
2203c9c5962bSJohannes Berg 				last_rxstats->chain_signal_last[i];
2204b7ffbd7eSJohannes Berg 			sinfo->chain_signal_avg[i] =
22050be6ed13SJohannes Berg 				-ewma_signal_read(&sta->rx_stats_avg.chain_signal[i]);
2206b7ffbd7eSJohannes Berg 		}
2207b7ffbd7eSJohannes Berg 	}
2208b7ffbd7eSJohannes Berg 
2209319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE))) {
2210e5a9f8d0SJohannes Berg 		sta_set_rate_info_tx(sta, &sta->tx_stats.last_rate,
2211e5a9f8d0SJohannes Berg 				     &sinfo->txrate);
2212319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE);
22132b9a7e1bSJohannes Berg 	}
22142b9a7e1bSJohannes Berg 
2215319090bfSJohannes Berg 	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE))) {
2216b7ffbd7eSJohannes Berg 		sta_set_rate_info_rx(sta, &sinfo->rxrate);
2217319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BITRATE);
22182b9a7e1bSJohannes Berg 	}
2219b7ffbd7eSJohannes Berg 
222079c892b8SJohannes Berg 	sinfo->filled |= BIT(NL80211_STA_INFO_TID_STATS);
222179c892b8SJohannes Berg 	for (i = 0; i < IEEE80211_NUM_TIDS + 1; i++) {
222279c892b8SJohannes Berg 		struct cfg80211_tid_stats *tidstats = &sinfo->pertid[i];
222379c892b8SJohannes Berg 
22240f9c5a61SJohannes Berg 		sta_set_tidstats(sta, tidstats, i);
222579c892b8SJohannes Berg 	}
222679c892b8SJohannes Berg 
2227b7ffbd7eSJohannes Berg 	if (ieee80211_vif_is_mesh(&sdata->vif)) {
2228b7ffbd7eSJohannes Berg #ifdef CONFIG_MAC80211_MESH
2229319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_LLID) |
2230319090bfSJohannes Berg 				 BIT(NL80211_STA_INFO_PLID) |
2231319090bfSJohannes Berg 				 BIT(NL80211_STA_INFO_PLINK_STATE) |
2232319090bfSJohannes Berg 				 BIT(NL80211_STA_INFO_LOCAL_PM) |
2233319090bfSJohannes Berg 				 BIT(NL80211_STA_INFO_PEER_PM) |
2234319090bfSJohannes Berg 				 BIT(NL80211_STA_INFO_NONPEER_PM);
2235b7ffbd7eSJohannes Berg 
2236433f5bc1SJohannes Berg 		sinfo->llid = sta->mesh->llid;
2237433f5bc1SJohannes Berg 		sinfo->plid = sta->mesh->plid;
2238433f5bc1SJohannes Berg 		sinfo->plink_state = sta->mesh->plink_state;
2239b7ffbd7eSJohannes Berg 		if (test_sta_flag(sta, WLAN_STA_TOFFSET_KNOWN)) {
2240319090bfSJohannes Berg 			sinfo->filled |= BIT(NL80211_STA_INFO_T_OFFSET);
2241433f5bc1SJohannes Berg 			sinfo->t_offset = sta->mesh->t_offset;
2242b7ffbd7eSJohannes Berg 		}
2243433f5bc1SJohannes Berg 		sinfo->local_pm = sta->mesh->local_pm;
2244433f5bc1SJohannes Berg 		sinfo->peer_pm = sta->mesh->peer_pm;
2245433f5bc1SJohannes Berg 		sinfo->nonpeer_pm = sta->mesh->nonpeer_pm;
2246b7ffbd7eSJohannes Berg #endif
2247b7ffbd7eSJohannes Berg 	}
2248b7ffbd7eSJohannes Berg 
2249b7ffbd7eSJohannes Berg 	sinfo->bss_param.flags = 0;
2250b7ffbd7eSJohannes Berg 	if (sdata->vif.bss_conf.use_cts_prot)
2251b7ffbd7eSJohannes Berg 		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_CTS_PROT;
2252b7ffbd7eSJohannes Berg 	if (sdata->vif.bss_conf.use_short_preamble)
2253b7ffbd7eSJohannes Berg 		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_PREAMBLE;
2254b7ffbd7eSJohannes Berg 	if (sdata->vif.bss_conf.use_short_slot)
2255b7ffbd7eSJohannes Berg 		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_SLOT_TIME;
2256785e21a8SEmmanuel Grumbach 	sinfo->bss_param.dtim_period = sdata->vif.bss_conf.dtim_period;
2257b7ffbd7eSJohannes Berg 	sinfo->bss_param.beacon_interval = sdata->vif.bss_conf.beacon_int;
2258b7ffbd7eSJohannes Berg 
2259b7ffbd7eSJohannes Berg 	sinfo->sta_flags.set = 0;
2260b7ffbd7eSJohannes Berg 	sinfo->sta_flags.mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
2261b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
2262b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_WME) |
2263b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_MFP) |
2264b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_AUTHENTICATED) |
2265b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_ASSOCIATED) |
2266b7ffbd7eSJohannes Berg 				BIT(NL80211_STA_FLAG_TDLS_PEER);
2267b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
2268b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHORIZED);
2269b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE))
2270b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_SHORT_PREAMBLE);
2271a74a8c84SJohannes Berg 	if (sta->sta.wme)
2272b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_WME);
2273b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_MFP))
2274b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_MFP);
2275b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_AUTH))
2276b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHENTICATED);
2277b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_ASSOC))
2278b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_ASSOCIATED);
2279b7ffbd7eSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER))
2280b7ffbd7eSJohannes Berg 		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_TDLS_PEER);
2281b7ffbd7eSJohannes Berg 
2282b7ffbd7eSJohannes Berg 	/* check if the driver has a SW RC implementation */
2283b7ffbd7eSJohannes Berg 	if (ref && ref->ops->get_expected_throughput)
2284b7ffbd7eSJohannes Berg 		thr = ref->ops->get_expected_throughput(sta->rate_ctrl_priv);
2285b7ffbd7eSJohannes Berg 	else
2286b7ffbd7eSJohannes Berg 		thr = drv_get_expected_throughput(local, &sta->sta);
2287b7ffbd7eSJohannes Berg 
2288b7ffbd7eSJohannes Berg 	if (thr != 0) {
2289319090bfSJohannes Berg 		sinfo->filled |= BIT(NL80211_STA_INFO_EXPECTED_THROUGHPUT);
2290b7ffbd7eSJohannes Berg 		sinfo->expected_throughput = thr;
2291b7ffbd7eSJohannes Berg 	}
2292b7ffbd7eSJohannes Berg }
2293b8da6b6aSJohannes Berg 
2294b8da6b6aSJohannes Berg unsigned long ieee80211_sta_last_active(struct sta_info *sta)
2295b8da6b6aSJohannes Berg {
2296c9c5962bSJohannes Berg 	struct ieee80211_sta_rx_stats *stats = sta_get_last_rx_stats(sta);
2297c9c5962bSJohannes Berg 
2298c9c5962bSJohannes Berg 	if (time_after(stats->last_rx, sta->status_stats.last_ack))
2299c9c5962bSJohannes Berg 		return stats->last_rx;
2300b8da6b6aSJohannes Berg 	return sta->status_stats.last_ack;
2301b8da6b6aSJohannes Berg }
2302