xref: /openbmc/linux/net/mac80211/sta_info.c (revision 8bf11d8d081106c3cce8281a0150e716f8ac5d22)
1f0706e82SJiri Benc /*
2f0706e82SJiri Benc  * Copyright 2002-2005, Instant802 Networks, Inc.
3f0706e82SJiri Benc  * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
4f0706e82SJiri Benc  *
5f0706e82SJiri Benc  * This program is free software; you can redistribute it and/or modify
6f0706e82SJiri Benc  * it under the terms of the GNU General Public License version 2 as
7f0706e82SJiri Benc  * published by the Free Software Foundation.
8f0706e82SJiri Benc  */
9f0706e82SJiri Benc 
10f0706e82SJiri Benc #include <linux/module.h>
11f0706e82SJiri Benc #include <linux/init.h>
12f0706e82SJiri Benc #include <linux/netdevice.h>
13f0706e82SJiri Benc #include <linux/types.h>
14f0706e82SJiri Benc #include <linux/slab.h>
15f0706e82SJiri Benc #include <linux/skbuff.h>
16f0706e82SJiri Benc #include <linux/if_arp.h>
170d174406SJohannes Berg #include <linux/timer.h>
18d0709a65SJohannes Berg #include <linux/rtnetlink.h>
19f0706e82SJiri Benc 
20f0706e82SJiri Benc #include <net/mac80211.h>
21f0706e82SJiri Benc #include "ieee80211_i.h"
2224487981SJohannes Berg #include "driver-ops.h"
232c8dccc7SJohannes Berg #include "rate.h"
24f0706e82SJiri Benc #include "sta_info.h"
25e9f207f0SJiri Benc #include "debugfs_sta.h"
26ee385855SLuis Carlos Cobo #include "mesh.h"
27ce662b44SJohannes Berg #include "wme.h"
28f0706e82SJiri Benc 
29d0709a65SJohannes Berg /**
30d0709a65SJohannes Berg  * DOC: STA information lifetime rules
31d0709a65SJohannes Berg  *
32d0709a65SJohannes Berg  * STA info structures (&struct sta_info) are managed in a hash table
33d0709a65SJohannes Berg  * for faster lookup and a list for iteration. They are managed using
34d0709a65SJohannes Berg  * RCU, i.e. access to the list and hash table is protected by RCU.
35d0709a65SJohannes Berg  *
3634e89507SJohannes Berg  * Upon allocating a STA info structure with sta_info_alloc(), the caller
3734e89507SJohannes Berg  * owns that structure. It must then insert it into the hash table using
3834e89507SJohannes Berg  * either sta_info_insert() or sta_info_insert_rcu(); only in the latter
3934e89507SJohannes Berg  * case (which acquires an rcu read section but must not be called from
4034e89507SJohannes Berg  * within one) will the pointer still be valid after the call. Note that
4134e89507SJohannes Berg  * the caller may not do much with the STA info before inserting it, in
4234e89507SJohannes Berg  * particular, it may not start any mesh peer link management or add
4334e89507SJohannes Berg  * encryption keys.
4493e5deb1SJohannes Berg  *
4593e5deb1SJohannes Berg  * When the insertion fails (sta_info_insert()) returns non-zero), the
4693e5deb1SJohannes Berg  * structure will have been freed by sta_info_insert()!
47d0709a65SJohannes Berg  *
4834e89507SJohannes Berg  * Station entries are added by mac80211 when you establish a link with a
497e189a12SLuis R. Rodriguez  * peer. This means different things for the different type of interfaces
507e189a12SLuis R. Rodriguez  * we support. For a regular station this mean we add the AP sta when we
5125985edcSLucas De Marchi  * receive an association response from the AP. For IBSS this occurs when
5234e89507SJohannes Berg  * get to know about a peer on the same IBSS. For WDS we add the sta for
5325985edcSLucas De Marchi  * the peer immediately upon device open. When using AP mode we add stations
5434e89507SJohannes Berg  * for each respective station upon request from userspace through nl80211.
557e189a12SLuis R. Rodriguez  *
5634e89507SJohannes Berg  * In order to remove a STA info structure, various sta_info_destroy_*()
5734e89507SJohannes Berg  * calls are available.
58d0709a65SJohannes Berg  *
5934e89507SJohannes Berg  * There is no concept of ownership on a STA entry, each structure is
6034e89507SJohannes Berg  * owned by the global hash table/list until it is removed. All users of
6134e89507SJohannes Berg  * the structure need to be RCU protected so that the structure won't be
6234e89507SJohannes Berg  * freed before they are done using it.
63d0709a65SJohannes Berg  */
64f0706e82SJiri Benc 
65f0706e82SJiri Benc /* Caller must hold local->sta_lock */
66be8755e1SMichael Wu static int sta_info_hash_del(struct ieee80211_local *local,
67f0706e82SJiri Benc 			     struct sta_info *sta)
68f0706e82SJiri Benc {
69f0706e82SJiri Benc 	struct sta_info *s;
70f0706e82SJiri Benc 
7140b275b6SJohannes Berg 	s = rcu_dereference_protected(local->sta_hash[STA_HASH(sta->sta.addr)],
7240b275b6SJohannes Berg 				      lockdep_is_held(&local->sta_lock));
73f0706e82SJiri Benc 	if (!s)
74be8755e1SMichael Wu 		return -ENOENT;
75be8755e1SMichael Wu 	if (s == sta) {
76a9b3cd7fSStephen Hemminger 		RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)],
77d0709a65SJohannes Berg 				   s->hnext);
78be8755e1SMichael Wu 		return 0;
79f0706e82SJiri Benc 	}
80f0706e82SJiri Benc 
8140b275b6SJohannes Berg 	while (rcu_access_pointer(s->hnext) &&
8240b275b6SJohannes Berg 	       rcu_access_pointer(s->hnext) != sta)
8340b275b6SJohannes Berg 		s = rcu_dereference_protected(s->hnext,
8440b275b6SJohannes Berg 					lockdep_is_held(&local->sta_lock));
8540b275b6SJohannes Berg 	if (rcu_access_pointer(s->hnext)) {
86a9b3cd7fSStephen Hemminger 		RCU_INIT_POINTER(s->hnext, sta->hnext);
87be8755e1SMichael Wu 		return 0;
88f0706e82SJiri Benc 	}
89f0706e82SJiri Benc 
90be8755e1SMichael Wu 	return -ENOENT;
91f0706e82SJiri Benc }
92f0706e82SJiri Benc 
93d0709a65SJohannes Berg /* protected by RCU */
94abe60632SJohannes Berg struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata,
95abe60632SJohannes Berg 			      const u8 *addr)
9643ba7e95SJohannes Berg {
97abe60632SJohannes Berg 	struct ieee80211_local *local = sdata->local;
9843ba7e95SJohannes Berg 	struct sta_info *sta;
9943ba7e95SJohannes Berg 
1000379185bSJohannes Berg 	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
1010379185bSJohannes Berg 				    lockdep_is_held(&local->sta_lock) ||
1020379185bSJohannes Berg 				    lockdep_is_held(&local->sta_mtx));
10343ba7e95SJohannes Berg 	while (sta) {
1042a33bee2SGuy Eilam 		if (sta->sdata == sdata && !sta->dummy &&
1052a33bee2SGuy Eilam 		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
1062a33bee2SGuy Eilam 			break;
1072a33bee2SGuy Eilam 		sta = rcu_dereference_check(sta->hnext,
1082a33bee2SGuy Eilam 					    lockdep_is_held(&local->sta_lock) ||
1092a33bee2SGuy Eilam 					    lockdep_is_held(&local->sta_mtx));
1102a33bee2SGuy Eilam 	}
1112a33bee2SGuy Eilam 	return sta;
1122a33bee2SGuy Eilam }
1132a33bee2SGuy Eilam 
1142a33bee2SGuy Eilam /* get a station info entry even if it is a dummy station*/
1152a33bee2SGuy Eilam struct sta_info *sta_info_get_rx(struct ieee80211_sub_if_data *sdata,
1162a33bee2SGuy Eilam 			      const u8 *addr)
1172a33bee2SGuy Eilam {
1182a33bee2SGuy Eilam 	struct ieee80211_local *local = sdata->local;
1192a33bee2SGuy Eilam 	struct sta_info *sta;
1202a33bee2SGuy Eilam 
1212a33bee2SGuy Eilam 	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
1222a33bee2SGuy Eilam 				    lockdep_is_held(&local->sta_lock) ||
1232a33bee2SGuy Eilam 				    lockdep_is_held(&local->sta_mtx));
1242a33bee2SGuy Eilam 	while (sta) {
125abe60632SJohannes Berg 		if (sta->sdata == sdata &&
126abe60632SJohannes Berg 		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
12743ba7e95SJohannes Berg 			break;
1280379185bSJohannes Berg 		sta = rcu_dereference_check(sta->hnext,
1290379185bSJohannes Berg 					    lockdep_is_held(&local->sta_lock) ||
1300379185bSJohannes Berg 					    lockdep_is_held(&local->sta_mtx));
13143ba7e95SJohannes Berg 	}
13243ba7e95SJohannes Berg 	return sta;
13343ba7e95SJohannes Berg }
13443ba7e95SJohannes Berg 
1350e5ded5aSFelix Fietkau /*
1360e5ded5aSFelix Fietkau  * Get sta info either from the specified interface
1370e5ded5aSFelix Fietkau  * or from one of its vlans
1380e5ded5aSFelix Fietkau  */
1390e5ded5aSFelix Fietkau struct sta_info *sta_info_get_bss(struct ieee80211_sub_if_data *sdata,
1400e5ded5aSFelix Fietkau 				  const u8 *addr)
1410e5ded5aSFelix Fietkau {
1420e5ded5aSFelix Fietkau 	struct ieee80211_local *local = sdata->local;
1430e5ded5aSFelix Fietkau 	struct sta_info *sta;
1440e5ded5aSFelix Fietkau 
1450379185bSJohannes Berg 	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
1460379185bSJohannes Berg 				    lockdep_is_held(&local->sta_lock) ||
1470379185bSJohannes Berg 				    lockdep_is_held(&local->sta_mtx));
1480e5ded5aSFelix Fietkau 	while (sta) {
1490e5ded5aSFelix Fietkau 		if ((sta->sdata == sdata ||
150a2c1e3daSJohannes Berg 		     (sta->sdata->bss && sta->sdata->bss == sdata->bss)) &&
1512a33bee2SGuy Eilam 		    !sta->dummy &&
1522a33bee2SGuy Eilam 		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
1532a33bee2SGuy Eilam 			break;
1542a33bee2SGuy Eilam 		sta = rcu_dereference_check(sta->hnext,
1552a33bee2SGuy Eilam 					    lockdep_is_held(&local->sta_lock) ||
1562a33bee2SGuy Eilam 					    lockdep_is_held(&local->sta_mtx));
1572a33bee2SGuy Eilam 	}
1582a33bee2SGuy Eilam 	return sta;
1592a33bee2SGuy Eilam }
1602a33bee2SGuy Eilam 
1612a33bee2SGuy Eilam /*
1622a33bee2SGuy Eilam  * Get sta info either from the specified interface
1632a33bee2SGuy Eilam  * or from one of its vlans (including dummy stations)
1642a33bee2SGuy Eilam  */
1652a33bee2SGuy Eilam struct sta_info *sta_info_get_bss_rx(struct ieee80211_sub_if_data *sdata,
1662a33bee2SGuy Eilam 				  const u8 *addr)
1672a33bee2SGuy Eilam {
1682a33bee2SGuy Eilam 	struct ieee80211_local *local = sdata->local;
1692a33bee2SGuy Eilam 	struct sta_info *sta;
1702a33bee2SGuy Eilam 
1712a33bee2SGuy Eilam 	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
1722a33bee2SGuy Eilam 				    lockdep_is_held(&local->sta_lock) ||
1732a33bee2SGuy Eilam 				    lockdep_is_held(&local->sta_mtx));
1742a33bee2SGuy Eilam 	while (sta) {
1752a33bee2SGuy Eilam 		if ((sta->sdata == sdata ||
1762a33bee2SGuy Eilam 		     (sta->sdata->bss && sta->sdata->bss == sdata->bss)) &&
1770e5ded5aSFelix Fietkau 		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
1780e5ded5aSFelix Fietkau 			break;
1790379185bSJohannes Berg 		sta = rcu_dereference_check(sta->hnext,
1800379185bSJohannes Berg 					    lockdep_is_held(&local->sta_lock) ||
1810379185bSJohannes Berg 					    lockdep_is_held(&local->sta_mtx));
1820e5ded5aSFelix Fietkau 	}
1830e5ded5aSFelix Fietkau 	return sta;
1840e5ded5aSFelix Fietkau }
1850e5ded5aSFelix Fietkau 
1863b53fde8SJohannes Berg struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata,
1873b53fde8SJohannes Berg 				     int idx)
188ee385855SLuis Carlos Cobo {
1893b53fde8SJohannes Berg 	struct ieee80211_local *local = sdata->local;
190ee385855SLuis Carlos Cobo 	struct sta_info *sta;
191ee385855SLuis Carlos Cobo 	int i = 0;
192ee385855SLuis Carlos Cobo 
193d0709a65SJohannes Berg 	list_for_each_entry_rcu(sta, &local->sta_list, list) {
1943b53fde8SJohannes Berg 		if (sdata != sta->sdata)
1952a8ca29aSLuis Carlos Cobo 			continue;
196ee385855SLuis Carlos Cobo 		if (i < idx) {
197ee385855SLuis Carlos Cobo 			++i;
198ee385855SLuis Carlos Cobo 			continue;
199ee385855SLuis Carlos Cobo 		}
2002a8ca29aSLuis Carlos Cobo 		return sta;
201ee385855SLuis Carlos Cobo 	}
202ee385855SLuis Carlos Cobo 
203ee385855SLuis Carlos Cobo 	return NULL;
204ee385855SLuis Carlos Cobo }
205f0706e82SJiri Benc 
20693e5deb1SJohannes Berg /**
207d9a7ddb0SJohannes Berg  * sta_info_free - free STA
20893e5deb1SJohannes Berg  *
2096ef307bcSRandy Dunlap  * @local: pointer to the global information
21093e5deb1SJohannes Berg  * @sta: STA info to free
21193e5deb1SJohannes Berg  *
21293e5deb1SJohannes Berg  * This function must undo everything done by sta_info_alloc()
213d9a7ddb0SJohannes Berg  * that may happen before sta_info_insert(). It may only be
214d9a7ddb0SJohannes Berg  * called when sta_info_insert() has not been attempted (and
215d9a7ddb0SJohannes Berg  * if that fails, the station is freed anyway.)
21693e5deb1SJohannes Berg  */
217d9a7ddb0SJohannes Berg void sta_info_free(struct ieee80211_local *local, struct sta_info *sta)
21893e5deb1SJohannes Berg {
219af65cd96SJohannes Berg 	if (sta->rate_ctrl) {
2204b7679a5SJohannes Berg 		rate_control_free_sta(sta);
22193e5deb1SJohannes Berg 		rate_control_put(sta->rate_ctrl);
222af65cd96SJohannes Berg 	}
22393e5deb1SJohannes Berg 
22493e5deb1SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
2250fb9a9ecSJoe Perches 	wiphy_debug(local->hw.wiphy, "Destroyed STA %pM\n", sta->sta.addr);
22693e5deb1SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
22793e5deb1SJohannes Berg 
22893e5deb1SJohannes Berg 	kfree(sta);
22993e5deb1SJohannes Berg }
23093e5deb1SJohannes Berg 
231d0709a65SJohannes Berg /* Caller must hold local->sta_lock */
232d0709a65SJohannes Berg static void sta_info_hash_add(struct ieee80211_local *local,
233d0709a65SJohannes Berg 			      struct sta_info *sta)
234f0706e82SJiri Benc {
23517741cdcSJohannes Berg 	sta->hnext = local->sta_hash[STA_HASH(sta->sta.addr)];
236a9b3cd7fSStephen Hemminger 	RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)], sta);
237f0706e82SJiri Benc }
238f0706e82SJiri Benc 
239af818581SJohannes Berg static void sta_unblock(struct work_struct *wk)
240af818581SJohannes Berg {
241af818581SJohannes Berg 	struct sta_info *sta;
242af818581SJohannes Berg 
243af818581SJohannes Berg 	sta = container_of(wk, struct sta_info, drv_unblock_wk);
244af818581SJohannes Berg 
245af818581SJohannes Berg 	if (sta->dead)
246af818581SJohannes Berg 		return;
247af818581SJohannes Berg 
248c2c98fdeSJohannes Berg 	if (!test_sta_flag(sta, WLAN_STA_PS_STA))
249af818581SJohannes Berg 		ieee80211_sta_ps_deliver_wakeup(sta);
250c2c98fdeSJohannes Berg 	else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL)) {
251c2c98fdeSJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
252ce662b44SJohannes Berg 
253ce662b44SJohannes Berg 		local_bh_disable();
254af818581SJohannes Berg 		ieee80211_sta_ps_deliver_poll_response(sta);
255ce662b44SJohannes Berg 		local_bh_enable();
256c2c98fdeSJohannes Berg 	} else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD)) {
257c2c98fdeSJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
258ce662b44SJohannes Berg 
259ce662b44SJohannes Berg 		local_bh_disable();
26047086fc5SJohannes Berg 		ieee80211_sta_ps_deliver_uapsd(sta);
261ce662b44SJohannes Berg 		local_bh_enable();
26250a9432dSJohannes Berg 	} else
263c2c98fdeSJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
264af818581SJohannes Berg }
265af818581SJohannes Berg 
266af65cd96SJohannes Berg static int sta_prepare_rate_control(struct ieee80211_local *local,
267af65cd96SJohannes Berg 				    struct sta_info *sta, gfp_t gfp)
268af65cd96SJohannes Berg {
269af65cd96SJohannes Berg 	if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL)
270af65cd96SJohannes Berg 		return 0;
271af65cd96SJohannes Berg 
272af65cd96SJohannes Berg 	sta->rate_ctrl = rate_control_get(local->rate_ctrl);
273af65cd96SJohannes Berg 	sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl,
274af65cd96SJohannes Berg 						     &sta->sta, gfp);
275af65cd96SJohannes Berg 	if (!sta->rate_ctrl_priv) {
276af65cd96SJohannes Berg 		rate_control_put(sta->rate_ctrl);
277af65cd96SJohannes Berg 		return -ENOMEM;
278af65cd96SJohannes Berg 	}
279af65cd96SJohannes Berg 
280af65cd96SJohannes Berg 	return 0;
281af65cd96SJohannes Berg }
282af65cd96SJohannes Berg 
28373651ee6SJohannes Berg struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata,
28456544160SJohannes Berg 				const u8 *addr, gfp_t gfp)
285f0706e82SJiri Benc {
286d0709a65SJohannes Berg 	struct ieee80211_local *local = sdata->local;
287f0706e82SJiri Benc 	struct sta_info *sta;
288ebe27c91SMohammed Shafi Shajakhan 	struct timespec uptime;
28916c5f15cSRon Rindjunsky 	int i;
290f0706e82SJiri Benc 
29117741cdcSJohannes Berg 	sta = kzalloc(sizeof(*sta) + local->hw.sta_data_size, gfp);
292f0706e82SJiri Benc 	if (!sta)
29373651ee6SJohannes Berg 		return NULL;
294f0706e82SJiri Benc 
29507346f81SJohannes Berg 	spin_lock_init(&sta->lock);
296af818581SJohannes Berg 	INIT_WORK(&sta->drv_unblock_wk, sta_unblock);
29767c282c0SJohannes Berg 	INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work);
298a93e3644SJohannes Berg 	mutex_init(&sta->ampdu_mlme.mtx);
29907346f81SJohannes Berg 
30017741cdcSJohannes Berg 	memcpy(sta->sta.addr, addr, ETH_ALEN);
301d0709a65SJohannes Berg 	sta->local = local;
302d0709a65SJohannes Berg 	sta->sdata = sdata;
3038bc8aecdSFelix Fietkau 	sta->last_rx = jiffies;
304f0706e82SJiri Benc 
305ebe27c91SMohammed Shafi Shajakhan 	do_posix_clock_monotonic_gettime(&uptime);
306ebe27c91SMohammed Shafi Shajakhan 	sta->last_connected = uptime.tv_sec;
307541a45a1SBruno Randolf 	ewma_init(&sta->avg_signal, 1024, 8);
308541a45a1SBruno Randolf 
309af65cd96SJohannes Berg 	if (sta_prepare_rate_control(local, sta, gfp)) {
310f0706e82SJiri Benc 		kfree(sta);
31173651ee6SJohannes Berg 		return NULL;
312f0706e82SJiri Benc 	}
313f0706e82SJiri Benc 
31416c5f15cSRon Rindjunsky 	for (i = 0; i < STA_TID_NUM; i++) {
315a622ab72SJohannes Berg 		/*
316a622ab72SJohannes Berg 		 * timer_to_tid must be initialized with identity mapping
317a622ab72SJohannes Berg 		 * to enable session_timer's data differentiation. See
318a622ab72SJohannes Berg 		 * sta_rx_agg_session_timer_expired for usage.
319a622ab72SJohannes Berg 		 */
32016c5f15cSRon Rindjunsky 		sta->timer_to_tid[i] = i;
32116c5f15cSRon Rindjunsky 	}
322948d887dSJohannes Berg 	for (i = 0; i < IEEE80211_NUM_ACS; i++) {
323948d887dSJohannes Berg 		skb_queue_head_init(&sta->ps_tx_buf[i]);
324948d887dSJohannes Berg 		skb_queue_head_init(&sta->tx_filtered[i]);
325948d887dSJohannes Berg 	}
32673651ee6SJohannes Berg 
327cccaec98SSenthil Balasubramanian 	for (i = 0; i < NUM_RX_DATA_QUEUES; i++)
3284be929beSAlexey Dobriyan 		sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX);
329cccaec98SSenthil Balasubramanian 
33073651ee6SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
3310fb9a9ecSJoe Perches 	wiphy_debug(local->hw.wiphy, "Allocated STA %pM\n", sta->sta.addr);
33273651ee6SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
33373651ee6SJohannes Berg 
33403e4497eSJohannes Berg #ifdef CONFIG_MAC80211_MESH
33557cf8043SJavier Cardona 	sta->plink_state = NL80211_PLINK_LISTEN;
33603e4497eSJohannes Berg 	init_timer(&sta->plink_timer);
33703e4497eSJohannes Berg #endif
33803e4497eSJohannes Berg 
33973651ee6SJohannes Berg 	return sta;
34073651ee6SJohannes Berg }
34173651ee6SJohannes Berg 
3422a33bee2SGuy Eilam static int sta_info_finish_insert(struct sta_info *sta,
3432a33bee2SGuy Eilam 				bool async, bool dummy_reinsert)
34473651ee6SJohannes Berg {
34573651ee6SJohannes Berg 	struct ieee80211_local *local = sta->local;
34673651ee6SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
34798b62183SJohannes Berg 	struct station_info sinfo;
34873651ee6SJohannes Berg 	unsigned long flags;
34993e5deb1SJohannes Berg 	int err = 0;
35073651ee6SJohannes Berg 
35146a5ebafSJohannes Berg 	lockdep_assert_held(&local->sta_mtx);
35234e89507SJohannes Berg 
3532a33bee2SGuy Eilam 	if (!sta->dummy || dummy_reinsert) {
35434e89507SJohannes Berg 		/* notify driver */
35534e89507SJohannes Berg 		err = drv_sta_add(local, sdata, &sta->sta);
35634e89507SJohannes Berg 		if (err) {
357*8bf11d8dSJohannes Berg 			if (sdata->vif.type != NL80211_IFTYPE_ADHOC)
35834e89507SJohannes Berg 				return err;
3592a33bee2SGuy Eilam 			printk(KERN_DEBUG "%s: failed to add IBSS STA %pM to "
3602a33bee2SGuy Eilam 					  "driver (%d) - keeping it anyway.\n",
36134e89507SJohannes Berg 			       sdata->name, sta->sta.addr, err);
362*8bf11d8dSJohannes Berg 		} else
36334e89507SJohannes Berg 			sta->uploaded = true;
36434e89507SJohannes Berg 
36534e89507SJohannes Berg 		sdata = sta->sdata;
3662a33bee2SGuy Eilam 	}
36734e89507SJohannes Berg 
3682a33bee2SGuy Eilam 	if (!dummy_reinsert) {
36934e89507SJohannes Berg 		local->num_sta++;
37034e89507SJohannes Berg 		local->sta_generation++;
37134e89507SJohannes Berg 		smp_mb();
37234e89507SJohannes Berg 
37334e89507SJohannes Berg 		/* make the station visible */
37434e89507SJohannes Berg 		spin_lock_irqsave(&local->sta_lock, flags);
37534e89507SJohannes Berg 		sta_info_hash_add(local, sta);
37634e89507SJohannes Berg 		spin_unlock_irqrestore(&local->sta_lock, flags);
37734e89507SJohannes Berg 
37834e89507SJohannes Berg 		list_add(&sta->list, &local->sta_list);
3792a33bee2SGuy Eilam 	} else {
3802a33bee2SGuy Eilam 		sta->dummy = false;
3812a33bee2SGuy Eilam 	}
38234e89507SJohannes Berg 
3832a33bee2SGuy Eilam 	if (!sta->dummy) {
38434e89507SJohannes Berg 		ieee80211_sta_debugfs_add(sta);
38534e89507SJohannes Berg 		rate_control_add_sta_debugfs(sta);
38634e89507SJohannes Berg 
387f612cedfSJouni Malinen 		memset(&sinfo, 0, sizeof(sinfo));
38834e89507SJohannes Berg 		sinfo.filled = 0;
38934e89507SJohannes Berg 		sinfo.generation = local->sta_generation;
39034e89507SJohannes Berg 		cfg80211_new_sta(sdata->dev, sta->sta.addr, &sinfo, GFP_KERNEL);
3912a33bee2SGuy Eilam 	}
39234e89507SJohannes Berg 
39334e89507SJohannes Berg 	return 0;
39434e89507SJohannes Berg }
39534e89507SJohannes Berg 
39634e89507SJohannes Berg static void sta_info_finish_pending(struct ieee80211_local *local)
39734e89507SJohannes Berg {
39834e89507SJohannes Berg 	struct sta_info *sta;
39934e89507SJohannes Berg 	unsigned long flags;
40034e89507SJohannes Berg 
40134e89507SJohannes Berg 	spin_lock_irqsave(&local->sta_lock, flags);
40234e89507SJohannes Berg 	while (!list_empty(&local->sta_pending_list)) {
40334e89507SJohannes Berg 		sta = list_first_entry(&local->sta_pending_list,
40434e89507SJohannes Berg 				       struct sta_info, list);
40534e89507SJohannes Berg 		list_del(&sta->list);
40634e89507SJohannes Berg 		spin_unlock_irqrestore(&local->sta_lock, flags);
40734e89507SJohannes Berg 
4082a33bee2SGuy Eilam 		sta_info_finish_insert(sta, true, false);
40934e89507SJohannes Berg 
41034e89507SJohannes Berg 		spin_lock_irqsave(&local->sta_lock, flags);
41134e89507SJohannes Berg 	}
41234e89507SJohannes Berg 	spin_unlock_irqrestore(&local->sta_lock, flags);
41334e89507SJohannes Berg }
41434e89507SJohannes Berg 
41534e89507SJohannes Berg static void sta_info_finish_work(struct work_struct *work)
41634e89507SJohannes Berg {
41734e89507SJohannes Berg 	struct ieee80211_local *local =
41834e89507SJohannes Berg 		container_of(work, struct ieee80211_local, sta_finish_work);
41934e89507SJohannes Berg 
42034e89507SJohannes Berg 	mutex_lock(&local->sta_mtx);
42134e89507SJohannes Berg 	sta_info_finish_pending(local);
42234e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
42334e89507SJohannes Berg }
42434e89507SJohannes Berg 
4258c71df7aSGuy Eilam static int sta_info_insert_check(struct sta_info *sta)
42634e89507SJohannes Berg {
42734e89507SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
42834e89507SJohannes Berg 
42903e4497eSJohannes Berg 	/*
43003e4497eSJohannes Berg 	 * Can't be a WARN_ON because it can be triggered through a race:
43103e4497eSJohannes Berg 	 * something inserts a STA (on one CPU) without holding the RTNL
43203e4497eSJohannes Berg 	 * and another CPU turns off the net device.
43303e4497eSJohannes Berg 	 */
4348c71df7aSGuy Eilam 	if (unlikely(!ieee80211_sdata_running(sdata)))
4358c71df7aSGuy Eilam 		return -ENETDOWN;
43603e4497eSJohannes Berg 
43747846c9bSJohannes Berg 	if (WARN_ON(compare_ether_addr(sta->sta.addr, sdata->vif.addr) == 0 ||
4388c71df7aSGuy Eilam 		    is_multicast_ether_addr(sta->sta.addr)))
4398c71df7aSGuy Eilam 		return -EINVAL;
4408c71df7aSGuy Eilam 
4418c71df7aSGuy Eilam 	return 0;
44293e5deb1SJohannes Berg }
44344213b5eSJohannes Berg 
4448c71df7aSGuy Eilam static int sta_info_insert_ibss(struct sta_info *sta) __acquires(RCU)
4458c71df7aSGuy Eilam {
4468c71df7aSGuy Eilam 	struct ieee80211_local *local = sta->local;
4478c71df7aSGuy Eilam 	struct ieee80211_sub_if_data *sdata = sta->sdata;
4488c71df7aSGuy Eilam 	unsigned long flags;
4498c71df7aSGuy Eilam 
450d0709a65SJohannes Berg 	spin_lock_irqsave(&local->sta_lock, flags);
45143ba7e95SJohannes Berg 	/* check if STA exists already */
4522a33bee2SGuy Eilam 	if (sta_info_get_bss_rx(sdata, sta->sta.addr)) {
453d0709a65SJohannes Berg 		spin_unlock_irqrestore(&local->sta_lock, flags);
45434e89507SJohannes Berg 		rcu_read_lock();
4558c71df7aSGuy Eilam 		return -EEXIST;
45643ba7e95SJohannes Berg 	}
45734e89507SJohannes Berg 
458f0706e82SJiri Benc 	local->num_sta++;
45934e89507SJohannes Berg 	local->sta_generation++;
46034e89507SJohannes Berg 	smp_mb();
461f0706e82SJiri Benc 	sta_info_hash_add(local, sta);
46232bfd35dSJohannes Berg 
46334e89507SJohannes Berg 	list_add_tail(&sta->list, &local->sta_pending_list);
46432bfd35dSJohannes Berg 
46534e89507SJohannes Berg 	rcu_read_lock();
46634e89507SJohannes Berg 	spin_unlock_irqrestore(&local->sta_lock, flags);
46734e89507SJohannes Berg 
46834e89507SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
4690fb9a9ecSJoe Perches 	wiphy_debug(local->hw.wiphy, "Added IBSS STA %pM\n",
4700fb9a9ecSJoe Perches 			sta->sta.addr);
47134e89507SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
47234e89507SJohannes Berg 
47334e89507SJohannes Berg 	ieee80211_queue_work(&local->hw, &local->sta_finish_work);
47434e89507SJohannes Berg 
47534e89507SJohannes Berg 	return 0;
47634e89507SJohannes Berg }
47734e89507SJohannes Berg 
47834e89507SJohannes Berg /*
4798c71df7aSGuy Eilam  * should be called with sta_mtx locked
4808c71df7aSGuy Eilam  * this function replaces the mutex lock
4818c71df7aSGuy Eilam  * with a RCU lock
4828c71df7aSGuy Eilam  */
4838c71df7aSGuy Eilam static int sta_info_insert_non_ibss(struct sta_info *sta) __acquires(RCU)
4848c71df7aSGuy Eilam {
4858c71df7aSGuy Eilam 	struct ieee80211_local *local = sta->local;
4868c71df7aSGuy Eilam 	struct ieee80211_sub_if_data *sdata = sta->sdata;
4878c71df7aSGuy Eilam 	unsigned long flags;
4882a33bee2SGuy Eilam 	struct sta_info *exist_sta;
4892a33bee2SGuy Eilam 	bool dummy_reinsert = false;
4908c71df7aSGuy Eilam 	int err = 0;
4918c71df7aSGuy Eilam 
4928c71df7aSGuy Eilam 	lockdep_assert_held(&local->sta_mtx);
4938c71df7aSGuy Eilam 
4948c71df7aSGuy Eilam 	/*
49534e89507SJohannes Berg 	 * On first glance, this will look racy, because the code
4968c71df7aSGuy Eilam 	 * in this function, which inserts a station with sleeping,
49734e89507SJohannes Berg 	 * unlocks the sta_lock between checking existence in the
49834e89507SJohannes Berg 	 * hash table and inserting into it.
49934e89507SJohannes Berg 	 *
50034e89507SJohannes Berg 	 * However, it is not racy against itself because it keeps
5018c71df7aSGuy Eilam 	 * the mutex locked.
50234e89507SJohannes Berg 	 */
50334e89507SJohannes Berg 
50434e89507SJohannes Berg 	spin_lock_irqsave(&local->sta_lock, flags);
5052a33bee2SGuy Eilam 	/*
5062a33bee2SGuy Eilam 	 * check if STA exists already.
5072a33bee2SGuy Eilam 	 * only accept a scenario of a second call to sta_info_insert_non_ibss
5082a33bee2SGuy Eilam 	 * with a dummy station entry that was inserted earlier
5092a33bee2SGuy Eilam 	 * in that case - assume that the dummy station flag should
5102a33bee2SGuy Eilam 	 * be removed.
5112a33bee2SGuy Eilam 	 */
5122a33bee2SGuy Eilam 	exist_sta = sta_info_get_bss_rx(sdata, sta->sta.addr);
5132a33bee2SGuy Eilam 	if (exist_sta) {
5142a33bee2SGuy Eilam 		if (exist_sta == sta && sta->dummy) {
5152a33bee2SGuy Eilam 			dummy_reinsert = true;
5162a33bee2SGuy Eilam 		} else {
51734e89507SJohannes Berg 			spin_unlock_irqrestore(&local->sta_lock, flags);
51838a679a5SJouni Malinen 			mutex_unlock(&local->sta_mtx);
51934e89507SJohannes Berg 			rcu_read_lock();
5208c71df7aSGuy Eilam 			return -EEXIST;
52134e89507SJohannes Berg 		}
5222a33bee2SGuy Eilam 	}
52334e89507SJohannes Berg 
52434e89507SJohannes Berg 	spin_unlock_irqrestore(&local->sta_lock, flags);
52534e89507SJohannes Berg 
5262a33bee2SGuy Eilam 	err = sta_info_finish_insert(sta, false, dummy_reinsert);
52734e89507SJohannes Berg 	if (err) {
52834e89507SJohannes Berg 		mutex_unlock(&local->sta_mtx);
52934e89507SJohannes Berg 		rcu_read_lock();
5308c71df7aSGuy Eilam 		return err;
53132bfd35dSJohannes Berg 	}
532d0709a65SJohannes Berg 
533f0706e82SJiri Benc #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
5342a33bee2SGuy Eilam 	wiphy_debug(local->hw.wiphy, "Inserted %sSTA %pM\n",
5352a33bee2SGuy Eilam 			sta->dummy ? "dummy " : "", sta->sta.addr);
536f0706e82SJiri Benc #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
537f0706e82SJiri Benc 
53834e89507SJohannes Berg 	/* move reference to rcu-protected */
53934e89507SJohannes Berg 	rcu_read_lock();
54034e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
541e9f207f0SJiri Benc 
54273651ee6SJohannes Berg 	if (ieee80211_vif_is_mesh(&sdata->vif))
54373651ee6SJohannes Berg 		mesh_accept_plinks_update(sdata);
54473651ee6SJohannes Berg 
54573651ee6SJohannes Berg 	return 0;
5468c71df7aSGuy Eilam }
5478c71df7aSGuy Eilam 
5488c71df7aSGuy Eilam int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU)
5498c71df7aSGuy Eilam {
5508c71df7aSGuy Eilam 	struct ieee80211_local *local = sta->local;
5518c71df7aSGuy Eilam 	struct ieee80211_sub_if_data *sdata = sta->sdata;
5528c71df7aSGuy Eilam 	int err = 0;
5538c71df7aSGuy Eilam 
5548c71df7aSGuy Eilam 	err = sta_info_insert_check(sta);
5558c71df7aSGuy Eilam 	if (err) {
5568c71df7aSGuy Eilam 		rcu_read_lock();
5578c71df7aSGuy Eilam 		goto out_free;
5588c71df7aSGuy Eilam 	}
5598c71df7aSGuy Eilam 
5608c71df7aSGuy Eilam 	/*
5618c71df7aSGuy Eilam 	 * In ad-hoc mode, we sometimes need to insert stations
5628c71df7aSGuy Eilam 	 * from tasklet context from the RX path. To avoid races,
5638c71df7aSGuy Eilam 	 * always do so in that case -- see the comment below.
5648c71df7aSGuy Eilam 	 */
5658c71df7aSGuy Eilam 	if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
5668c71df7aSGuy Eilam 		err = sta_info_insert_ibss(sta);
5678c71df7aSGuy Eilam 		if (err)
5688c71df7aSGuy Eilam 			goto out_free;
5698c71df7aSGuy Eilam 
5708c71df7aSGuy Eilam 		return 0;
5718c71df7aSGuy Eilam 	}
5728c71df7aSGuy Eilam 
5738c71df7aSGuy Eilam 	/*
5748c71df7aSGuy Eilam 	 * It might seem that the function called below is in race against
5758c71df7aSGuy Eilam 	 * the function call above that atomically inserts the station... That,
576004c872eSJohannes Berg 	 * however, is not true because the above code can only
577004c872eSJohannes Berg 	 * be invoked for IBSS interfaces, and the below code will
578004c872eSJohannes Berg 	 * not be -- and the two do not race against each other as
579004c872eSJohannes Berg 	 * the hash table also keys off the interface.
580004c872eSJohannes Berg 	 */
581004c872eSJohannes Berg 
582004c872eSJohannes Berg 	might_sleep();
583004c872eSJohannes Berg 
584004c872eSJohannes Berg 	mutex_lock(&local->sta_mtx);
585004c872eSJohannes Berg 
5868c71df7aSGuy Eilam 	err = sta_info_insert_non_ibss(sta);
5878c71df7aSGuy Eilam 	if (err)
588004c872eSJohannes Berg 		goto out_free;
589d0709a65SJohannes Berg 
590004c872eSJohannes Berg 	return 0;
59193e5deb1SJohannes Berg  out_free:
59293e5deb1SJohannes Berg 	BUG_ON(!err);
593d9a7ddb0SJohannes Berg 	sta_info_free(local, sta);
59493e5deb1SJohannes Berg 	return err;
595f0706e82SJiri Benc }
596f0706e82SJiri Benc 
59734e89507SJohannes Berg int sta_info_insert(struct sta_info *sta)
59834e89507SJohannes Berg {
59934e89507SJohannes Berg 	int err = sta_info_insert_rcu(sta);
60034e89507SJohannes Berg 
60134e89507SJohannes Berg 	rcu_read_unlock();
60234e89507SJohannes Berg 
60334e89507SJohannes Berg 	return err;
60434e89507SJohannes Berg }
60534e89507SJohannes Berg 
6062a33bee2SGuy Eilam /* Caller must hold sta->local->sta_mtx */
6072a33bee2SGuy Eilam int sta_info_reinsert(struct sta_info *sta)
6082a33bee2SGuy Eilam {
6092a33bee2SGuy Eilam 	struct ieee80211_local *local = sta->local;
6102a33bee2SGuy Eilam 	int err = 0;
6112a33bee2SGuy Eilam 
6122a33bee2SGuy Eilam 	err = sta_info_insert_check(sta);
6132a33bee2SGuy Eilam 	if (err) {
6142a33bee2SGuy Eilam 		mutex_unlock(&local->sta_mtx);
6152a33bee2SGuy Eilam 		return err;
6162a33bee2SGuy Eilam 	}
6172a33bee2SGuy Eilam 
6182a33bee2SGuy Eilam 	might_sleep();
6192a33bee2SGuy Eilam 
6202a33bee2SGuy Eilam 	err = sta_info_insert_non_ibss(sta);
6212a33bee2SGuy Eilam 	rcu_read_unlock();
6222a33bee2SGuy Eilam 	return err;
6232a33bee2SGuy Eilam }
6242a33bee2SGuy Eilam 
625f0706e82SJiri Benc static inline void __bss_tim_set(struct ieee80211_if_ap *bss, u16 aid)
626004c872eSJohannes Berg {
627004c872eSJohannes Berg 	/*
628004c872eSJohannes Berg 	 * This format has been mandated by the IEEE specifications,
629004c872eSJohannes Berg 	 * so this line may not be changed to use the __set_bit() format.
630004c872eSJohannes Berg 	 */
631004c872eSJohannes Berg 	bss->tim[aid / 8] |= (1 << (aid % 8));
632004c872eSJohannes Berg }
633004c872eSJohannes Berg 
634004c872eSJohannes Berg static inline void __bss_tim_clear(struct ieee80211_if_ap *bss, u16 aid)
635004c872eSJohannes Berg {
636004c872eSJohannes Berg 	/*
637004c872eSJohannes Berg 	 * This format has been mandated by the IEEE specifications,
638004c872eSJohannes Berg 	 * so this line may not be changed to use the __clear_bit() format.
639004c872eSJohannes Berg 	 */
640004c872eSJohannes Berg 	bss->tim[aid / 8] &= ~(1 << (aid % 8));
641004c872eSJohannes Berg }
642004c872eSJohannes Berg 
643948d887dSJohannes Berg static unsigned long ieee80211_tids_for_ac(int ac)
644004c872eSJohannes Berg {
645948d887dSJohannes Berg 	/* If we ever support TIDs > 7, this obviously needs to be adjusted */
646948d887dSJohannes Berg 	switch (ac) {
647948d887dSJohannes Berg 	case IEEE80211_AC_VO:
648948d887dSJohannes Berg 		return BIT(6) | BIT(7);
649948d887dSJohannes Berg 	case IEEE80211_AC_VI:
650948d887dSJohannes Berg 		return BIT(4) | BIT(5);
651948d887dSJohannes Berg 	case IEEE80211_AC_BE:
652948d887dSJohannes Berg 		return BIT(0) | BIT(3);
653948d887dSJohannes Berg 	case IEEE80211_AC_BK:
654948d887dSJohannes Berg 		return BIT(1) | BIT(2);
655948d887dSJohannes Berg 	default:
656948d887dSJohannes Berg 		WARN_ON(1);
657948d887dSJohannes Berg 		return 0;
658d0709a65SJohannes Berg 	}
659004c872eSJohannes Berg }
660004c872eSJohannes Berg 
661c868cb35SJohannes Berg void sta_info_recalc_tim(struct sta_info *sta)
662004c872eSJohannes Berg {
663c868cb35SJohannes Berg 	struct ieee80211_local *local = sta->local;
664c868cb35SJohannes Berg 	struct ieee80211_if_ap *bss = sta->sdata->bss;
665d0709a65SJohannes Berg 	unsigned long flags;
666948d887dSJohannes Berg 	bool indicate_tim = false;
667948d887dSJohannes Berg 	u8 ignore_for_tim = sta->sta.uapsd_queues;
668948d887dSJohannes Berg 	int ac;
669004c872eSJohannes Berg 
670c868cb35SJohannes Berg 	if (WARN_ON_ONCE(!sta->sdata->bss))
671c868cb35SJohannes Berg 		return;
6723e122be0SJohannes Berg 
673c868cb35SJohannes Berg 	/* No need to do anything if the driver does all */
674c868cb35SJohannes Berg 	if (local->hw.flags & IEEE80211_HW_AP_LINK_PS)
675c868cb35SJohannes Berg 		return;
676004c872eSJohannes Berg 
677c868cb35SJohannes Berg 	if (sta->dead)
678c868cb35SJohannes Berg 		goto done;
6793e122be0SJohannes Berg 
680948d887dSJohannes Berg 	/*
681948d887dSJohannes Berg 	 * If all ACs are delivery-enabled then we should build
682948d887dSJohannes Berg 	 * the TIM bit for all ACs anyway; if only some are then
683948d887dSJohannes Berg 	 * we ignore those and build the TIM bit using only the
684948d887dSJohannes Berg 	 * non-enabled ones.
685948d887dSJohannes Berg 	 */
686948d887dSJohannes Berg 	if (ignore_for_tim == BIT(IEEE80211_NUM_ACS) - 1)
687948d887dSJohannes Berg 		ignore_for_tim = 0;
688948d887dSJohannes Berg 
689948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
690948d887dSJohannes Berg 		unsigned long tids;
691948d887dSJohannes Berg 
692948d887dSJohannes Berg 		if (ignore_for_tim & BIT(ac))
693948d887dSJohannes Berg 			continue;
694948d887dSJohannes Berg 
695948d887dSJohannes Berg 		indicate_tim |= !skb_queue_empty(&sta->tx_filtered[ac]) ||
696948d887dSJohannes Berg 				!skb_queue_empty(&sta->ps_tx_buf[ac]);
697948d887dSJohannes Berg 		if (indicate_tim)
698948d887dSJohannes Berg 			break;
699948d887dSJohannes Berg 
700948d887dSJohannes Berg 		tids = ieee80211_tids_for_ac(ac);
701948d887dSJohannes Berg 
702948d887dSJohannes Berg 		indicate_tim |=
703948d887dSJohannes Berg 			sta->driver_buffered_tids & tids;
704004c872eSJohannes Berg 	}
705004c872eSJohannes Berg 
706c868cb35SJohannes Berg  done:
707c868cb35SJohannes Berg 	spin_lock_irqsave(&local->sta_lock, flags);
708004c872eSJohannes Berg 
709948d887dSJohannes Berg 	if (indicate_tim)
710c868cb35SJohannes Berg 		__bss_tim_set(bss, sta->sta.aid);
711c868cb35SJohannes Berg 	else
71217741cdcSJohannes Berg 		__bss_tim_clear(bss, sta->sta.aid);
7133e122be0SJohannes Berg 
714c868cb35SJohannes Berg 	if (local->ops->set_tim) {
715c868cb35SJohannes Berg 		local->tim_in_locked_section = true;
716948d887dSJohannes Berg 		drv_set_tim(local, &sta->sta, indicate_tim);
717c868cb35SJohannes Berg 		local->tim_in_locked_section = false;
718004c872eSJohannes Berg 	}
719004c872eSJohannes Berg 
720c868cb35SJohannes Berg 	spin_unlock_irqrestore(&local->sta_lock, flags);
721004c872eSJohannes Berg }
722004c872eSJohannes Berg 
723cd0b8d89SJohannes Berg static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb)
724f0706e82SJiri Benc {
725e039fa4aSJohannes Berg 	struct ieee80211_tx_info *info;
726f0706e82SJiri Benc 	int timeout;
727f0706e82SJiri Benc 
728f0706e82SJiri Benc 	if (!skb)
729cd0b8d89SJohannes Berg 		return false;
730f0706e82SJiri Benc 
731e039fa4aSJohannes Berg 	info = IEEE80211_SKB_CB(skb);
732f0706e82SJiri Benc 
733f0706e82SJiri Benc 	/* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */
73457c4d7b4SJohannes Berg 	timeout = (sta->listen_interval *
73557c4d7b4SJohannes Berg 		   sta->sdata->vif.bss_conf.beacon_int *
73657c4d7b4SJohannes Berg 		   32 / 15625) * HZ;
737f0706e82SJiri Benc 	if (timeout < STA_TX_BUFFER_EXPIRE)
738f0706e82SJiri Benc 		timeout = STA_TX_BUFFER_EXPIRE;
739e039fa4aSJohannes Berg 	return time_after(jiffies, info->control.jiffies + timeout);
740f0706e82SJiri Benc }
741f0706e82SJiri Benc 
742f0706e82SJiri Benc 
743948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local,
744948d887dSJohannes Berg 						struct sta_info *sta, int ac)
745f0706e82SJiri Benc {
746f0706e82SJiri Benc 	unsigned long flags;
747f0706e82SJiri Benc 	struct sk_buff *skb;
748f0706e82SJiri Benc 
74960750397SJohannes Berg 	/*
75060750397SJohannes Berg 	 * First check for frames that should expire on the filtered
75160750397SJohannes Berg 	 * queue. Frames here were rejected by the driver and are on
75260750397SJohannes Berg 	 * a separate queue to avoid reordering with normal PS-buffered
75360750397SJohannes Berg 	 * frames. They also aren't accounted for right now in the
75460750397SJohannes Berg 	 * total_ps_buffered counter.
75560750397SJohannes Berg 	 */
756f0706e82SJiri Benc 	for (;;) {
757948d887dSJohannes Berg 		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
758948d887dSJohannes Berg 		skb = skb_peek(&sta->tx_filtered[ac]);
75957c4d7b4SJohannes Berg 		if (sta_info_buffer_expired(sta, skb))
760948d887dSJohannes Berg 			skb = __skb_dequeue(&sta->tx_filtered[ac]);
761836341a7SJohannes Berg 		else
762f0706e82SJiri Benc 			skb = NULL;
763948d887dSJohannes Berg 		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
764f0706e82SJiri Benc 
76560750397SJohannes Berg 		/*
76660750397SJohannes Berg 		 * Frames are queued in order, so if this one
76760750397SJohannes Berg 		 * hasn't expired yet we can stop testing. If
76860750397SJohannes Berg 		 * we actually reached the end of the queue we
76960750397SJohannes Berg 		 * also need to stop, of course.
77060750397SJohannes Berg 		 */
77160750397SJohannes Berg 		if (!skb)
77260750397SJohannes Berg 			break;
77360750397SJohannes Berg 		dev_kfree_skb(skb);
77460750397SJohannes Berg 	}
77560750397SJohannes Berg 
77660750397SJohannes Berg 	/*
77760750397SJohannes Berg 	 * Now also check the normal PS-buffered queue, this will
77860750397SJohannes Berg 	 * only find something if the filtered queue was emptied
77960750397SJohannes Berg 	 * since the filtered frames are all before the normal PS
78060750397SJohannes Berg 	 * buffered frames.
78160750397SJohannes Berg 	 */
782f0706e82SJiri Benc 	for (;;) {
783948d887dSJohannes Berg 		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
784948d887dSJohannes Berg 		skb = skb_peek(&sta->ps_tx_buf[ac]);
785f0706e82SJiri Benc 		if (sta_info_buffer_expired(sta, skb))
786948d887dSJohannes Berg 			skb = __skb_dequeue(&sta->ps_tx_buf[ac]);
787f0706e82SJiri Benc 		else
788f0706e82SJiri Benc 			skb = NULL;
789948d887dSJohannes Berg 		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
790f0706e82SJiri Benc 
79160750397SJohannes Berg 		/*
79260750397SJohannes Berg 		 * frames are queued in order, so if this one
79360750397SJohannes Berg 		 * hasn't expired yet (or we reached the end of
79460750397SJohannes Berg 		 * the queue) we can stop testing
79560750397SJohannes Berg 		 */
796836341a7SJohannes Berg 		if (!skb)
797836341a7SJohannes Berg 			break;
798836341a7SJohannes Berg 
799f0706e82SJiri Benc 		local->total_ps_buffered--;
800f4ea83ddSJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
8010c68ae26SJohannes Berg 		printk(KERN_DEBUG "Buffered frame expired (STA %pM)\n",
8020c68ae26SJohannes Berg 		       sta->sta.addr);
803f4ea83ddSJohannes Berg #endif
804f0706e82SJiri Benc 		dev_kfree_skb(skb);
805f0706e82SJiri Benc 	}
8063393a608SJuuso Oikarinen 
80760750397SJohannes Berg 	/*
80860750397SJohannes Berg 	 * Finally, recalculate the TIM bit for this station -- it might
80960750397SJohannes Berg 	 * now be clear because the station was too slow to retrieve its
81060750397SJohannes Berg 	 * frames.
81160750397SJohannes Berg 	 */
81260750397SJohannes Berg 	sta_info_recalc_tim(sta);
81360750397SJohannes Berg 
81460750397SJohannes Berg 	/*
81560750397SJohannes Berg 	 * Return whether there are any frames still buffered, this is
81660750397SJohannes Berg 	 * used to check whether the cleanup timer still needs to run,
81760750397SJohannes Berg 	 * if there are no frames we don't need to rearm the timer.
81860750397SJohannes Berg 	 */
819948d887dSJohannes Berg 	return !(skb_queue_empty(&sta->ps_tx_buf[ac]) &&
820948d887dSJohannes Berg 		 skb_queue_empty(&sta->tx_filtered[ac]));
821948d887dSJohannes Berg }
822948d887dSJohannes Berg 
823948d887dSJohannes Berg static bool sta_info_cleanup_expire_buffered(struct ieee80211_local *local,
824948d887dSJohannes Berg 					     struct sta_info *sta)
825948d887dSJohannes Berg {
826948d887dSJohannes Berg 	bool have_buffered = false;
827948d887dSJohannes Berg 	int ac;
828948d887dSJohannes Berg 
829948d887dSJohannes Berg 	/* This is only necessary for stations on BSS interfaces */
830948d887dSJohannes Berg 	if (!sta->sdata->bss)
831948d887dSJohannes Berg 		return false;
832948d887dSJohannes Berg 
833948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
834948d887dSJohannes Berg 		have_buffered |=
835948d887dSJohannes Berg 			sta_info_cleanup_expire_buffered_ac(local, sta, ac);
836948d887dSJohannes Berg 
837948d887dSJohannes Berg 	return have_buffered;
838f0706e82SJiri Benc }
839f0706e82SJiri Benc 
84034e89507SJohannes Berg static int __must_check __sta_info_destroy(struct sta_info *sta)
84134e89507SJohannes Berg {
84234e89507SJohannes Berg 	struct ieee80211_local *local;
84334e89507SJohannes Berg 	struct ieee80211_sub_if_data *sdata;
84434e89507SJohannes Berg 	unsigned long flags;
845948d887dSJohannes Berg 	int ret, i, ac;
84642624d49SYogesh Ashok Powar 	struct tid_ampdu_tx *tid_tx;
84734e89507SJohannes Berg 
84834e89507SJohannes Berg 	might_sleep();
84934e89507SJohannes Berg 
85034e89507SJohannes Berg 	if (!sta)
85134e89507SJohannes Berg 		return -ENOENT;
85234e89507SJohannes Berg 
85334e89507SJohannes Berg 	local = sta->local;
85434e89507SJohannes Berg 	sdata = sta->sdata;
85534e89507SJohannes Berg 
856098a6070SJohannes Berg 	/*
857098a6070SJohannes Berg 	 * Before removing the station from the driver and
858098a6070SJohannes Berg 	 * rate control, it might still start new aggregation
859098a6070SJohannes Berg 	 * sessions -- block that to make sure the tear-down
860098a6070SJohannes Berg 	 * will be sufficient.
861098a6070SJohannes Berg 	 */
862c2c98fdeSJohannes Berg 	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
86353f73c09SJohannes Berg 	ieee80211_sta_tear_down_BA_sessions(sta, true);
864098a6070SJohannes Berg 
86534e89507SJohannes Berg 	spin_lock_irqsave(&local->sta_lock, flags);
86634e89507SJohannes Berg 	ret = sta_info_hash_del(local, sta);
86734e89507SJohannes Berg 	/* this might still be the pending list ... which is fine */
86834e89507SJohannes Berg 	if (!ret)
86934e89507SJohannes Berg 		list_del(&sta->list);
87034e89507SJohannes Berg 	spin_unlock_irqrestore(&local->sta_lock, flags);
87134e89507SJohannes Berg 	if (ret)
87234e89507SJohannes Berg 		return ret;
87334e89507SJohannes Berg 
8748cb23153SJohannes Berg 	mutex_lock(&local->key_mtx);
875e31b8213SJohannes Berg 	for (i = 0; i < NUM_DEFAULT_KEYS; i++)
87640b275b6SJohannes Berg 		__ieee80211_key_free(key_mtx_dereference(local, sta->gtk[i]));
877e31b8213SJohannes Berg 	if (sta->ptk)
87840b275b6SJohannes Berg 		__ieee80211_key_free(key_mtx_dereference(local, sta->ptk));
8798cb23153SJohannes Berg 	mutex_unlock(&local->key_mtx);
88034e89507SJohannes Berg 
88134e89507SJohannes Berg 	sta->dead = true;
88234e89507SJohannes Berg 
883c2c98fdeSJohannes Berg 	if (test_sta_flag(sta, WLAN_STA_PS_STA) ||
884c2c98fdeSJohannes Berg 	    test_sta_flag(sta, WLAN_STA_PS_DRIVER)) {
88534e89507SJohannes Berg 		BUG_ON(!sdata->bss);
88634e89507SJohannes Berg 
887c2c98fdeSJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_STA);
888c2c98fdeSJohannes Berg 		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
889c2c98fdeSJohannes Berg 
89034e89507SJohannes Berg 		atomic_dec(&sdata->bss->num_sta_ps);
891c868cb35SJohannes Berg 		sta_info_recalc_tim(sta);
89234e89507SJohannes Berg 	}
89334e89507SJohannes Berg 
89434e89507SJohannes Berg 	local->num_sta--;
89534e89507SJohannes Berg 	local->sta_generation++;
89634e89507SJohannes Berg 
89734e89507SJohannes Berg 	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
898a9b3cd7fSStephen Hemminger 		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
89934e89507SJohannes Berg 
900d9a7ddb0SJohannes Berg 	while (sta->sta_state > IEEE80211_STA_NONE)
901d9a7ddb0SJohannes Berg 		sta_info_move_state(sta, sta->sta_state - 1);
902d9a7ddb0SJohannes Berg 
90334e89507SJohannes Berg 	if (sta->uploaded) {
90434e89507SJohannes Berg 		if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
90534e89507SJohannes Berg 			sdata = container_of(sdata->bss,
90634e89507SJohannes Berg 					     struct ieee80211_sub_if_data,
90734e89507SJohannes Berg 					     u.ap);
90834e89507SJohannes Berg 		drv_sta_remove(local, sdata, &sta->sta);
90934e89507SJohannes Berg 		sdata = sta->sdata;
91034e89507SJohannes Berg 	}
91134e89507SJohannes Berg 
912e64b3795SJohannes Berg 	/*
913e64b3795SJohannes Berg 	 * At this point, after we wait for an RCU grace period,
914e64b3795SJohannes Berg 	 * neither mac80211 nor the driver can reference this
915e64b3795SJohannes Berg 	 * sta struct any more except by still existing timers
916e64b3795SJohannes Berg 	 * associated with this station that we clean up below.
917e64b3795SJohannes Berg 	 */
918e64b3795SJohannes Berg 	synchronize_rcu();
919e64b3795SJohannes Berg 
920948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
921948d887dSJohannes Berg 		local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]);
922948d887dSJohannes Berg 		__skb_queue_purge(&sta->ps_tx_buf[ac]);
923948d887dSJohannes Berg 		__skb_queue_purge(&sta->tx_filtered[ac]);
924948d887dSJohannes Berg 	}
925c868cb35SJohannes Berg 
92634e89507SJohannes Berg #ifdef CONFIG_MAC80211_MESH
927e64b3795SJohannes Berg 	if (ieee80211_vif_is_mesh(&sdata->vif))
92834e89507SJohannes Berg 		mesh_accept_plinks_update(sdata);
92934e89507SJohannes Berg #endif
93034e89507SJohannes Berg 
93134e89507SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
9320fb9a9ecSJoe Perches 	wiphy_debug(local->hw.wiphy, "Removed STA %pM\n", sta->sta.addr);
93334e89507SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
93434e89507SJohannes Berg 	cancel_work_sync(&sta->drv_unblock_wk);
93534e89507SJohannes Berg 
936ec15e68bSJouni Malinen 	cfg80211_del_sta(sdata->dev, sta->sta.addr, GFP_KERNEL);
937ec15e68bSJouni Malinen 
93834e89507SJohannes Berg 	rate_control_remove_sta_debugfs(sta);
93934e89507SJohannes Berg 	ieee80211_sta_debugfs_remove(sta);
94034e89507SJohannes Berg 
94134e89507SJohannes Berg #ifdef CONFIG_MAC80211_MESH
94234e89507SJohannes Berg 	if (ieee80211_vif_is_mesh(&sta->sdata->vif)) {
94334e89507SJohannes Berg 		mesh_plink_deactivate(sta);
94434e89507SJohannes Berg 		del_timer_sync(&sta->plink_timer);
94534e89507SJohannes Berg 	}
94634e89507SJohannes Berg #endif
94734e89507SJohannes Berg 
94842624d49SYogesh Ashok Powar 	/* There could be some memory leaks because of ampdu tx pending queue
94942624d49SYogesh Ashok Powar 	 * not being freed before destroying the station info.
95042624d49SYogesh Ashok Powar 	 *
95142624d49SYogesh Ashok Powar 	 * Make sure that such queues are purged before freeing the station
95242624d49SYogesh Ashok Powar 	 * info.
95342624d49SYogesh Ashok Powar 	 * TODO: We have to somehow postpone the full destruction
95442624d49SYogesh Ashok Powar 	 * until the aggregation stop completes. Refer
95542624d49SYogesh Ashok Powar 	 * http://thread.gmane.org/gmane.linux.kernel.wireless.general/81936
95642624d49SYogesh Ashok Powar 	 */
95742624d49SYogesh Ashok Powar 	for (i = 0; i < STA_TID_NUM; i++) {
95842624d49SYogesh Ashok Powar 		if (!sta->ampdu_mlme.tid_tx[i])
95942624d49SYogesh Ashok Powar 			continue;
96042624d49SYogesh Ashok Powar 		tid_tx = sta->ampdu_mlme.tid_tx[i];
96142624d49SYogesh Ashok Powar 		if (skb_queue_len(&tid_tx->pending)) {
96242624d49SYogesh Ashok Powar #ifdef CONFIG_MAC80211_HT_DEBUG
96342624d49SYogesh Ashok Powar 			wiphy_debug(local->hw.wiphy, "TX A-MPDU  purging %d "
96442624d49SYogesh Ashok Powar 				"packets for tid=%d\n",
96542624d49SYogesh Ashok Powar 				skb_queue_len(&tid_tx->pending), i);
96642624d49SYogesh Ashok Powar #endif /* CONFIG_MAC80211_HT_DEBUG */
96742624d49SYogesh Ashok Powar 			__skb_queue_purge(&tid_tx->pending);
96842624d49SYogesh Ashok Powar 		}
96942624d49SYogesh Ashok Powar 		kfree_rcu(tid_tx, rcu_head);
97042624d49SYogesh Ashok Powar 	}
97142624d49SYogesh Ashok Powar 
972d9a7ddb0SJohannes Berg 	sta_info_free(local, sta);
97334e89507SJohannes Berg 
97434e89507SJohannes Berg 	return 0;
97534e89507SJohannes Berg }
97634e89507SJohannes Berg 
97734e89507SJohannes Berg int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr)
97834e89507SJohannes Berg {
97934e89507SJohannes Berg 	struct sta_info *sta;
98034e89507SJohannes Berg 	int ret;
98134e89507SJohannes Berg 
98234e89507SJohannes Berg 	mutex_lock(&sdata->local->sta_mtx);
9832a33bee2SGuy Eilam 	sta = sta_info_get_rx(sdata, addr);
98434e89507SJohannes Berg 	ret = __sta_info_destroy(sta);
98534e89507SJohannes Berg 	mutex_unlock(&sdata->local->sta_mtx);
98634e89507SJohannes Berg 
98734e89507SJohannes Berg 	return ret;
98834e89507SJohannes Berg }
98934e89507SJohannes Berg 
99034e89507SJohannes Berg int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata,
99134e89507SJohannes Berg 			      const u8 *addr)
99234e89507SJohannes Berg {
99334e89507SJohannes Berg 	struct sta_info *sta;
99434e89507SJohannes Berg 	int ret;
99534e89507SJohannes Berg 
99634e89507SJohannes Berg 	mutex_lock(&sdata->local->sta_mtx);
9972a33bee2SGuy Eilam 	sta = sta_info_get_bss_rx(sdata, addr);
99834e89507SJohannes Berg 	ret = __sta_info_destroy(sta);
99934e89507SJohannes Berg 	mutex_unlock(&sdata->local->sta_mtx);
100034e89507SJohannes Berg 
100134e89507SJohannes Berg 	return ret;
100234e89507SJohannes Berg }
1003f0706e82SJiri Benc 
1004f0706e82SJiri Benc static void sta_info_cleanup(unsigned long data)
1005f0706e82SJiri Benc {
1006f0706e82SJiri Benc 	struct ieee80211_local *local = (struct ieee80211_local *) data;
1007f0706e82SJiri Benc 	struct sta_info *sta;
10083393a608SJuuso Oikarinen 	bool timer_needed = false;
1009f0706e82SJiri Benc 
1010d0709a65SJohannes Berg 	rcu_read_lock();
1011d0709a65SJohannes Berg 	list_for_each_entry_rcu(sta, &local->sta_list, list)
10123393a608SJuuso Oikarinen 		if (sta_info_cleanup_expire_buffered(local, sta))
10133393a608SJuuso Oikarinen 			timer_needed = true;
1014d0709a65SJohannes Berg 	rcu_read_unlock();
1015f0706e82SJiri Benc 
10165bb644a0SJohannes Berg 	if (local->quiescing)
10175bb644a0SJohannes Berg 		return;
10185bb644a0SJohannes Berg 
10193393a608SJuuso Oikarinen 	if (!timer_needed)
10203393a608SJuuso Oikarinen 		return;
10213393a608SJuuso Oikarinen 
102226d59535SJohannes Berg 	mod_timer(&local->sta_cleanup,
102326d59535SJohannes Berg 		  round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL));
1024f0706e82SJiri Benc }
1025f0706e82SJiri Benc 
1026f0706e82SJiri Benc void sta_info_init(struct ieee80211_local *local)
1027f0706e82SJiri Benc {
1028d0709a65SJohannes Berg 	spin_lock_init(&local->sta_lock);
102934e89507SJohannes Berg 	mutex_init(&local->sta_mtx);
1030f0706e82SJiri Benc 	INIT_LIST_HEAD(&local->sta_list);
103134e89507SJohannes Berg 	INIT_LIST_HEAD(&local->sta_pending_list);
103234e89507SJohannes Berg 	INIT_WORK(&local->sta_finish_work, sta_info_finish_work);
1033f0706e82SJiri Benc 
1034b24b8a24SPavel Emelyanov 	setup_timer(&local->sta_cleanup, sta_info_cleanup,
1035b24b8a24SPavel Emelyanov 		    (unsigned long)local);
1036f0706e82SJiri Benc }
1037f0706e82SJiri Benc 
1038f0706e82SJiri Benc void sta_info_stop(struct ieee80211_local *local)
1039f0706e82SJiri Benc {
1040f0706e82SJiri Benc 	del_timer(&local->sta_cleanup);
1041be8755e1SMichael Wu 	sta_info_flush(local, NULL);
1042f0706e82SJiri Benc }
1043f0706e82SJiri Benc 
1044f0706e82SJiri Benc /**
1045f0706e82SJiri Benc  * sta_info_flush - flush matching STA entries from the STA table
104644213b5eSJohannes Berg  *
104744213b5eSJohannes Berg  * Returns the number of removed STA entries.
104844213b5eSJohannes Berg  *
1049f0706e82SJiri Benc  * @local: local interface data
1050d0709a65SJohannes Berg  * @sdata: matching rule for the net device (sta->dev) or %NULL to match all STAs
1051f0706e82SJiri Benc  */
105244213b5eSJohannes Berg int sta_info_flush(struct ieee80211_local *local,
1053d0709a65SJohannes Berg 		   struct ieee80211_sub_if_data *sdata)
1054f0706e82SJiri Benc {
1055f0706e82SJiri Benc 	struct sta_info *sta, *tmp;
105644213b5eSJohannes Berg 	int ret = 0;
1057f0706e82SJiri Benc 
1058d0709a65SJohannes Berg 	might_sleep();
1059d0709a65SJohannes Berg 
106034e89507SJohannes Berg 	mutex_lock(&local->sta_mtx);
1061d0709a65SJohannes Berg 
106234e89507SJohannes Berg 	sta_info_finish_pending(local);
106334e89507SJohannes Berg 
106434e89507SJohannes Berg 	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
106534e89507SJohannes Berg 		if (!sdata || sdata == sta->sdata)
106634e89507SJohannes Berg 			WARN_ON(__sta_info_destroy(sta));
106734e89507SJohannes Berg 	}
106834e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
106944213b5eSJohannes Berg 
107044213b5eSJohannes Berg 	return ret;
1071f0706e82SJiri Benc }
1072dc6676b7SJohannes Berg 
107324723d1bSJohannes Berg void ieee80211_sta_expire(struct ieee80211_sub_if_data *sdata,
107424723d1bSJohannes Berg 			  unsigned long exp_time)
107524723d1bSJohannes Berg {
107624723d1bSJohannes Berg 	struct ieee80211_local *local = sdata->local;
107724723d1bSJohannes Berg 	struct sta_info *sta, *tmp;
107824723d1bSJohannes Berg 
107934e89507SJohannes Berg 	mutex_lock(&local->sta_mtx);
108024723d1bSJohannes Berg 	list_for_each_entry_safe(sta, tmp, &local->sta_list, list)
108124723d1bSJohannes Berg 		if (time_after(jiffies, sta->last_rx + exp_time)) {
108224723d1bSJohannes Berg #ifdef CONFIG_MAC80211_IBSS_DEBUG
10830c68ae26SJohannes Berg 			printk(KERN_DEBUG "%s: expiring inactive STA %pM\n",
108447846c9bSJohannes Berg 			       sdata->name, sta->sta.addr);
108524723d1bSJohannes Berg #endif
108634e89507SJohannes Berg 			WARN_ON(__sta_info_destroy(sta));
108724723d1bSJohannes Berg 		}
108834e89507SJohannes Berg 	mutex_unlock(&local->sta_mtx);
108924723d1bSJohannes Berg }
109017741cdcSJohannes Berg 
1091686b9cb9SBen Greear struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
1092686b9cb9SBen Greear 					       const u8 *addr,
1093686b9cb9SBen Greear 					       const u8 *localaddr)
109417741cdcSJohannes Berg {
1095abe60632SJohannes Berg 	struct sta_info *sta, *nxt;
109617741cdcSJohannes Berg 
1097686b9cb9SBen Greear 	/*
1098686b9cb9SBen Greear 	 * Just return a random station if localaddr is NULL
1099686b9cb9SBen Greear 	 * ... first in list.
1100686b9cb9SBen Greear 	 */
1101f7c65594SJohannes Berg 	for_each_sta_info(hw_to_local(hw), addr, sta, nxt) {
1102686b9cb9SBen Greear 		if (localaddr &&
1103686b9cb9SBen Greear 		    compare_ether_addr(sta->sdata->vif.addr, localaddr) != 0)
1104686b9cb9SBen Greear 			continue;
1105f7c65594SJohannes Berg 		if (!sta->uploaded)
1106f7c65594SJohannes Berg 			return NULL;
110717741cdcSJohannes Berg 		return &sta->sta;
1108f7c65594SJohannes Berg 	}
1109f7c65594SJohannes Berg 
1110abe60632SJohannes Berg 	return NULL;
111117741cdcSJohannes Berg }
1112686b9cb9SBen Greear EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
11135ed176e1SJohannes Berg 
11145ed176e1SJohannes Berg struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif,
11155ed176e1SJohannes Berg 					 const u8 *addr)
11165ed176e1SJohannes Berg {
1117f7c65594SJohannes Berg 	struct sta_info *sta;
11185ed176e1SJohannes Berg 
11195ed176e1SJohannes Berg 	if (!vif)
11205ed176e1SJohannes Berg 		return NULL;
11215ed176e1SJohannes Berg 
1122f7c65594SJohannes Berg 	sta = sta_info_get_bss(vif_to_sdata(vif), addr);
1123f7c65594SJohannes Berg 	if (!sta)
1124f7c65594SJohannes Berg 		return NULL;
11255ed176e1SJohannes Berg 
1126f7c65594SJohannes Berg 	if (!sta->uploaded)
1127f7c65594SJohannes Berg 		return NULL;
1128f7c65594SJohannes Berg 
1129f7c65594SJohannes Berg 	return &sta->sta;
11305ed176e1SJohannes Berg }
113117741cdcSJohannes Berg EXPORT_SYMBOL(ieee80211_find_sta);
1132af818581SJohannes Berg 
113350a9432dSJohannes Berg static void clear_sta_ps_flags(void *_sta)
113450a9432dSJohannes Berg {
113550a9432dSJohannes Berg 	struct sta_info *sta = _sta;
113650a9432dSJohannes Berg 
1137c2c98fdeSJohannes Berg 	clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
1138c2c98fdeSJohannes Berg 	clear_sta_flag(sta, WLAN_STA_PS_STA);
113950a9432dSJohannes Berg }
114050a9432dSJohannes Berg 
1141af818581SJohannes Berg /* powersave support code */
1142af818581SJohannes Berg void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta)
1143af818581SJohannes Berg {
1144af818581SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1145af818581SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1146948d887dSJohannes Berg 	struct sk_buff_head pending;
1147948d887dSJohannes Berg 	int filtered = 0, buffered = 0, ac;
1148af818581SJohannes Berg 
1149c2c98fdeSJohannes Berg 	clear_sta_flag(sta, WLAN_STA_SP);
115047086fc5SJohannes Berg 
1151948d887dSJohannes Berg 	BUILD_BUG_ON(BITS_TO_LONGS(STA_TID_NUM) > 1);
1152948d887dSJohannes Berg 	sta->driver_buffered_tids = 0;
1153948d887dSJohannes Berg 
1154d057e5a3SArik Nemtsov 	if (!(local->hw.flags & IEEE80211_HW_AP_LINK_PS))
115512375ef9SJohannes Berg 		drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta);
1156af818581SJohannes Berg 
1157948d887dSJohannes Berg 	skb_queue_head_init(&pending);
1158af818581SJohannes Berg 
1159af818581SJohannes Berg 	/* Send all buffered frames to the station */
1160948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1161948d887dSJohannes Berg 		int count = skb_queue_len(&pending), tmp;
1162948d887dSJohannes Berg 
1163948d887dSJohannes Berg 		skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending);
1164948d887dSJohannes Berg 		tmp = skb_queue_len(&pending);
1165948d887dSJohannes Berg 		filtered += tmp - count;
1166948d887dSJohannes Berg 		count = tmp;
1167948d887dSJohannes Berg 
1168948d887dSJohannes Berg 		skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending);
1169948d887dSJohannes Berg 		tmp = skb_queue_len(&pending);
1170948d887dSJohannes Berg 		buffered += tmp - count;
1171948d887dSJohannes Berg 	}
1172948d887dSJohannes Berg 
1173948d887dSJohannes Berg 	ieee80211_add_pending_skbs_fn(local, &pending, clear_sta_ps_flags, sta);
1174948d887dSJohannes Berg 
1175af818581SJohannes Berg 	local->total_ps_buffered -= buffered;
1176af818581SJohannes Berg 
1177c868cb35SJohannes Berg 	sta_info_recalc_tim(sta);
1178c868cb35SJohannes Berg 
1179af818581SJohannes Berg #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
1180af818581SJohannes Berg 	printk(KERN_DEBUG "%s: STA %pM aid %d sending %d filtered/%d PS frames "
118147846c9bSJohannes Berg 	       "since STA not sleeping anymore\n", sdata->name,
1182948d887dSJohannes Berg 	       sta->sta.addr, sta->sta.aid, filtered, buffered);
1183af818581SJohannes Berg #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
1184af818581SJohannes Berg }
1185af818581SJohannes Berg 
1186ce662b44SJohannes Berg static void ieee80211_send_null_response(struct ieee80211_sub_if_data *sdata,
1187ce662b44SJohannes Berg 					 struct sta_info *sta, int tid,
118840b96408SJohannes Berg 					 enum ieee80211_frame_release_type reason)
1189ce662b44SJohannes Berg {
1190ce662b44SJohannes Berg 	struct ieee80211_local *local = sdata->local;
1191ce662b44SJohannes Berg 	struct ieee80211_qos_hdr *nullfunc;
1192ce662b44SJohannes Berg 	struct sk_buff *skb;
1193ce662b44SJohannes Berg 	int size = sizeof(*nullfunc);
1194ce662b44SJohannes Berg 	__le16 fc;
1195c2c98fdeSJohannes Berg 	bool qos = test_sta_flag(sta, WLAN_STA_WME);
1196ce662b44SJohannes Berg 	struct ieee80211_tx_info *info;
1197ce662b44SJohannes Berg 
1198ce662b44SJohannes Berg 	if (qos) {
1199ce662b44SJohannes Berg 		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
1200ce662b44SJohannes Berg 				 IEEE80211_STYPE_QOS_NULLFUNC |
1201ce662b44SJohannes Berg 				 IEEE80211_FCTL_FROMDS);
1202ce662b44SJohannes Berg 	} else {
1203ce662b44SJohannes Berg 		size -= 2;
1204ce662b44SJohannes Berg 		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
1205ce662b44SJohannes Berg 				 IEEE80211_STYPE_NULLFUNC |
1206ce662b44SJohannes Berg 				 IEEE80211_FCTL_FROMDS);
1207ce662b44SJohannes Berg 	}
1208ce662b44SJohannes Berg 
1209ce662b44SJohannes Berg 	skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
1210ce662b44SJohannes Berg 	if (!skb)
1211ce662b44SJohannes Berg 		return;
1212ce662b44SJohannes Berg 
1213ce662b44SJohannes Berg 	skb_reserve(skb, local->hw.extra_tx_headroom);
1214ce662b44SJohannes Berg 
1215ce662b44SJohannes Berg 	nullfunc = (void *) skb_put(skb, size);
1216ce662b44SJohannes Berg 	nullfunc->frame_control = fc;
1217ce662b44SJohannes Berg 	nullfunc->duration_id = 0;
1218ce662b44SJohannes Berg 	memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
1219ce662b44SJohannes Berg 	memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
1220ce662b44SJohannes Berg 	memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
1221ce662b44SJohannes Berg 
1222ce662b44SJohannes Berg 	skb->priority = tid;
1223ce662b44SJohannes Berg 	skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]);
122459b66255SJohannes Berg 	if (qos) {
1225ce662b44SJohannes Berg 		nullfunc->qos_ctrl = cpu_to_le16(tid);
1226ce662b44SJohannes Berg 
122740b96408SJohannes Berg 		if (reason == IEEE80211_FRAME_RELEASE_UAPSD)
1228ce662b44SJohannes Berg 			nullfunc->qos_ctrl |=
1229ce662b44SJohannes Berg 				cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
1230ce662b44SJohannes Berg 	}
1231ce662b44SJohannes Berg 
1232ce662b44SJohannes Berg 	info = IEEE80211_SKB_CB(skb);
1233ce662b44SJohannes Berg 
1234ce662b44SJohannes Berg 	/*
1235ce662b44SJohannes Berg 	 * Tell TX path to send this frame even though the
1236ce662b44SJohannes Berg 	 * STA may still remain is PS mode after this frame
1237deeaee19SJohannes Berg 	 * exchange. Also set EOSP to indicate this packet
1238deeaee19SJohannes Berg 	 * ends the poll/service period.
1239ce662b44SJohannes Berg 	 */
1240deeaee19SJohannes Berg 	info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE |
1241deeaee19SJohannes Berg 		       IEEE80211_TX_STATUS_EOSP |
1242ce662b44SJohannes Berg 		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1243ce662b44SJohannes Berg 
124440b96408SJohannes Berg 	drv_allow_buffered_frames(local, sta, BIT(tid), 1, reason, false);
124540b96408SJohannes Berg 
1246ce662b44SJohannes Berg 	ieee80211_xmit(sdata, skb);
1247ce662b44SJohannes Berg }
1248ce662b44SJohannes Berg 
124947086fc5SJohannes Berg static void
125047086fc5SJohannes Berg ieee80211_sta_ps_deliver_response(struct sta_info *sta,
125147086fc5SJohannes Berg 				  int n_frames, u8 ignored_acs,
125247086fc5SJohannes Berg 				  enum ieee80211_frame_release_type reason)
1253af818581SJohannes Berg {
1254af818581SJohannes Berg 	struct ieee80211_sub_if_data *sdata = sta->sdata;
1255af818581SJohannes Berg 	struct ieee80211_local *local = sdata->local;
12564049e09aSJohannes Berg 	bool found = false;
1257948d887dSJohannes Berg 	bool more_data = false;
1258948d887dSJohannes Berg 	int ac;
12594049e09aSJohannes Berg 	unsigned long driver_release_tids = 0;
126047086fc5SJohannes Berg 	struct sk_buff_head frames;
126147086fc5SJohannes Berg 
1262deeaee19SJohannes Berg 	/* Service or PS-Poll period starts */
1263c2c98fdeSJohannes Berg 	set_sta_flag(sta, WLAN_STA_SP);
1264deeaee19SJohannes Berg 
126547086fc5SJohannes Berg 	__skb_queue_head_init(&frames);
1266af818581SJohannes Berg 
1267948d887dSJohannes Berg 	/*
126847086fc5SJohannes Berg 	 * Get response frame(s) and more data bit for it.
1269948d887dSJohannes Berg 	 */
1270948d887dSJohannes Berg 	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
12714049e09aSJohannes Berg 		unsigned long tids;
12724049e09aSJohannes Berg 
127347086fc5SJohannes Berg 		if (ignored_acs & BIT(ac))
1274948d887dSJohannes Berg 			continue;
1275948d887dSJohannes Berg 
12764049e09aSJohannes Berg 		tids = ieee80211_tids_for_ac(ac);
12774049e09aSJohannes Berg 
12784049e09aSJohannes Berg 		if (!found) {
12794049e09aSJohannes Berg 			driver_release_tids = sta->driver_buffered_tids & tids;
12804049e09aSJohannes Berg 			if (driver_release_tids) {
12814049e09aSJohannes Berg 				found = true;
12824049e09aSJohannes Berg 			} else {
128347086fc5SJohannes Berg 				struct sk_buff *skb;
128447086fc5SJohannes Berg 
128547086fc5SJohannes Berg 				while (n_frames > 0) {
1286948d887dSJohannes Berg 					skb = skb_dequeue(&sta->tx_filtered[ac]);
1287948d887dSJohannes Berg 					if (!skb) {
128847086fc5SJohannes Berg 						skb = skb_dequeue(
128947086fc5SJohannes Berg 							&sta->ps_tx_buf[ac]);
1290af818581SJohannes Berg 						if (skb)
1291af818581SJohannes Berg 							local->total_ps_buffered--;
1292af818581SJohannes Berg 					}
129347086fc5SJohannes Berg 					if (!skb)
129447086fc5SJohannes Berg 						break;
129547086fc5SJohannes Berg 					n_frames--;
12964049e09aSJohannes Berg 					found = true;
129747086fc5SJohannes Berg 					__skb_queue_tail(&frames, skb);
129847086fc5SJohannes Berg 				}
1299948d887dSJohannes Berg 			}
1300948d887dSJohannes Berg 
13014049e09aSJohannes Berg 			/*
13024049e09aSJohannes Berg 			 * If the driver has data on more than one TID then
13034049e09aSJohannes Berg 			 * certainly there's more data if we release just a
13044049e09aSJohannes Berg 			 * single frame now (from a single TID).
13054049e09aSJohannes Berg 			 */
130647086fc5SJohannes Berg 			if (reason == IEEE80211_FRAME_RELEASE_PSPOLL &&
130747086fc5SJohannes Berg 			    hweight16(driver_release_tids) > 1) {
13084049e09aSJohannes Berg 				more_data = true;
13094049e09aSJohannes Berg 				driver_release_tids =
13104049e09aSJohannes Berg 					BIT(ffs(driver_release_tids) - 1);
13114049e09aSJohannes Berg 				break;
13124049e09aSJohannes Berg 			}
13134049e09aSJohannes Berg 		}
1314948d887dSJohannes Berg 
1315948d887dSJohannes Berg 		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
1316948d887dSJohannes Berg 		    !skb_queue_empty(&sta->ps_tx_buf[ac])) {
1317948d887dSJohannes Berg 			more_data = true;
1318948d887dSJohannes Berg 			break;
1319948d887dSJohannes Berg 		}
1320948d887dSJohannes Berg 	}
1321af818581SJohannes Berg 
13224049e09aSJohannes Berg 	if (!found) {
1323ce662b44SJohannes Berg 		int tid;
13244049e09aSJohannes Berg 
1325ce662b44SJohannes Berg 		/*
1326ce662b44SJohannes Berg 		 * For PS-Poll, this can only happen due to a race condition
1327ce662b44SJohannes Berg 		 * when we set the TIM bit and the station notices it, but
1328ce662b44SJohannes Berg 		 * before it can poll for the frame we expire it.
1329ce662b44SJohannes Berg 		 *
1330ce662b44SJohannes Berg 		 * For uAPSD, this is said in the standard (11.2.1.5 h):
1331ce662b44SJohannes Berg 		 *	At each unscheduled SP for a non-AP STA, the AP shall
1332ce662b44SJohannes Berg 		 *	attempt to transmit at least one MSDU or MMPDU, but no
1333ce662b44SJohannes Berg 		 *	more than the value specified in the Max SP Length field
1334ce662b44SJohannes Berg 		 *	in the QoS Capability element from delivery-enabled ACs,
1335ce662b44SJohannes Berg 		 *	that are destined for the non-AP STA.
1336ce662b44SJohannes Berg 		 *
1337ce662b44SJohannes Berg 		 * Since we have no other MSDU/MMPDU, transmit a QoS null frame.
1338ce662b44SJohannes Berg 		 */
1339ce662b44SJohannes Berg 
1340ce662b44SJohannes Berg 		/* This will evaluate to 1, 3, 5 or 7. */
1341ce662b44SJohannes Berg 		tid = 7 - ((ffs(~ignored_acs) - 1) << 1);
1342ce662b44SJohannes Berg 
134340b96408SJohannes Berg 		ieee80211_send_null_response(sdata, sta, tid, reason);
13444049e09aSJohannes Berg 		return;
13454049e09aSJohannes Berg 	}
13464049e09aSJohannes Berg 
134747086fc5SJohannes Berg 	if (!driver_release_tids) {
134847086fc5SJohannes Berg 		struct sk_buff_head pending;
134947086fc5SJohannes Berg 		struct sk_buff *skb;
135040b96408SJohannes Berg 		int num = 0;
135140b96408SJohannes Berg 		u16 tids = 0;
135247086fc5SJohannes Berg 
135347086fc5SJohannes Berg 		skb_queue_head_init(&pending);
135447086fc5SJohannes Berg 
135547086fc5SJohannes Berg 		while ((skb = __skb_dequeue(&frames))) {
1356af818581SJohannes Berg 			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
135747086fc5SJohannes Berg 			struct ieee80211_hdr *hdr = (void *) skb->data;
135840b96408SJohannes Berg 			u8 *qoshdr = NULL;
135940b96408SJohannes Berg 
136040b96408SJohannes Berg 			num++;
1361af818581SJohannes Berg 
1362af818581SJohannes Berg 			/*
136347086fc5SJohannes Berg 			 * Tell TX path to send this frame even though the
136447086fc5SJohannes Berg 			 * STA may still remain is PS mode after this frame
136547086fc5SJohannes Berg 			 * exchange.
1366af818581SJohannes Berg 			 */
136747086fc5SJohannes Berg 			info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE;
1368af818581SJohannes Berg 
136947086fc5SJohannes Berg 			/*
137047086fc5SJohannes Berg 			 * Use MoreData flag to indicate whether there are
137147086fc5SJohannes Berg 			 * more buffered frames for this STA
137247086fc5SJohannes Berg 			 */
137324b9c373SJanusz.Dziedzic@tieto.com 			if (more_data || !skb_queue_empty(&frames))
137447086fc5SJohannes Berg 				hdr->frame_control |=
137547086fc5SJohannes Berg 					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
137624b9c373SJanusz.Dziedzic@tieto.com 			else
137724b9c373SJanusz.Dziedzic@tieto.com 				hdr->frame_control &=
137824b9c373SJanusz.Dziedzic@tieto.com 					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
1379af818581SJohannes Berg 
138040b96408SJohannes Berg 			if (ieee80211_is_data_qos(hdr->frame_control) ||
138140b96408SJohannes Berg 			    ieee80211_is_qos_nullfunc(hdr->frame_control))
138240b96408SJohannes Berg 				qoshdr = ieee80211_get_qos_ctl(hdr);
138340b96408SJohannes Berg 
138447086fc5SJohannes Berg 			/* set EOSP for the frame */
138540b96408SJohannes Berg 			if (reason == IEEE80211_FRAME_RELEASE_UAPSD &&
138640b96408SJohannes Berg 			    qoshdr && skb_queue_empty(&frames))
138740b96408SJohannes Berg 				*qoshdr |= IEEE80211_QOS_CTL_EOSP;
1388deeaee19SJohannes Berg 
138947086fc5SJohannes Berg 			info->flags |= IEEE80211_TX_STATUS_EOSP |
139047086fc5SJohannes Berg 				       IEEE80211_TX_CTL_REQ_TX_STATUS;
139147086fc5SJohannes Berg 
139240b96408SJohannes Berg 			if (qoshdr)
139340b96408SJohannes Berg 				tids |= BIT(*qoshdr & IEEE80211_QOS_CTL_TID_MASK);
139440b96408SJohannes Berg 			else
139540b96408SJohannes Berg 				tids |= BIT(0);
139640b96408SJohannes Berg 
139747086fc5SJohannes Berg 			__skb_queue_tail(&pending, skb);
139847086fc5SJohannes Berg 		}
139947086fc5SJohannes Berg 
140040b96408SJohannes Berg 		drv_allow_buffered_frames(local, sta, tids, num,
140140b96408SJohannes Berg 					  reason, more_data);
140240b96408SJohannes Berg 
140347086fc5SJohannes Berg 		ieee80211_add_pending_skbs(local, &pending);
1404af818581SJohannes Berg 
1405c868cb35SJohannes Berg 		sta_info_recalc_tim(sta);
1406af818581SJohannes Berg 	} else {
1407af818581SJohannes Berg 		/*
14084049e09aSJohannes Berg 		 * We need to release a frame that is buffered somewhere in the
14094049e09aSJohannes Berg 		 * driver ... it'll have to handle that.
14104049e09aSJohannes Berg 		 * Note that, as per the comment above, it'll also have to see
14114049e09aSJohannes Berg 		 * if there is more than just one frame on the specific TID that
14124049e09aSJohannes Berg 		 * we're releasing from, and it needs to set the more-data bit
14134049e09aSJohannes Berg 		 * accordingly if we tell it that there's no more data. If we do
14144049e09aSJohannes Berg 		 * tell it there's more data, then of course the more-data bit
14154049e09aSJohannes Berg 		 * needs to be set anyway.
1416af818581SJohannes Berg 		 */
14174049e09aSJohannes Berg 		drv_release_buffered_frames(local, sta, driver_release_tids,
141847086fc5SJohannes Berg 					    n_frames, reason, more_data);
14194049e09aSJohannes Berg 
14204049e09aSJohannes Berg 		/*
14214049e09aSJohannes Berg 		 * Note that we don't recalculate the TIM bit here as it would
14224049e09aSJohannes Berg 		 * most likely have no effect at all unless the driver told us
14234049e09aSJohannes Berg 		 * that the TID became empty before returning here from the
14244049e09aSJohannes Berg 		 * release function.
14254049e09aSJohannes Berg 		 * Either way, however, when the driver tells us that the TID
14264049e09aSJohannes Berg 		 * became empty we'll do the TIM recalculation.
14274049e09aSJohannes Berg 		 */
1428af818581SJohannes Berg 	}
1429af818581SJohannes Berg }
1430af818581SJohannes Berg 
1431af818581SJohannes Berg void ieee80211_sta_ps_deliver_poll_response(struct sta_info *sta)
1432af818581SJohannes Berg {
143347086fc5SJohannes Berg 	u8 ignore_for_response = sta->sta.uapsd_queues;
1434af818581SJohannes Berg 
1435af818581SJohannes Berg 	/*
143647086fc5SJohannes Berg 	 * If all ACs are delivery-enabled then we should reply
143747086fc5SJohannes Berg 	 * from any of them, if only some are enabled we reply
143847086fc5SJohannes Berg 	 * only from the non-enabled ones.
1439af818581SJohannes Berg 	 */
144047086fc5SJohannes Berg 	if (ignore_for_response == BIT(IEEE80211_NUM_ACS) - 1)
144147086fc5SJohannes Berg 		ignore_for_response = 0;
1442af818581SJohannes Berg 
144347086fc5SJohannes Berg 	ieee80211_sta_ps_deliver_response(sta, 1, ignore_for_response,
144447086fc5SJohannes Berg 					  IEEE80211_FRAME_RELEASE_PSPOLL);
1445af818581SJohannes Berg }
144647086fc5SJohannes Berg 
144747086fc5SJohannes Berg void ieee80211_sta_ps_deliver_uapsd(struct sta_info *sta)
144847086fc5SJohannes Berg {
144947086fc5SJohannes Berg 	int n_frames = sta->sta.max_sp;
145047086fc5SJohannes Berg 	u8 delivery_enabled = sta->sta.uapsd_queues;
145147086fc5SJohannes Berg 
145247086fc5SJohannes Berg 	/*
145347086fc5SJohannes Berg 	 * If we ever grow support for TSPEC this might happen if
145447086fc5SJohannes Berg 	 * the TSPEC update from hostapd comes in between a trigger
145547086fc5SJohannes Berg 	 * frame setting WLAN_STA_UAPSD in the RX path and this
145647086fc5SJohannes Berg 	 * actually getting called.
145747086fc5SJohannes Berg 	 */
145847086fc5SJohannes Berg 	if (!delivery_enabled)
145947086fc5SJohannes Berg 		return;
146047086fc5SJohannes Berg 
146147086fc5SJohannes Berg 	switch (sta->sta.max_sp) {
146247086fc5SJohannes Berg 	case 1:
146347086fc5SJohannes Berg 		n_frames = 2;
146447086fc5SJohannes Berg 		break;
146547086fc5SJohannes Berg 	case 2:
146647086fc5SJohannes Berg 		n_frames = 4;
146747086fc5SJohannes Berg 		break;
146847086fc5SJohannes Berg 	case 3:
146947086fc5SJohannes Berg 		n_frames = 6;
147047086fc5SJohannes Berg 		break;
147147086fc5SJohannes Berg 	case 0:
147247086fc5SJohannes Berg 		/* XXX: what is a good value? */
147347086fc5SJohannes Berg 		n_frames = 8;
147447086fc5SJohannes Berg 		break;
147547086fc5SJohannes Berg 	}
147647086fc5SJohannes Berg 
147747086fc5SJohannes Berg 	ieee80211_sta_ps_deliver_response(sta, n_frames, ~delivery_enabled,
147847086fc5SJohannes Berg 					  IEEE80211_FRAME_RELEASE_UAPSD);
1479af818581SJohannes Berg }
1480af818581SJohannes Berg 
1481af818581SJohannes Berg void ieee80211_sta_block_awake(struct ieee80211_hw *hw,
1482af818581SJohannes Berg 			       struct ieee80211_sta *pubsta, bool block)
1483af818581SJohannes Berg {
1484af818581SJohannes Berg 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
1485af818581SJohannes Berg 
1486b5878a2dSJohannes Berg 	trace_api_sta_block_awake(sta->local, pubsta, block);
1487b5878a2dSJohannes Berg 
1488af818581SJohannes Berg 	if (block)
1489c2c98fdeSJohannes Berg 		set_sta_flag(sta, WLAN_STA_PS_DRIVER);
1490c2c98fdeSJohannes Berg 	else if (test_sta_flag(sta, WLAN_STA_PS_DRIVER))
1491af818581SJohannes Berg 		ieee80211_queue_work(hw, &sta->drv_unblock_wk);
1492af818581SJohannes Berg }
1493af818581SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_block_awake);
1494dcf55fb5SFelix Fietkau 
149537fbd908SJohannes Berg void ieee80211_sta_eosp_irqsafe(struct ieee80211_sta *pubsta)
149637fbd908SJohannes Berg {
149737fbd908SJohannes Berg 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
149837fbd908SJohannes Berg 	struct ieee80211_local *local = sta->local;
149937fbd908SJohannes Berg 	struct sk_buff *skb;
150037fbd908SJohannes Berg 	struct skb_eosp_msg_data *data;
150137fbd908SJohannes Berg 
150237fbd908SJohannes Berg 	trace_api_eosp(local, pubsta);
150337fbd908SJohannes Berg 
150437fbd908SJohannes Berg 	skb = alloc_skb(0, GFP_ATOMIC);
150537fbd908SJohannes Berg 	if (!skb) {
150637fbd908SJohannes Berg 		/* too bad ... but race is better than loss */
150737fbd908SJohannes Berg 		clear_sta_flag(sta, WLAN_STA_SP);
150837fbd908SJohannes Berg 		return;
150937fbd908SJohannes Berg 	}
151037fbd908SJohannes Berg 
151137fbd908SJohannes Berg 	data = (void *)skb->cb;
151237fbd908SJohannes Berg 	memcpy(data->sta, pubsta->addr, ETH_ALEN);
151337fbd908SJohannes Berg 	memcpy(data->iface, sta->sdata->vif.addr, ETH_ALEN);
151437fbd908SJohannes Berg 	skb->pkt_type = IEEE80211_EOSP_MSG;
151537fbd908SJohannes Berg 	skb_queue_tail(&local->skb_queue, skb);
151637fbd908SJohannes Berg 	tasklet_schedule(&local->tasklet);
151737fbd908SJohannes Berg }
151837fbd908SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_eosp_irqsafe);
151937fbd908SJohannes Berg 
1520042ec453SJohannes Berg void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta,
1521042ec453SJohannes Berg 				u8 tid, bool buffered)
1522dcf55fb5SFelix Fietkau {
1523dcf55fb5SFelix Fietkau 	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
1524dcf55fb5SFelix Fietkau 
1525948d887dSJohannes Berg 	if (WARN_ON(tid >= STA_TID_NUM))
1526042ec453SJohannes Berg 		return;
1527042ec453SJohannes Berg 
1528948d887dSJohannes Berg 	if (buffered)
1529948d887dSJohannes Berg 		set_bit(tid, &sta->driver_buffered_tids);
1530948d887dSJohannes Berg 	else
1531948d887dSJohannes Berg 		clear_bit(tid, &sta->driver_buffered_tids);
1532948d887dSJohannes Berg 
1533c868cb35SJohannes Berg 	sta_info_recalc_tim(sta);
1534dcf55fb5SFelix Fietkau }
1535042ec453SJohannes Berg EXPORT_SYMBOL(ieee80211_sta_set_buffered);
1536d9a7ddb0SJohannes Berg 
1537d9a7ddb0SJohannes Berg int sta_info_move_state_checked(struct sta_info *sta,
1538d9a7ddb0SJohannes Berg 				enum ieee80211_sta_state new_state)
1539d9a7ddb0SJohannes Berg {
1540*8bf11d8dSJohannes Berg 	might_sleep();
1541d9a7ddb0SJohannes Berg 
1542d9a7ddb0SJohannes Berg 	if (sta->sta_state == new_state)
1543d9a7ddb0SJohannes Berg 		return 0;
1544d9a7ddb0SJohannes Berg 
1545d9a7ddb0SJohannes Berg 	switch (new_state) {
1546d9a7ddb0SJohannes Berg 	case IEEE80211_STA_NONE:
1547d9a7ddb0SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_AUTH)
1548d9a7ddb0SJohannes Berg 			clear_bit(WLAN_STA_AUTH, &sta->_flags);
1549d9a7ddb0SJohannes Berg 		else
1550d9a7ddb0SJohannes Berg 			return -EINVAL;
1551d9a7ddb0SJohannes Berg 		break;
1552d9a7ddb0SJohannes Berg 	case IEEE80211_STA_AUTH:
1553d9a7ddb0SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_NONE)
1554d9a7ddb0SJohannes Berg 			set_bit(WLAN_STA_AUTH, &sta->_flags);
1555d9a7ddb0SJohannes Berg 		else if (sta->sta_state == IEEE80211_STA_ASSOC)
1556d9a7ddb0SJohannes Berg 			clear_bit(WLAN_STA_ASSOC, &sta->_flags);
1557d9a7ddb0SJohannes Berg 		else
1558d9a7ddb0SJohannes Berg 			return -EINVAL;
1559d9a7ddb0SJohannes Berg 		break;
1560d9a7ddb0SJohannes Berg 	case IEEE80211_STA_ASSOC:
156129623892SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_AUTH) {
1562d9a7ddb0SJohannes Berg 			set_bit(WLAN_STA_ASSOC, &sta->_flags);
156329623892SJohannes Berg 		} else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) {
156429623892SJohannes Berg 			if (sta->sdata->vif.type == NL80211_IFTYPE_AP)
156529623892SJohannes Berg 				atomic_dec(&sta->sdata->u.ap.num_sta_authorized);
1566d9a7ddb0SJohannes Berg 			clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
156729623892SJohannes Berg 		} else
1568d9a7ddb0SJohannes Berg 			return -EINVAL;
1569d9a7ddb0SJohannes Berg 		break;
1570d9a7ddb0SJohannes Berg 	case IEEE80211_STA_AUTHORIZED:
157129623892SJohannes Berg 		if (sta->sta_state == IEEE80211_STA_ASSOC) {
157229623892SJohannes Berg 			if (sta->sdata->vif.type == NL80211_IFTYPE_AP)
157329623892SJohannes Berg 				atomic_inc(&sta->sdata->u.ap.num_sta_authorized);
1574d9a7ddb0SJohannes Berg 			set_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
157529623892SJohannes Berg 		} else
1576d9a7ddb0SJohannes Berg 			return -EINVAL;
1577d9a7ddb0SJohannes Berg 		break;
1578d9a7ddb0SJohannes Berg 	default:
1579d9a7ddb0SJohannes Berg 		WARN(1, "invalid state %d", new_state);
1580d9a7ddb0SJohannes Berg 		return -EINVAL;
1581d9a7ddb0SJohannes Berg 	}
1582d9a7ddb0SJohannes Berg 
1583d9a7ddb0SJohannes Berg 	printk(KERN_DEBUG "%s: moving STA %pM to state %d\n",
1584d9a7ddb0SJohannes Berg 		sta->sdata->name, sta->sta.addr, new_state);
1585d9a7ddb0SJohannes Berg 	sta->sta_state = new_state;
1586d9a7ddb0SJohannes Berg 
1587d9a7ddb0SJohannes Berg 	return 0;
1588d9a7ddb0SJohannes Berg }
1589