sta_info.c 57.4 KB
Newer Older
1 2 3
/*
 * Copyright 2002-2005, Instant802 Networks, Inc.
 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
4
 * Copyright 2013-2014  Intel Mobile Communications GmbH
5
 * Copyright (C) 2015 Intel Deutschland GmbH
6 7 8 9 10 11 12 13
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/init.h>
14
#include <linux/etherdevice.h>
15 16 17 18 19
#include <linux/netdevice.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/skbuff.h>
#include <linux/if_arp.h>
20
#include <linux/timer.h>
21
#include <linux/rtnetlink.h>
22 23 24

#include <net/mac80211.h>
#include "ieee80211_i.h"
25
#include "driver-ops.h"
J
Johannes Berg 已提交
26
#include "rate.h"
27
#include "sta_info.h"
J
Jiri Benc 已提交
28
#include "debugfs_sta.h"
29
#include "mesh.h"
30
#include "wme.h"
31

32 33 34 35 36 37 38
/**
 * DOC: STA information lifetime rules
 *
 * STA info structures (&struct sta_info) are managed in a hash table
 * for faster lookup and a list for iteration. They are managed using
 * RCU, i.e. access to the list and hash table is protected by RCU.
 *
39 40 41 42 43 44 45 46
 * Upon allocating a STA info structure with sta_info_alloc(), the caller
 * owns that structure. It must then insert it into the hash table using
 * either sta_info_insert() or sta_info_insert_rcu(); only in the latter
 * case (which acquires an rcu read section but must not be called from
 * within one) will the pointer still be valid after the call. Note that
 * the caller may not do much with the STA info before inserting it, in
 * particular, it may not start any mesh peer link management or add
 * encryption keys.
47 48 49
 *
 * When the insertion fails (sta_info_insert()) returns non-zero), the
 * structure will have been freed by sta_info_insert()!
50
 *
51
 * Station entries are added by mac80211 when you establish a link with a
52 53
 * peer. This means different things for the different type of interfaces
 * we support. For a regular station this mean we add the AP sta when we
L
Lucas De Marchi 已提交
54
 * receive an association response from the AP. For IBSS this occurs when
55
 * get to know about a peer on the same IBSS. For WDS we add the sta for
L
Lucas De Marchi 已提交
56
 * the peer immediately upon device open. When using AP mode we add stations
57
 * for each respective station upon request from userspace through nl80211.
58
 *
59 60
 * In order to remove a STA info structure, various sta_info_destroy_*()
 * calls are available.
61
 *
62 63 64 65
 * There is no concept of ownership on a STA entry, each structure is
 * owned by the global hash table/list until it is removed. All users of
 * the structure need to be RCU protected so that the structure won't be
 * freed before they are done using it.
66
 */
67

68 69
static const struct rhashtable_params sta_rht_params = {
	.nelem_hint = 3, /* start small */
70
	.automatic_shrinking = true,
71
	.head_offset = offsetof(struct sta_info, hash_node),
72
	.key_offset = offsetof(struct sta_info, addr),
73 74
	.key_len = ETH_ALEN,
	.hashfn = sta_addr_hash,
75
	.max_size = CONFIG_MAC80211_STA_HASH_MAX_SIZE,
76 77
};

78
/* Caller must hold local->sta_mtx */
79 80
static int sta_info_hash_del(struct ieee80211_local *local,
			     struct sta_info *sta)
81
{
82 83
	return rhashtable_remove_fast(&local->sta_hash, &sta->hash_node,
				      sta_rht_params);
84 85
}

86
static void __cleanup_single_sta(struct sta_info *sta)
87 88 89 90 91
{
	int ac, i;
	struct tid_ampdu_tx *tid_tx;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
92
	struct ps_data *ps;
93

94
	if (test_sta_flag(sta, WLAN_STA_PS_STA) ||
95 96
	    test_sta_flag(sta, WLAN_STA_PS_DRIVER) ||
	    test_sta_flag(sta, WLAN_STA_PS_DELIVER)) {
97 98 99
		if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
		    sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
			ps = &sdata->bss->ps;
M
Marco Porsch 已提交
100 101
		else if (ieee80211_vif_is_mesh(&sdata->vif))
			ps = &sdata->u.mesh.ps;
102 103
		else
			return;
104 105

		clear_sta_flag(sta, WLAN_STA_PS_STA);
106
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
107
		clear_sta_flag(sta, WLAN_STA_PS_DELIVER);
108

109
		atomic_dec(&ps->num_sta_ps);
110 111
	}

112 113 114 115 116 117 118
	if (sta->sta.txq[0]) {
		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
			struct txq_info *txqi = to_txq_info(sta->sta.txq[i]);
			int n = skb_queue_len(&txqi->queue);

			ieee80211_purge_tx_queue(&local->hw, &txqi->queue);
			atomic_sub(n, &sdata->txqs_len[txqi->txq.ac]);
119
			txqi->byte_cnt = 0;
120 121 122
		}
	}

123 124
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]);
125 126
		ieee80211_purge_tx_queue(&local->hw, &sta->ps_tx_buf[ac]);
		ieee80211_purge_tx_queue(&local->hw, &sta->tx_filtered[ac]);
127 128
	}

129 130
	if (ieee80211_vif_is_mesh(&sdata->vif))
		mesh_sta_cleanup(sta);
131

132
	cancel_work_sync(&sta->drv_deliver_wk);
133 134 135 136 137 138 139

	/*
	 * Destroy aggregation state here. It would be nice to wait for the
	 * driver to finish aggregation stop and then clean up, but for now
	 * drivers have to handle aggregation stop being requested, followed
	 * directly by station destruction.
	 */
140
	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
141
		kfree(sta->ampdu_mlme.tid_start_tx[i]);
142 143 144
		tid_tx = rcu_dereference_raw(sta->ampdu_mlme.tid_tx[i]);
		if (!tid_tx)
			continue;
145
		ieee80211_purge_tx_queue(&local->hw, &tid_tx->pending);
146 147
		kfree(tid_tx);
	}
148
}
149

150 151 152 153 154 155
static void cleanup_single_sta(struct sta_info *sta)
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;

	__cleanup_single_sta(sta);
156 157 158
	sta_info_free(local, sta);
}

159
/* protected by RCU */
160 161
struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
162
{
163
	struct ieee80211_local *local = sdata->local;
164 165 166
	struct sta_info *sta;
	struct rhash_head *tmp;
	const struct bucket_table *tbl;
167

168 169
	rcu_read_lock();
	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);
170

171 172 173 174 175 176 177 178 179 180 181
	for_each_sta_info(local, tbl, addr, sta, tmp) {
		if (sta->sdata == sdata) {
			rcu_read_unlock();
			/* this is safe as the caller must already hold
			 * another rcu read section or the mutex
			 */
			return sta;
		}
	}
	rcu_read_unlock();
	return NULL;
182 183
}

184 185 186 187 188 189 190 191 192
/*
 * Get sta info either from the specified interface
 * or from one of its vlans
 */
struct sta_info *sta_info_get_bss(struct ieee80211_sub_if_data *sdata,
				  const u8 *addr)
{
	struct ieee80211_local *local = sdata->local;
	struct sta_info *sta;
193 194
	struct rhash_head *tmp;
	const struct bucket_table *tbl;
195

196 197 198 199 200 201 202 203 204 205 206 207
	rcu_read_lock();
	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);

	for_each_sta_info(local, tbl, addr, sta, tmp) {
		if (sta->sdata == sdata ||
		    (sta->sdata->bss && sta->sdata->bss == sdata->bss)) {
			rcu_read_unlock();
			/* this is safe as the caller must already hold
			 * another rcu read section or the mutex
			 */
			return sta;
		}
208
	}
209 210
	rcu_read_unlock();
	return NULL;
211 212
}

213 214
struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata,
				     int idx)
215
{
216
	struct ieee80211_local *local = sdata->local;
217 218 219
	struct sta_info *sta;
	int i = 0;

220
	list_for_each_entry_rcu(sta, &local->sta_list, list) {
221
		if (sdata != sta->sdata)
222
			continue;
223 224 225 226
		if (i < idx) {
			++i;
			continue;
		}
227
		return sta;
228 229 230 231
	}

	return NULL;
}
232

233
/**
234
 * sta_info_free - free STA
235
 *
R
Randy Dunlap 已提交
236
 * @local: pointer to the global information
237 238 239
 * @sta: STA info to free
 *
 * This function must undo everything done by sta_info_alloc()
240 241 242
 * that may happen before sta_info_insert(). It may only be
 * called when sta_info_insert() has not been attempted (and
 * if that fails, the station is freed anyway.)
243
 */
244
void sta_info_free(struct ieee80211_local *local, struct sta_info *sta)
245
{
246
	if (sta->rate_ctrl)
247
		rate_control_free_sta(sta);
248

J
Johannes Berg 已提交
249
	sta_dbg(sta->sdata, "Destroyed STA %pM\n", sta->sta.addr);
250

251 252
	if (sta->sta.txq[0])
		kfree(to_txq_info(sta->sta.txq[0]));
253
	kfree(rcu_dereference_raw(sta->sta.rates));
254 255 256
#ifdef CONFIG_MAC80211_MESH
	kfree(sta->mesh);
#endif
257 258 259
	kfree(sta);
}

260
/* Caller must hold local->sta_mtx */
261 262
static void sta_info_hash_add(struct ieee80211_local *local,
			      struct sta_info *sta)
263
{
264 265
	rhashtable_insert_fast(&local->sta_hash, &sta->hash_node,
			       sta_rht_params);
266 267
}

268
static void sta_deliver_ps_frames(struct work_struct *wk)
269 270 271
{
	struct sta_info *sta;

272
	sta = container_of(wk, struct sta_info, drv_deliver_wk);
273 274 275 276

	if (sta->dead)
		return;

277 278
	local_bh_disable();
	if (!test_sta_flag(sta, WLAN_STA_PS_STA))
279
		ieee80211_sta_ps_deliver_wakeup(sta);
280
	else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL))
281
		ieee80211_sta_ps_deliver_poll_response(sta);
282
	else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD))
J
Johannes Berg 已提交
283
		ieee80211_sta_ps_deliver_uapsd(sta);
284
	local_bh_enable();
285 286
}

287 288 289
static int sta_prepare_rate_control(struct ieee80211_local *local,
				    struct sta_info *sta, gfp_t gfp)
{
290
	if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL))
291 292
		return 0;

293
	sta->rate_ctrl = local->rate_ctrl;
294
	sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl,
J
Johannes Berg 已提交
295
						     sta, gfp);
296
	if (!sta->rate_ctrl_priv)
297 298 299 300 301
		return -ENOMEM;

	return 0;
}

J
Johannes Berg 已提交
302
struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata,
303
				const u8 *addr, gfp_t gfp)
304
{
305
	struct ieee80211_local *local = sdata->local;
306
	struct ieee80211_hw *hw = &local->hw;
307
	struct sta_info *sta;
308
	int i;
309

310
	sta = kzalloc(sizeof(*sta) + hw->sta_data_size, gfp);
311
	if (!sta)
J
Johannes Berg 已提交
312
		return NULL;
313

314
	spin_lock_init(&sta->lock);
315
	spin_lock_init(&sta->ps_lock);
316
	INIT_WORK(&sta->drv_deliver_wk, sta_deliver_ps_frames);
J
Johannes Berg 已提交
317
	INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work);
318
	mutex_init(&sta->ampdu_mlme.mtx);
319
#ifdef CONFIG_MAC80211_MESH
320 321 322 323 324 325 326 327 328 329
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
		sta->mesh = kzalloc(sizeof(*sta->mesh), gfp);
		if (!sta->mesh)
			goto free;
		spin_lock_init(&sta->mesh->plink_lock);
		if (ieee80211_vif_is_mesh(&sdata->vif) &&
		    !sdata->u.mesh.user_mpm)
			init_timer(&sta->mesh->plink_timer);
		sta->mesh->nonpeer_pm = NL80211_MESH_POWER_ACTIVE;
	}
330
#endif
331

332
	memcpy(sta->addr, addr, ETH_ALEN);
333
	memcpy(sta->sta.addr, addr, ETH_ALEN);
334 335
	sta->local = local;
	sta->sdata = sdata;
336
	sta->rx_stats.last_rx = jiffies;
337

338 339
	sta->sta_state = IEEE80211_STA_NONE;

340 341 342
	/* Mark TID as unreserved */
	sta->reserved_tid = IEEE80211_TID_UNRESERVED;

A
Arnd Bergmann 已提交
343
	sta->last_connected = ktime_get_seconds();
344 345 346
	ewma_signal_init(&sta->rx_stats.avg_signal);
	for (i = 0; i < ARRAY_SIZE(sta->rx_stats.chain_signal_avg); i++)
		ewma_signal_init(&sta->rx_stats.chain_signal_avg[i]);
347

348 349 350 351 352 353 354 355 356 357 358 359 360 361
	if (local->ops->wake_tx_queue) {
		void *txq_data;
		int size = sizeof(struct txq_info) +
			   ALIGN(hw->txq_data_size, sizeof(void *));

		txq_data = kcalloc(ARRAY_SIZE(sta->sta.txq), size, gfp);
		if (!txq_data)
			goto free;

		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
			struct txq_info *txq = txq_data + i * size;

			ieee80211_init_tx_queue(sdata, sta, txq, i);
		}
362
	}
363

364 365 366
	if (sta_prepare_rate_control(local, sta, gfp))
		goto free_txq;

367
	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
368 369 370 371 372
		/*
		 * timer_to_tid must be initialized with identity mapping
		 * to enable session_timer's data differentiation. See
		 * sta_rx_agg_session_timer_expired for usage.
		 */
373 374
		sta->timer_to_tid[i] = i;
	}
375 376 377 378
	for (i = 0; i < IEEE80211_NUM_ACS; i++) {
		skb_queue_head_init(&sta->ps_tx_buf[i]);
		skb_queue_head_init(&sta->tx_filtered[i]);
	}
J
Johannes Berg 已提交
379

380
	for (i = 0; i < IEEE80211_NUM_TIDS; i++)
381
		sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX);
382

383
	sta->sta.smps_mode = IEEE80211_SMPS_OFF;
384 385 386
	if (sdata->vif.type == NL80211_IFTYPE_AP ||
	    sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
		struct ieee80211_supported_band *sband =
387
			hw->wiphy->bands[ieee80211_get_sdata_band(sdata)];
388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
		u8 smps = (sband->ht_cap.cap & IEEE80211_HT_CAP_SM_PS) >>
				IEEE80211_HT_CAP_SM_PS_SHIFT;
		/*
		 * Assume that hostapd advertises our caps in the beacon and
		 * this is the known_smps_mode for a station that just assciated
		 */
		switch (smps) {
		case WLAN_HT_SMPS_CONTROL_DISABLED:
			sta->known_smps_mode = IEEE80211_SMPS_OFF;
			break;
		case WLAN_HT_SMPS_CONTROL_STATIC:
			sta->known_smps_mode = IEEE80211_SMPS_STATIC;
			break;
		case WLAN_HT_SMPS_CONTROL_DYNAMIC:
			sta->known_smps_mode = IEEE80211_SMPS_DYNAMIC;
			break;
		default:
			WARN_ON(1);
		}
	}
408

J
Johannes Berg 已提交
409
	sta_dbg(sdata, "Allocated STA %pM\n", sta->sta.addr);
410

411
	return sta;
412 413 414 415 416

free_txq:
	if (sta->sta.txq[0])
		kfree(to_txq_info(sta->sta.txq[0]));
free:
417 418 419
#ifdef CONFIG_MAC80211_MESH
	kfree(sta->mesh);
#endif
420 421
	kfree(sta);
	return NULL;
J
Johannes Berg 已提交
422 423
}

424
static int sta_info_insert_check(struct sta_info *sta)
425 426 427
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;

428 429 430 431 432
	/*
	 * Can't be a WARN_ON because it can be triggered through a race:
	 * something inserts a STA (on one CPU) without holding the RTNL
	 * and another CPU turns off the net device.
	 */
433 434
	if (unlikely(!ieee80211_sdata_running(sdata)))
		return -ENETDOWN;
435

436
	if (WARN_ON(ether_addr_equal(sta->sta.addr, sdata->vif.addr) ||
437 438 439
		    is_multicast_ether_addr(sta->sta.addr)))
		return -EINVAL;

440 441 442 443 444 445 446 447 448 449 450 451 452
	/* Strictly speaking this isn't necessary as we hold the mutex, but
	 * the rhashtable code can't really deal with that distinction. We
	 * do require the mutex for correctness though.
	 */
	rcu_read_lock();
	lockdep_assert_held(&sdata->local->sta_mtx);
	if (ieee80211_hw_check(&sdata->local->hw, NEEDS_UNIQUE_STA_ADDR) &&
	    ieee80211_find_sta_by_ifaddr(&sdata->local->hw, sta->addr, NULL)) {
		rcu_read_unlock();
		return -ENOTUNIQ;
	}
	rcu_read_unlock();

453 454 455
	return 0;
}

J
Johannes Berg 已提交
456 457 458 459 460 461 462 463 464 465 466 467 468 469
static int sta_info_insert_drv_state(struct ieee80211_local *local,
				     struct ieee80211_sub_if_data *sdata,
				     struct sta_info *sta)
{
	enum ieee80211_sta_state state;
	int err = 0;

	for (state = IEEE80211_STA_NOTEXIST; state < sta->sta_state; state++) {
		err = drv_sta_state(local, sdata, sta, state, state + 1);
		if (err)
			break;
	}

	if (!err) {
470 471 472 473 474 475
		/*
		 * Drivers using legacy sta_add/sta_remove callbacks only
		 * get uploaded set to true after sta_add is called.
		 */
		if (!local->ops->sta_add)
			sta->uploaded = true;
J
Johannes Berg 已提交
476 477 478 479
		return 0;
	}

	if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
J
Johannes Berg 已提交
480 481 482
		sdata_info(sdata,
			   "failed to move IBSS STA %pM to state %d (%d) - keeping it anyway\n",
			   sta->sta.addr, state + 1, err);
J
Johannes Berg 已提交
483 484 485 486 487 488 489 490 491 492
		err = 0;
	}

	/* unwind on error */
	for (; state > IEEE80211_STA_NOTEXIST; state--)
		WARN_ON(drv_sta_state(local, sdata, sta, state, state - 1));

	return err;
}

493 494 495 496 497
/*
 * should be called with sta_mtx locked
 * this function replaces the mutex lock
 * with a RCU lock
 */
498
static int sta_info_insert_finish(struct sta_info *sta) __acquires(RCU)
499 500 501
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
502
	struct station_info *sinfo;
503 504 505
	int err = 0;

	lockdep_assert_held(&local->sta_mtx);
506

507 508 509 510 511 512
	sinfo = kzalloc(sizeof(struct station_info), GFP_KERNEL);
	if (!sinfo) {
		err = -ENOMEM;
		goto out_err;
	}

513 514 515 516
	/* check if STA exists already */
	if (sta_info_get_bss(sdata, sta->sta.addr)) {
		err = -EEXIST;
		goto out_err;
517
	}
518

519 520 521
	local->num_sta++;
	local->sta_generation++;
	smp_mb();
522

523 524 525
	/* simplify things and don't accept BA sessions yet */
	set_sta_flag(sta, WLAN_STA_BLOCK_BA);

526 527
	/* make the station visible */
	sta_info_hash_add(local, sta);
528

529
	list_add_tail_rcu(&sta->list, &local->sta_list);
530

531 532 533 534 535
	/* notify driver */
	err = sta_info_insert_drv_state(local, sdata, sta);
	if (err)
		goto out_remove;

536
	set_sta_flag(sta, WLAN_STA_INSERTED);
537 538
	/* accept BA sessions now */
	clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
539

540 541
	ieee80211_sta_debugfs_add(sta);
	rate_control_add_sta_debugfs(sta);
542

543 544 545
	sinfo->generation = local->sta_generation;
	cfg80211_new_sta(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL);
	kfree(sinfo);
546

J
Johannes Berg 已提交
547
	sta_dbg(sdata, "Inserted STA %pM\n", sta->sta.addr);
548

549 550 551
	/* move reference to rcu-protected */
	rcu_read_lock();
	mutex_unlock(&local->sta_mtx);
J
Jiri Benc 已提交
552

J
Johannes Berg 已提交
553 554 555
	if (ieee80211_vif_is_mesh(&sdata->vif))
		mesh_accept_plinks_update(sdata);

556
	return 0;
557 558 559 560 561 562
 out_remove:
	sta_info_hash_del(local, sta);
	list_del_rcu(&sta->list);
	local->num_sta--;
	synchronize_net();
	__cleanup_single_sta(sta);
563 564
 out_err:
	mutex_unlock(&local->sta_mtx);
S
Sudip Mukherjee 已提交
565
	kfree(sinfo);
566 567
	rcu_read_lock();
	return err;
568 569 570 571 572
}

int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU)
{
	struct ieee80211_local *local = sta->local;
573
	int err;
574

575 576
	might_sleep();

577 578
	mutex_lock(&local->sta_mtx);

579 580
	err = sta_info_insert_check(sta);
	if (err) {
581
		mutex_unlock(&local->sta_mtx);
582 583 584 585
		rcu_read_lock();
		goto out_free;
	}

586
	err = sta_info_insert_finish(sta);
587 588 589
	if (err)
		goto out_free;

J
Johannes Berg 已提交
590
	return 0;
591
 out_free:
592
	sta_info_free(local, sta);
593
	return err;
594 595
}

596 597 598 599 600 601 602 603 604
int sta_info_insert(struct sta_info *sta)
{
	int err = sta_info_insert_rcu(sta);

	rcu_read_unlock();

	return err;
}

605
static inline void __bss_tim_set(u8 *tim, u16 id)
606 607 608 609 610
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the __set_bit() format.
	 */
611
	tim[id / 8] |= (1 << (id % 8));
612 613
}

614
static inline void __bss_tim_clear(u8 *tim, u16 id)
615 616 617 618 619
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the __clear_bit() format.
	 */
620
	tim[id / 8] &= ~(1 << (id % 8));
621 622
}

623 624 625 626 627 628 629 630 631
static inline bool __bss_tim_get(u8 *tim, u16 id)
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the test_bit() format.
	 */
	return tim[id / 8] & (1 << (id % 8));
}

632
static unsigned long ieee80211_tids_for_ac(int ac)
633
{
634 635 636 637 638 639 640 641 642 643 644 645 646
	/* If we ever support TIDs > 7, this obviously needs to be adjusted */
	switch (ac) {
	case IEEE80211_AC_VO:
		return BIT(6) | BIT(7);
	case IEEE80211_AC_VI:
		return BIT(4) | BIT(5);
	case IEEE80211_AC_BE:
		return BIT(0) | BIT(3);
	case IEEE80211_AC_BK:
		return BIT(1) | BIT(2);
	default:
		WARN_ON(1);
		return 0;
647
	}
648 649
}

650
static void __sta_info_recalc_tim(struct sta_info *sta, bool ignore_pending)
651
{
J
Johannes Berg 已提交
652
	struct ieee80211_local *local = sta->local;
653
	struct ps_data *ps;
654 655 656
	bool indicate_tim = false;
	u8 ignore_for_tim = sta->sta.uapsd_queues;
	int ac;
657
	u16 id = sta->sta.aid;
658 659 660 661 662

	if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
	    sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
		if (WARN_ON_ONCE(!sta->sdata->bss))
			return;
663

664
		ps = &sta->sdata->bss->ps;
M
Marco Porsch 已提交
665 666 667 668
#ifdef CONFIG_MAC80211_MESH
	} else if (ieee80211_vif_is_mesh(&sta->sdata->vif)) {
		ps = &sta->sdata->u.mesh.ps;
#endif
669
	} else {
J
Johannes Berg 已提交
670
		return;
671
	}
672

J
Johannes Berg 已提交
673
	/* No need to do anything if the driver does all */
674
	if (ieee80211_hw_check(&local->hw, AP_LINK_PS))
J
Johannes Berg 已提交
675
		return;
676

J
Johannes Berg 已提交
677 678
	if (sta->dead)
		goto done;
679

680 681 682 683 684 685 686 687 688
	/*
	 * If all ACs are delivery-enabled then we should build
	 * the TIM bit for all ACs anyway; if only some are then
	 * we ignore those and build the TIM bit using only the
	 * non-enabled ones.
	 */
	if (ignore_for_tim == BIT(IEEE80211_NUM_ACS) - 1)
		ignore_for_tim = 0;

689 690 691
	if (ignore_pending)
		ignore_for_tim = BIT(IEEE80211_NUM_ACS) - 1;

692 693
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		unsigned long tids;
694

695 696 697 698 699 700 701
		if (ignore_for_tim & BIT(ac))
			continue;

		indicate_tim |= !skb_queue_empty(&sta->tx_filtered[ac]) ||
				!skb_queue_empty(&sta->ps_tx_buf[ac]);
		if (indicate_tim)
			break;
702

703 704 705 706
		tids = ieee80211_tids_for_ac(ac);

		indicate_tim |=
			sta->driver_buffered_tids & tids;
707 708
		indicate_tim |=
			sta->txq_buffered_tids & tids;
709
	}
710

J
Johannes Berg 已提交
711
 done:
712
	spin_lock_bh(&local->tim_lock);
713

714 715 716
	if (indicate_tim == __bss_tim_get(ps->tim, id))
		goto out_unlock;

717
	if (indicate_tim)
718
		__bss_tim_set(ps->tim, id);
J
Johannes Berg 已提交
719
	else
720
		__bss_tim_clear(ps->tim, id);
721

722
	if (local->ops->set_tim && !WARN_ON(sta->dead)) {
J
Johannes Berg 已提交
723
		local->tim_in_locked_section = true;
724
		drv_set_tim(local, &sta->sta, indicate_tim);
J
Johannes Berg 已提交
725 726
		local->tim_in_locked_section = false;
	}
727

728
out_unlock:
729
	spin_unlock_bh(&local->tim_lock);
730 731
}

732 733 734 735 736
void sta_info_recalc_tim(struct sta_info *sta)
{
	__sta_info_recalc_tim(sta, false);
}

737
static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb)
738
{
739
	struct ieee80211_tx_info *info;
740 741 742
	int timeout;

	if (!skb)
743
		return false;
744

745
	info = IEEE80211_SKB_CB(skb);
746 747

	/* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */
748 749 750
	timeout = (sta->listen_interval *
		   sta->sdata->vif.bss_conf.beacon_int *
		   32 / 15625) * HZ;
751 752
	if (timeout < STA_TX_BUFFER_EXPIRE)
		timeout = STA_TX_BUFFER_EXPIRE;
753
	return time_after(jiffies, info->control.jiffies + timeout);
754 755 756
}


757 758
static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local,
						struct sta_info *sta, int ac)
759 760 761 762
{
	unsigned long flags;
	struct sk_buff *skb;

763 764 765 766 767 768 769 770
	/*
	 * First check for frames that should expire on the filtered
	 * queue. Frames here were rejected by the driver and are on
	 * a separate queue to avoid reordering with normal PS-buffered
	 * frames. They also aren't accounted for right now in the
	 * total_ps_buffered counter.
	 */
	for (;;) {
771 772
		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
		skb = skb_peek(&sta->tx_filtered[ac]);
773
		if (sta_info_buffer_expired(sta, skb))
774
			skb = __skb_dequeue(&sta->tx_filtered[ac]);
775 776
		else
			skb = NULL;
777
		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
778 779 780 781 782 783 784 785 786

		/*
		 * Frames are queued in order, so if this one
		 * hasn't expired yet we can stop testing. If
		 * we actually reached the end of the queue we
		 * also need to stop, of course.
		 */
		if (!skb)
			break;
787
		ieee80211_free_txskb(&local->hw, skb);
788 789 790 791 792 793 794 795
	}

	/*
	 * Now also check the normal PS-buffered queue, this will
	 * only find something if the filtered queue was emptied
	 * since the filtered frames are all before the normal PS
	 * buffered frames.
	 */
796
	for (;;) {
797 798
		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
		skb = skb_peek(&sta->ps_tx_buf[ac]);
799
		if (sta_info_buffer_expired(sta, skb))
800
			skb = __skb_dequeue(&sta->ps_tx_buf[ac]);
801
		else
802
			skb = NULL;
803
		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
804

805 806 807 808 809
		/*
		 * frames are queued in order, so if this one
		 * hasn't expired yet (or we reached the end of
		 * the queue) we can stop testing
		 */
810
		if (!skb)
811
			break;
812 813

		local->total_ps_buffered--;
J
Johannes Berg 已提交
814 815
		ps_dbg(sta->sdata, "Buffered frame expired (STA %pM)\n",
		       sta->sta.addr);
816
		ieee80211_free_txskb(&local->hw, skb);
817
	}
818

819 820 821 822 823 824 825 826 827 828 829 830
	/*
	 * Finally, recalculate the TIM bit for this station -- it might
	 * now be clear because the station was too slow to retrieve its
	 * frames.
	 */
	sta_info_recalc_tim(sta);

	/*
	 * Return whether there are any frames still buffered, this is
	 * used to check whether the cleanup timer still needs to run,
	 * if there are no frames we don't need to rearm the timer.
	 */
831 832 833 834 835 836 837 838 839 840
	return !(skb_queue_empty(&sta->ps_tx_buf[ac]) &&
		 skb_queue_empty(&sta->tx_filtered[ac]));
}

static bool sta_info_cleanup_expire_buffered(struct ieee80211_local *local,
					     struct sta_info *sta)
{
	bool have_buffered = false;
	int ac;

M
Marco Porsch 已提交
841 842 843
	/* This is only necessary for stations on BSS/MBSS interfaces */
	if (!sta->sdata->bss &&
	    !ieee80211_vif_is_mesh(&sta->sdata->vif))
844 845 846 847 848 849 850
		return false;

	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
		have_buffered |=
			sta_info_cleanup_expire_buffered_ac(local, sta, ac);

	return have_buffered;
851 852
}

853
static int __must_check __sta_info_destroy_part1(struct sta_info *sta)
854
{
855 856
	struct ieee80211_local *local;
	struct ieee80211_sub_if_data *sdata;
857
	int ret;
858

859
	might_sleep();
860

861 862
	if (!sta)
		return -ENOENT;
863

864 865
	local = sta->local;
	sdata = sta->sdata;
866

867 868
	lockdep_assert_held(&local->sta_mtx);

869 870 871 872 873 874
	/*
	 * Before removing the station from the driver and
	 * rate control, it might still start new aggregation
	 * sessions -- block that to make sure the tear-down
	 * will be sufficient.
	 */
J
Johannes Berg 已提交
875
	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
876
	ieee80211_sta_tear_down_BA_sessions(sta, AGG_STOP_DESTROY_STA);
877

878
	ret = sta_info_hash_del(local, sta);
879
	if (WARN_ON(ret))
880 881
		return ret;

882 883 884 885 886 887 888 889 890
	/*
	 * for TDLS peers, make sure to return to the base channel before
	 * removal.
	 */
	if (test_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL)) {
		drv_tdls_cancel_channel_switch(local, sdata, &sta->sta);
		clear_sta_flag(sta, WLAN_STA_TDLS_OFF_CHANNEL);
	}

891
	list_del_rcu(&sta->list);
892
	sta->removed = true;
893

894 895
	drv_sta_pre_rcu_remove(local, sta->sdata, sta);

896 897 898 899
	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
	    rcu_access_pointer(sdata->u.vlan.sta) == sta)
		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);

900 901 902 903 904 905 906
	return 0;
}

static void __sta_info_destroy_part2(struct sta_info *sta)
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
907
	struct station_info *sinfo;
908 909 910 911 912 913 914 915 916 917
	int ret;

	/*
	 * NOTE: This assumes at least synchronize_net() was done
	 *	 after _part1 and before _part2!
	 */

	might_sleep();
	lockdep_assert_held(&local->sta_mtx);

918
	/* now keys can no longer be reached */
919
	ieee80211_free_sta_keys(local, sta);
920

921 922 923
	/* disable TIM bit - last chance to tell driver */
	__sta_info_recalc_tim(sta, true);

924 925 926 927 928
	sta->dead = true;

	local->num_sta--;
	local->sta_generation++;

929
	while (sta->sta_state > IEEE80211_STA_NONE) {
J
Johannes Berg 已提交
930 931
		ret = sta_info_move_state(sta, sta->sta_state - 1);
		if (ret) {
932 933 934 935
			WARN_ON_ONCE(1);
			break;
		}
	}
936

J
Johannes Berg 已提交
937 938 939 940 941
	if (sta->uploaded) {
		ret = drv_sta_state(local, sdata, sta, IEEE80211_STA_NONE,
				    IEEE80211_STA_NOTEXIST);
		WARN_ON_ONCE(ret != 0);
	}
942

J
Johannes Berg 已提交
943 944
	sta_dbg(sdata, "Removed STA %pM\n", sta->sta.addr);

945 946 947 948 949
	sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
	if (sinfo)
		sta_set_sinfo(sta, sinfo);
	cfg80211_del_sta_sinfo(sdata->dev, sta->sta.addr, sinfo, GFP_KERNEL);
	kfree(sinfo);
950

951 952 953
	rate_control_remove_sta_debugfs(sta);
	ieee80211_sta_debugfs_remove(sta);

954
	cleanup_single_sta(sta);
955 956 957 958 959 960 961 962 963 964 965 966
}

int __must_check __sta_info_destroy(struct sta_info *sta)
{
	int err = __sta_info_destroy_part1(sta);

	if (err)
		return err;

	synchronize_net();

	__sta_info_destroy_part2(sta);
967 968

	return 0;
J
Jiri Slaby 已提交
969 970
}

971
int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr)
J
Jiri Slaby 已提交
972
{
973 974
	struct sta_info *sta;
	int ret;
J
Jiri Slaby 已提交
975

976
	mutex_lock(&sdata->local->sta_mtx);
977
	sta = sta_info_get(sdata, addr);
978 979
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
J
Jiri Slaby 已提交
980 981 982 983

	return ret;
}

984 985
int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
J
Jiri Benc 已提交
986
{
987 988
	struct sta_info *sta;
	int ret;
J
Jiri Benc 已提交
989

990
	mutex_lock(&sdata->local->sta_mtx);
991
	sta = sta_info_get_bss(sdata, addr);
992 993
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
994

995 996
	return ret;
}
J
Jiri Benc 已提交
997

998 999 1000 1001
static void sta_info_cleanup(unsigned long data)
{
	struct ieee80211_local *local = (struct ieee80211_local *) data;
	struct sta_info *sta;
1002
	bool timer_needed = false;
1003 1004 1005

	rcu_read_lock();
	list_for_each_entry_rcu(sta, &local->sta_list, list)
1006 1007
		if (sta_info_cleanup_expire_buffered(local, sta))
			timer_needed = true;
1008
	rcu_read_unlock();
J
Jiri Benc 已提交
1009

1010 1011
	if (local->quiescing)
		return;
1012

1013 1014 1015
	if (!timer_needed)
		return;

1016 1017
	mod_timer(&local->sta_cleanup,
		  round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL));
J
Jiri Benc 已提交
1018 1019
}

1020
u32 sta_addr_hash(const void *key, u32 length, u32 seed)
1021
{
1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032
	return jhash(key, ETH_ALEN, seed);
}

int sta_info_init(struct ieee80211_local *local)
{
	int err;

	err = rhashtable_init(&local->sta_hash, &sta_rht_params);
	if (err)
		return err;

1033
	spin_lock_init(&local->tim_lock);
1034
	mutex_init(&local->sta_mtx);
1035 1036
	INIT_LIST_HEAD(&local->sta_list);

1037 1038
	setup_timer(&local->sta_cleanup, sta_info_cleanup,
		    (unsigned long)local);
1039
	return 0;
1040 1041 1042 1043
}

void sta_info_stop(struct ieee80211_local *local)
{
1044
	del_timer_sync(&local->sta_cleanup);
1045
	rhashtable_destroy(&local->sta_hash);
1046 1047
}

1048

1049
int __sta_info_flush(struct ieee80211_sub_if_data *sdata, bool vlans)
1050
{
1051
	struct ieee80211_local *local = sdata->local;
1052
	struct sta_info *sta, *tmp;
1053
	LIST_HEAD(free_list);
1054
	int ret = 0;
1055

1056
	might_sleep();
1057

1058 1059 1060
	WARN_ON(vlans && sdata->vif.type != NL80211_IFTYPE_AP);
	WARN_ON(vlans && !sdata->bss);

1061
	mutex_lock(&local->sta_mtx);
1062
	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1063 1064
		if (sdata == sta->sdata ||
		    (vlans && sdata->bss == sta->sdata->bss)) {
1065 1066
			if (!WARN_ON(__sta_info_destroy_part1(sta)))
				list_add(&sta->free_list, &free_list);
1067 1068
			ret++;
		}
1069
	}
1070 1071 1072 1073 1074 1075

	if (!list_empty(&free_list)) {
		synchronize_net();
		list_for_each_entry_safe(sta, tmp, &free_list, free_list)
			__sta_info_destroy_part2(sta);
	}
1076
	mutex_unlock(&local->sta_mtx);
1077

1078 1079 1080
	return ret;
}

1081 1082 1083 1084 1085 1086
void ieee80211_sta_expire(struct ieee80211_sub_if_data *sdata,
			  unsigned long exp_time)
{
	struct ieee80211_local *local = sdata->local;
	struct sta_info *sta, *tmp;

1087
	mutex_lock(&local->sta_mtx);
1088 1089

	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1090 1091 1092
		if (sdata != sta->sdata)
			continue;

1093
		if (time_after(jiffies, sta->rx_stats.last_rx + exp_time)) {
1094 1095
			sta_dbg(sta->sdata, "expiring inactive STA %pM\n",
				sta->sta.addr);
M
Marco Porsch 已提交
1096 1097 1098 1099 1100

			if (ieee80211_vif_is_mesh(&sdata->vif) &&
			    test_sta_flag(sta, WLAN_STA_PS_STA))
				atomic_dec(&sdata->u.mesh.ps.num_sta_ps);

1101
			WARN_ON(__sta_info_destroy(sta));
1102
		}
1103 1104
	}

1105
	mutex_unlock(&local->sta_mtx);
1106
}
1107

1108
struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
1109 1110
						   const u8 *addr,
						   const u8 *localaddr)
1111
{
1112 1113 1114 1115 1116 1117
	struct ieee80211_local *local = hw_to_local(hw);
	struct sta_info *sta;
	struct rhash_head *tmp;
	const struct bucket_table *tbl;

	tbl = rht_dereference_rcu(local->sta_hash.tbl, &local->sta_hash);
1118

1119 1120 1121 1122
	/*
	 * Just return a random station if localaddr is NULL
	 * ... first in list.
	 */
1123
	for_each_sta_info(local, tbl, addr, sta, tmp) {
1124
		if (localaddr &&
1125
		    !ether_addr_equal(sta->sdata->vif.addr, localaddr))
1126
			continue;
1127 1128
		if (!sta->uploaded)
			return NULL;
1129
		return &sta->sta;
1130 1131
	}

1132
	return NULL;
1133
}
1134
EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
1135 1136 1137 1138

struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif,
					 const u8 *addr)
{
1139
	struct sta_info *sta;
1140 1141 1142 1143

	if (!vif)
		return NULL;

1144 1145 1146 1147 1148 1149
	sta = sta_info_get_bss(vif_to_sdata(vif), addr);
	if (!sta)
		return NULL;

	if (!sta->uploaded)
		return NULL;
1150

1151
	return &sta->sta;
1152
}
1153
EXPORT_SYMBOL(ieee80211_find_sta);
1154

1155 1156
/* powersave support code */
void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta)
1157
{
1158
	struct ieee80211_sub_if_data *sdata = sta->sdata;
1159 1160
	struct ieee80211_local *local = sdata->local;
	struct sk_buff_head pending;
1161
	int filtered = 0, buffered = 0, ac, i;
1162
	unsigned long flags;
1163 1164
	struct ps_data *ps;

1165 1166 1167 1168 1169
	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
		sdata = container_of(sdata->bss, struct ieee80211_sub_if_data,
				     u.ap);

	if (sdata->vif.type == NL80211_IFTYPE_AP)
1170
		ps = &sdata->bss->ps;
M
Marco Porsch 已提交
1171 1172
	else if (ieee80211_vif_is_mesh(&sdata->vif))
		ps = &sdata->u.mesh.ps;
1173 1174
	else
		return;
1175

J
Johannes Berg 已提交
1176
	clear_sta_flag(sta, WLAN_STA_SP);
J
Johannes Berg 已提交
1177

1178
	BUILD_BUG_ON(BITS_TO_LONGS(IEEE80211_NUM_TIDS) > 1);
1179
	sta->driver_buffered_tids = 0;
1180
	sta->txq_buffered_tids = 0;
1181

1182
	if (!ieee80211_hw_check(&local->hw, AP_LINK_PS))
1183
		drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta);
1184

1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
	if (sta->sta.txq[0]) {
		for (i = 0; i < ARRAY_SIZE(sta->sta.txq); i++) {
			struct txq_info *txqi = to_txq_info(sta->sta.txq[i]);

			if (!skb_queue_len(&txqi->queue))
				continue;

			drv_wake_tx_queue(local, txqi);
		}
	}

1196
	skb_queue_head_init(&pending);
1197

1198 1199
	/* sync with ieee80211_tx_h_unicast_ps_buf */
	spin_lock(&sta->ps_lock);
1200
	/* Send all buffered frames to the station */
1201 1202 1203
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		int count = skb_queue_len(&pending), tmp;

1204
		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
1205
		skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending);
1206
		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
1207 1208 1209 1210
		tmp = skb_queue_len(&pending);
		filtered += tmp - count;
		count = tmp;

1211
		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
1212
		skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending);
1213
		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
1214 1215 1216 1217
		tmp = skb_queue_len(&pending);
		buffered += tmp - count;
	}

1218
	ieee80211_add_pending_skbs(local, &pending);
1219 1220 1221 1222 1223 1224 1225 1226 1227

	/* now we're no longer in the deliver code */
	clear_sta_flag(sta, WLAN_STA_PS_DELIVER);

	/* The station might have polled and then woken up before we responded,
	 * so clear these flags now to avoid them sticking around.
	 */
	clear_sta_flag(sta, WLAN_STA_PSPOLL);
	clear_sta_flag(sta, WLAN_STA_UAPSD);
1228
	spin_unlock(&sta->ps_lock);
1229

1230 1231
	atomic_dec(&ps->num_sta_ps);

1232
	/* This station just woke up and isn't aware of our SMPS state */
1233 1234
	if (!ieee80211_vif_is_mesh(&sdata->vif) &&
	    !ieee80211_smps_is_restrictive(sta->known_smps_mode,
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
					   sdata->smps_mode) &&
	    sta->known_smps_mode != sdata->bss->req_smps &&
	    sta_info_tx_streams(sta) != 1) {
		ht_dbg(sdata,
		       "%pM just woke up and MIMO capable - update SMPS\n",
		       sta->sta.addr);
		ieee80211_send_smps_action(sdata, sdata->bss->req_smps,
					   sta->sta.addr,
					   sdata->vif.bss_conf.bssid);
	}

1246 1247
	local->total_ps_buffered -= buffered;

J
Johannes Berg 已提交
1248 1249
	sta_info_recalc_tim(sta);

J
Johannes Berg 已提交
1250 1251 1252
	ps_dbg(sdata,
	       "STA %pM aid %d sending %d filtered/%d PS frames since STA not sleeping anymore\n",
	       sta->sta.addr, sta->sta.aid, filtered, buffered);
J
Johannes Berg 已提交
1253 1254

	ieee80211_check_fast_xmit(sta);
1255 1256
}

1257
static void ieee80211_send_null_response(struct sta_info *sta, int tid,
1258
					 enum ieee80211_frame_release_type reason,
1259
					 bool call_driver, bool more_data)
1260
{
1261
	struct ieee80211_sub_if_data *sdata = sta->sdata;
1262
	struct ieee80211_local *local = sdata->local;
1263
	struct ieee80211_qos_hdr *nullfunc;
1264
	struct sk_buff *skb;
1265 1266
	int size = sizeof(*nullfunc);
	__le16 fc;
1267
	bool qos = sta->sta.wme;
1268
	struct ieee80211_tx_info *info;
J
Johannes Berg 已提交
1269
	struct ieee80211_chanctx_conf *chanctx_conf;
1270

1271 1272 1273 1274 1275 1276 1277 1278 1279
	if (qos) {
		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
				 IEEE80211_STYPE_QOS_NULLFUNC |
				 IEEE80211_FCTL_FROMDS);
	} else {
		size -= 2;
		fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
				 IEEE80211_STYPE_NULLFUNC |
				 IEEE80211_FCTL_FROMDS);
1280 1281
	}

1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293
	skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
	if (!skb)
		return;

	skb_reserve(skb, local->hw.extra_tx_headroom);

	nullfunc = (void *) skb_put(skb, size);
	nullfunc->frame_control = fc;
	nullfunc->duration_id = 0;
	memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
	memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
	memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
1294
	nullfunc->seq_ctrl = 0;
1295

1296 1297
	skb->priority = tid;
	skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]);
1298 1299 1300
	if (qos) {
		nullfunc->qos_ctrl = cpu_to_le16(tid);

1301
		if (reason == IEEE80211_FRAME_RELEASE_UAPSD) {
1302 1303
			nullfunc->qos_ctrl |=
				cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
1304 1305 1306 1307
			if (more_data)
				nullfunc->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
		}
1308 1309 1310 1311 1312 1313 1314
	}

	info = IEEE80211_SKB_CB(skb);

	/*
	 * Tell TX path to send this frame even though the
	 * STA may still remain is PS mode after this frame
1315 1316
	 * exchange. Also set EOSP to indicate this packet
	 * ends the poll/service period.
1317
	 */
1318
	info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER |
1319 1320
		       IEEE80211_TX_STATUS_EOSP |
		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1321

1322 1323
	info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;

1324 1325 1326
	if (call_driver)
		drv_allow_buffered_frames(local, sta, BIT(tid), 1,
					  reason, false);
1327

1328 1329
	skb->dev = sdata->dev;

J
Johannes Berg 已提交
1330 1331 1332 1333 1334 1335 1336 1337
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (WARN_ON(!chanctx_conf)) {
		rcu_read_unlock();
		kfree_skb(skb);
		return;
	}

1338
	info->band = chanctx_conf->def.chan->band;
1339
	ieee80211_xmit(sdata, sta, skb);
J
Johannes Berg 已提交
1340
	rcu_read_unlock();
1341 1342
}

1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353
static int find_highest_prio_tid(unsigned long tids)
{
	/* lower 3 TIDs aren't ordered perfectly */
	if (tids & 0xF8)
		return fls(tids) - 1;
	/* TID 0 is BE just like TID 3 */
	if (tids & BIT(0))
		return 0;
	return fls(tids) - 1;
}

1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
/* Indicates if the MORE_DATA bit should be set in the last
 * frame obtained by ieee80211_sta_ps_get_frames.
 * Note that driver_release_tids is relevant only if
 * reason = IEEE80211_FRAME_RELEASE_PSPOLL
 */
static bool
ieee80211_sta_ps_more_data(struct sta_info *sta, u8 ignored_acs,
			   enum ieee80211_frame_release_type reason,
			   unsigned long driver_release_tids)
{
	int ac;

	/* If the driver has data on more than one TID then
	 * certainly there's more data if we release just a
	 * single frame now (from a single TID). This will
	 * only happen for PS-Poll.
	 */
	if (reason == IEEE80211_FRAME_RELEASE_PSPOLL &&
	    hweight16(driver_release_tids) > 1)
		return true;

	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		if (ignored_acs & BIT(ac))
			continue;

		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
		    !skb_queue_empty(&sta->ps_tx_buf[ac]))
			return true;
	}

	return false;
}

J
Johannes Berg 已提交
1387
static void
1388 1389 1390 1391
ieee80211_sta_ps_get_frames(struct sta_info *sta, int n_frames, u8 ignored_acs,
			    enum ieee80211_frame_release_type reason,
			    struct sk_buff_head *frames,
			    unsigned long *driver_release_tids)
1392 1393 1394
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1395 1396
	int ac;

1397
	/* Get response frame(s) and more data bit for the last one. */
1398
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1399 1400
		unsigned long tids;

J
Johannes Berg 已提交
1401
		if (ignored_acs & BIT(ac))
1402 1403
			continue;

1404 1405
		tids = ieee80211_tids_for_ac(ac);

1406 1407 1408
		/* if we already have frames from software, then we can't also
		 * release from hardware queues
		 */
1409 1410 1411 1412
		if (skb_queue_empty(frames)) {
			*driver_release_tids |=
				sta->driver_buffered_tids & tids;
			*driver_release_tids |= sta->txq_buffered_tids & tids;
1413
		}
1414

1415
		if (!*driver_release_tids) {
1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428
			struct sk_buff *skb;

			while (n_frames > 0) {
				skb = skb_dequeue(&sta->tx_filtered[ac]);
				if (!skb) {
					skb = skb_dequeue(
						&sta->ps_tx_buf[ac]);
					if (skb)
						local->total_ps_buffered--;
				}
				if (!skb)
					break;
				n_frames--;
1429
				__skb_queue_tail(frames, skb);
1430
			}
1431
		}
1432

1433 1434 1435
		/* If we have more frames buffered on this AC, then abort the
		 * loop since we can't send more data from other ACs before
		 * the buffered frames from this.
1436
		 */
1437
		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
1438
		    !skb_queue_empty(&sta->ps_tx_buf[ac]))
1439
			break;
1440
	}
1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463
}

static void
ieee80211_sta_ps_deliver_response(struct sta_info *sta,
				  int n_frames, u8 ignored_acs,
				  enum ieee80211_frame_release_type reason)
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
	unsigned long driver_release_tids = 0;
	struct sk_buff_head frames;
	bool more_data;

	/* Service or PS-Poll period starts */
	set_sta_flag(sta, WLAN_STA_SP);

	__skb_queue_head_init(&frames);

	ieee80211_sta_ps_get_frames(sta, n_frames, ignored_acs, reason,
				    &frames, &driver_release_tids);

	more_data = ieee80211_sta_ps_more_data(sta, ignored_acs, reason, driver_release_tids);

1464
	if (driver_release_tids && reason == IEEE80211_FRAME_RELEASE_PSPOLL)
1465 1466
		driver_release_tids =
			BIT(find_highest_prio_tid(driver_release_tids));
1467

1468
	if (skb_queue_empty(&frames) && !driver_release_tids) {
1469
		int tid;
1470 1471

		/*
1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483
		 * For PS-Poll, this can only happen due to a race condition
		 * when we set the TIM bit and the station notices it, but
		 * before it can poll for the frame we expire it.
		 *
		 * For uAPSD, this is said in the standard (11.2.1.5 h):
		 *	At each unscheduled SP for a non-AP STA, the AP shall
		 *	attempt to transmit at least one MSDU or MMPDU, but no
		 *	more than the value specified in the Max SP Length field
		 *	in the QoS Capability element from delivery-enabled ACs,
		 *	that are destined for the non-AP STA.
		 *
		 * Since we have no other MSDU/MMPDU, transmit a QoS null frame.
1484 1485
		 */

1486 1487
		/* This will evaluate to 1, 3, 5 or 7. */
		tid = 7 - ((ffs(~ignored_acs) - 1) << 1);
1488

1489
		ieee80211_send_null_response(sta, tid, reason, true, false);
1490
	} else if (!driver_release_tids) {
J
Johannes Berg 已提交
1491 1492
		struct sk_buff_head pending;
		struct sk_buff *skb;
1493 1494
		int num = 0;
		u16 tids = 0;
1495
		bool need_null = false;
1496

J
Johannes Berg 已提交
1497
		skb_queue_head_init(&pending);
1498

J
Johannes Berg 已提交
1499 1500 1501
		while ((skb = __skb_dequeue(&frames))) {
			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
			struct ieee80211_hdr *hdr = (void *) skb->data;
1502 1503 1504
			u8 *qoshdr = NULL;

			num++;
1505

J
Johannes Berg 已提交
1506 1507 1508 1509 1510
			/*
			 * Tell TX path to send this frame even though the
			 * STA may still remain is PS mode after this frame
			 * exchange.
			 */
1511 1512
			info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER;
			info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;
J
Johannes Berg 已提交
1513 1514 1515 1516 1517

			/*
			 * Use MoreData flag to indicate whether there are
			 * more buffered frames for this STA
			 */
1518
			if (more_data || !skb_queue_empty(&frames))
J
Johannes Berg 已提交
1519 1520
				hdr->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
1521 1522 1523
			else
				hdr->frame_control &=
					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
J
Johannes Berg 已提交
1524

1525 1526 1527 1528
			if (ieee80211_is_data_qos(hdr->frame_control) ||
			    ieee80211_is_qos_nullfunc(hdr->frame_control))
				qoshdr = ieee80211_get_qos_ctl(hdr);

1529
			tids |= BIT(skb->priority);
1530

1531 1532 1533 1534 1535 1536 1537 1538
			__skb_queue_tail(&pending, skb);

			/* end service period after last frame or add one */
			if (!skb_queue_empty(&frames))
				continue;

			if (reason != IEEE80211_FRAME_RELEASE_UAPSD) {
				/* for PS-Poll, there's only one frame */
1539 1540
				info->flags |= IEEE80211_TX_STATUS_EOSP |
					       IEEE80211_TX_CTL_REQ_TX_STATUS;
1541
				break;
1542
			}
1543

1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561
			/* For uAPSD, things are a bit more complicated. If the
			 * last frame has a QoS header (i.e. is a QoS-data or
			 * QoS-nulldata frame) then just set the EOSP bit there
			 * and be done.
			 * If the frame doesn't have a QoS header (which means
			 * it should be a bufferable MMPDU) then we can't set
			 * the EOSP bit in the QoS header; add a QoS-nulldata
			 * frame to the list to send it after the MMPDU.
			 *
			 * Note that this code is only in the mac80211-release
			 * code path, we assume that the driver will not buffer
			 * anything but QoS-data frames, or if it does, will
			 * create the QoS-nulldata frame by itself if needed.
			 *
			 * Cf. 802.11-2012 10.2.1.10 (c).
			 */
			if (qoshdr) {
				*qoshdr |= IEEE80211_QOS_CTL_EOSP;
1562

1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579
				info->flags |= IEEE80211_TX_STATUS_EOSP |
					       IEEE80211_TX_CTL_REQ_TX_STATUS;
			} else {
				/* The standard isn't completely clear on this
				 * as it says the more-data bit should be set
				 * if there are more BUs. The QoS-Null frame
				 * we're about to send isn't buffered yet, we
				 * only create it below, but let's pretend it
				 * was buffered just in case some clients only
				 * expect more-data=0 when eosp=1.
				 */
				hdr->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
				need_null = true;
				num++;
			}
			break;
J
Johannes Berg 已提交
1580
		}
1581

1582 1583 1584
		drv_allow_buffered_frames(local, sta, tids, num,
					  reason, more_data);

J
Johannes Berg 已提交
1585
		ieee80211_add_pending_skbs(local, &pending);
1586

1587 1588
		if (need_null)
			ieee80211_send_null_response(
1589 1590
				sta, find_highest_prio_tid(tids),
				reason, false, false);
1591

J
Johannes Berg 已提交
1592
		sta_info_recalc_tim(sta);
1593
	} else {
1594 1595 1596
		unsigned long tids = sta->txq_buffered_tids & driver_release_tids;
		int tid;

1597
		/*
1598 1599
		 * We need to release a frame that is buffered somewhere in the
		 * driver ... it'll have to handle that.
1600 1601 1602 1603 1604 1605
		 * Note that the driver also has to check the number of frames
		 * on the TIDs we're releasing from - if there are more than
		 * n_frames it has to set the more-data bit (if we didn't ask
		 * it to set it anyway due to other buffered frames); if there
		 * are fewer than n_frames it has to make sure to adjust that
		 * to allow the service period to end properly.
1606 1607
		 */
		drv_release_buffered_frames(local, sta, driver_release_tids,
J
Johannes Berg 已提交
1608
					    n_frames, reason, more_data);
1609 1610 1611 1612

		/*
		 * Note that we don't recalculate the TIM bit here as it would
		 * most likely have no effect at all unless the driver told us
1613
		 * that the TID(s) became empty before returning here from the
1614
		 * release function.
1615
		 * Either way, however, when the driver tells us that the TID(s)
1616 1617
		 * became empty or we find that a txq became empty, we'll do the
		 * TIM recalculation.
1618
		 */
1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631

		if (!sta->sta.txq[0])
			return;

		for (tid = 0; tid < ARRAY_SIZE(sta->sta.txq); tid++) {
			struct txq_info *txqi = to_txq_info(sta->sta.txq[tid]);

			if (!(tids & BIT(tid)) || skb_queue_len(&txqi->queue))
				continue;

			sta_info_recalc_tim(sta);
			break;
		}
1632 1633 1634
	}
}

J
Johannes Berg 已提交
1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676
void ieee80211_sta_ps_deliver_poll_response(struct sta_info *sta)
{
	u8 ignore_for_response = sta->sta.uapsd_queues;

	/*
	 * If all ACs are delivery-enabled then we should reply
	 * from any of them, if only some are enabled we reply
	 * only from the non-enabled ones.
	 */
	if (ignore_for_response == BIT(IEEE80211_NUM_ACS) - 1)
		ignore_for_response = 0;

	ieee80211_sta_ps_deliver_response(sta, 1, ignore_for_response,
					  IEEE80211_FRAME_RELEASE_PSPOLL);
}

void ieee80211_sta_ps_deliver_uapsd(struct sta_info *sta)
{
	int n_frames = sta->sta.max_sp;
	u8 delivery_enabled = sta->sta.uapsd_queues;

	/*
	 * If we ever grow support for TSPEC this might happen if
	 * the TSPEC update from hostapd comes in between a trigger
	 * frame setting WLAN_STA_UAPSD in the RX path and this
	 * actually getting called.
	 */
	if (!delivery_enabled)
		return;

	switch (sta->sta.max_sp) {
	case 1:
		n_frames = 2;
		break;
	case 2:
		n_frames = 4;
		break;
	case 3:
		n_frames = 6;
		break;
	case 0:
		/* XXX: what is a good value? */
1677
		n_frames = 128;
J
Johannes Berg 已提交
1678 1679 1680 1681 1682 1683 1684
		break;
	}

	ieee80211_sta_ps_deliver_response(sta, n_frames, ~delivery_enabled,
					  IEEE80211_FRAME_RELEASE_UAPSD);
}

1685 1686 1687 1688 1689
void ieee80211_sta_block_awake(struct ieee80211_hw *hw,
			       struct ieee80211_sta *pubsta, bool block)
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);

J
Johannes Berg 已提交
1690 1691
	trace_api_sta_block_awake(sta->local, pubsta, block);

1692
	if (block) {
J
Johannes Berg 已提交
1693
		set_sta_flag(sta, WLAN_STA_PS_DRIVER);
J
Johannes Berg 已提交
1694
		ieee80211_clear_fast_xmit(sta);
1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711
		return;
	}

	if (!test_sta_flag(sta, WLAN_STA_PS_DRIVER))
		return;

	if (!test_sta_flag(sta, WLAN_STA_PS_STA)) {
		set_sta_flag(sta, WLAN_STA_PS_DELIVER);
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
		ieee80211_queue_work(hw, &sta->drv_deliver_wk);
	} else if (test_sta_flag(sta, WLAN_STA_PSPOLL) ||
		   test_sta_flag(sta, WLAN_STA_UAPSD)) {
		/* must be asleep in this case */
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
		ieee80211_queue_work(hw, &sta->drv_deliver_wk);
	} else {
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
J
Johannes Berg 已提交
1712
		ieee80211_check_fast_xmit(sta);
1713
	}
1714 1715
}
EXPORT_SYMBOL(ieee80211_sta_block_awake);
1716

1717
void ieee80211_sta_eosp(struct ieee80211_sta *pubsta)
1718 1719 1720 1721 1722 1723
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
	struct ieee80211_local *local = sta->local;

	trace_api_eosp(local, pubsta);

1724
	clear_sta_flag(sta, WLAN_STA_SP);
1725
}
1726
EXPORT_SYMBOL(ieee80211_sta_eosp);
1727

1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743
void ieee80211_send_eosp_nullfunc(struct ieee80211_sta *pubsta, int tid)
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
	enum ieee80211_frame_release_type reason;
	bool more_data;

	trace_api_send_eosp_nullfunc(sta->local, pubsta, tid);

	reason = IEEE80211_FRAME_RELEASE_UAPSD;
	more_data = ieee80211_sta_ps_more_data(sta, ~sta->sta.uapsd_queues,
					       reason, 0);

	ieee80211_send_null_response(sta, tid, reason, false, more_data);
}
EXPORT_SYMBOL(ieee80211_send_eosp_nullfunc);

1744 1745
void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta,
				u8 tid, bool buffered)
1746 1747 1748
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);

1749
	if (WARN_ON(tid >= IEEE80211_NUM_TIDS))
1750 1751
		return;

1752 1753
	trace_api_sta_set_buffered(sta->local, pubsta, tid, buffered);

1754 1755 1756 1757 1758
	if (buffered)
		set_bit(tid, &sta->driver_buffered_tids);
	else
		clear_bit(tid, &sta->driver_buffered_tids);

J
Johannes Berg 已提交
1759
	sta_info_recalc_tim(sta);
1760
}
1761
EXPORT_SYMBOL(ieee80211_sta_set_buffered);
1762

1763 1764
int sta_info_move_state(struct sta_info *sta,
			enum ieee80211_sta_state new_state)
1765
{
1766
	might_sleep();
1767 1768 1769 1770

	if (sta->sta_state == new_state)
		return 0;

J
Johannes Berg 已提交
1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796
	/* check allowed transitions first */

	switch (new_state) {
	case IEEE80211_STA_NONE:
		if (sta->sta_state != IEEE80211_STA_AUTH)
			return -EINVAL;
		break;
	case IEEE80211_STA_AUTH:
		if (sta->sta_state != IEEE80211_STA_NONE &&
		    sta->sta_state != IEEE80211_STA_ASSOC)
			return -EINVAL;
		break;
	case IEEE80211_STA_ASSOC:
		if (sta->sta_state != IEEE80211_STA_AUTH &&
		    sta->sta_state != IEEE80211_STA_AUTHORIZED)
			return -EINVAL;
		break;
	case IEEE80211_STA_AUTHORIZED:
		if (sta->sta_state != IEEE80211_STA_ASSOC)
			return -EINVAL;
		break;
	default:
		WARN(1, "invalid state %d", new_state);
		return -EINVAL;
	}

J
Johannes Berg 已提交
1797 1798
	sta_dbg(sta->sdata, "moving STA %pM to state %d\n",
		sta->sta.addr, new_state);
J
Johannes Berg 已提交
1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812

	/*
	 * notify the driver before the actual changes so it can
	 * fail the transition
	 */
	if (test_sta_flag(sta, WLAN_STA_INSERTED)) {
		int err = drv_sta_state(sta->local, sta->sdata, sta,
					sta->sta_state, new_state);
		if (err)
			return err;
	}

	/* reflect the change in all state variables */

1813 1814 1815 1816 1817 1818
	switch (new_state) {
	case IEEE80211_STA_NONE:
		if (sta->sta_state == IEEE80211_STA_AUTH)
			clear_bit(WLAN_STA_AUTH, &sta->_flags);
		break;
	case IEEE80211_STA_AUTH:
1819
		if (sta->sta_state == IEEE80211_STA_NONE) {
1820
			set_bit(WLAN_STA_AUTH, &sta->_flags);
1821
		} else if (sta->sta_state == IEEE80211_STA_ASSOC) {
1822
			clear_bit(WLAN_STA_ASSOC, &sta->_flags);
1823 1824
			ieee80211_recalc_min_chandef(sta->sdata);
		}
1825 1826
		break;
	case IEEE80211_STA_ASSOC:
1827
		if (sta->sta_state == IEEE80211_STA_AUTH) {
1828
			set_bit(WLAN_STA_ASSOC, &sta->_flags);
1829
			ieee80211_recalc_min_chandef(sta->sdata);
1830
		} else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) {
1831 1832 1833 1834
			if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
			    (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
			     !sta->sdata->u.vlan.sta))
				atomic_dec(&sta->sdata->bss->num_mcast_sta);
1835
			clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1836
			ieee80211_clear_fast_xmit(sta);
J
Johannes Berg 已提交
1837
		}
1838 1839
		break;
	case IEEE80211_STA_AUTHORIZED:
1840
		if (sta->sta_state == IEEE80211_STA_ASSOC) {
1841 1842 1843 1844
			if (sta->sdata->vif.type == NL80211_IFTYPE_AP ||
			    (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
			     !sta->sdata->u.vlan.sta))
				atomic_inc(&sta->sdata->bss->num_mcast_sta);
1845
			set_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1846
			ieee80211_check_fast_xmit(sta);
J
Johannes Berg 已提交
1847
		}
1848 1849
		break;
	default:
J
Johannes Berg 已提交
1850
		break;
1851 1852 1853 1854 1855 1856
	}

	sta->sta_state = new_state;

	return 0;
}
1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891

u8 sta_info_tx_streams(struct sta_info *sta)
{
	struct ieee80211_sta_ht_cap *ht_cap = &sta->sta.ht_cap;
	u8 rx_streams;

	if (!sta->sta.ht_cap.ht_supported)
		return 1;

	if (sta->sta.vht_cap.vht_supported) {
		int i;
		u16 tx_mcs_map =
			le16_to_cpu(sta->sta.vht_cap.vht_mcs.tx_mcs_map);

		for (i = 7; i >= 0; i--)
			if ((tx_mcs_map & (0x3 << (i * 2))) !=
			    IEEE80211_VHT_MCS_NOT_SUPPORTED)
				return i + 1;
	}

	if (ht_cap->mcs.rx_mask[3])
		rx_streams = 4;
	else if (ht_cap->mcs.rx_mask[2])
		rx_streams = 3;
	else if (ht_cap->mcs.rx_mask[1])
		rx_streams = 2;
	else
		rx_streams = 1;

	if (!(ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_RX_DIFF))
		return rx_streams;

	return ((ht_cap->mcs.tx_params & IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK)
			>> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT) + 1;
}
1892

1893 1894 1895 1896
static void sta_set_rate_info_rx(struct sta_info *sta, struct rate_info *rinfo)
{
	rinfo->flags = 0;

1897
	if (sta->rx_stats.last_rate_flag & RX_FLAG_HT) {
1898
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
1899 1900
		rinfo->mcs = sta->rx_stats.last_rate_idx;
	} else if (sta->rx_stats.last_rate_flag & RX_FLAG_VHT) {
1901
		rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
1902 1903
		rinfo->nss = sta->rx_stats.last_rate_vht_nss;
		rinfo->mcs = sta->rx_stats.last_rate_idx;
1904 1905 1906 1907 1908 1909 1910
	} else {
		struct ieee80211_supported_band *sband;
		int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
		u16 brate;

		sband = sta->local->hw.wiphy->bands[
				ieee80211_get_sdata_band(sta->sdata)];
1911
		brate = sband->bitrates[sta->rx_stats.last_rate_idx].bitrate;
1912 1913 1914
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
	}

1915
	if (sta->rx_stats.last_rate_flag & RX_FLAG_SHORT_GI)
1916 1917
		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;

1918
	if (sta->rx_stats.last_rate_flag & RX_FLAG_5MHZ)
1919
		rinfo->bw = RATE_INFO_BW_5;
1920
	else if (sta->rx_stats.last_rate_flag & RX_FLAG_10MHZ)
1921
		rinfo->bw = RATE_INFO_BW_10;
1922
	else if (sta->rx_stats.last_rate_flag & RX_FLAG_40MHZ)
1923
		rinfo->bw = RATE_INFO_BW_40;
1924
	else if (sta->rx_stats.last_rate_vht_flag & RX_VHT_FLAG_80MHZ)
1925
		rinfo->bw = RATE_INFO_BW_80;
1926
	else if (sta->rx_stats.last_rate_vht_flag & RX_VHT_FLAG_160MHZ)
1927 1928 1929 1930 1931
		rinfo->bw = RATE_INFO_BW_160;
	else
		rinfo->bw = RATE_INFO_BW_20;
}

1932 1933 1934 1935
void sta_set_sinfo(struct sta_info *sta, struct station_info *sinfo)
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1936
	struct rate_control_ref *ref = NULL;
1937 1938 1939
	u32 thr = 0;
	int i, ac;

1940 1941 1942
	if (test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
		ref = local->rate_ctrl;

1943 1944
	sinfo->generation = sdata->local->sta_generation;

1945 1946 1947 1948 1949 1950 1951
	/* do before driver, so beacon filtering drivers have a
	 * chance to e.g. just add the number of filtered beacons
	 * (or just modify the value entirely, of course)
	 */
	if (sdata->vif.type == NL80211_IFTYPE_STATION)
		sinfo->rx_beacon = sdata->u.mgd.count_beacon_signal;

1952 1953
	drv_sta_statistics(local, sdata, &sta->sta, sinfo);

1954 1955 1956 1957
	sinfo->filled |= BIT(NL80211_STA_INFO_INACTIVE_TIME) |
			 BIT(NL80211_STA_INFO_STA_FLAGS) |
			 BIT(NL80211_STA_INFO_BSS_PARAM) |
			 BIT(NL80211_STA_INFO_CONNECTED_TIME) |
1958 1959 1960 1961 1962 1963
			 BIT(NL80211_STA_INFO_RX_DROP_MISC);

	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
		sinfo->beacon_loss_count = sdata->u.mgd.beacon_loss_count;
		sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_LOSS);
	}
1964

A
Arnd Bergmann 已提交
1965
	sinfo->connected_time = ktime_get_seconds() - sta->last_connected;
1966 1967
	sinfo->inactive_time =
		jiffies_to_msecs(jiffies - sta->rx_stats.last_rx);
1968

1969 1970
	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES64) |
			       BIT(NL80211_STA_INFO_TX_BYTES)))) {
1971 1972
		sinfo->tx_bytes = 0;
		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
1973
			sinfo->tx_bytes += sta->tx_stats.bytes[ac];
1974
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64);
1975 1976
	}

1977
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_PACKETS))) {
1978 1979
		sinfo->tx_packets = 0;
		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
1980
			sinfo->tx_packets += sta->tx_stats.packets[ac];
1981
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS);
1982 1983
	}

1984 1985
	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES64) |
			       BIT(NL80211_STA_INFO_RX_BYTES)))) {
1986
		sinfo->rx_bytes = sta->rx_stats.bytes;
1987
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64);
1988 1989
	}

1990
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_PACKETS))) {
1991
		sinfo->rx_packets = sta->rx_stats.packets;
1992
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS);
1993 1994
	}

1995
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_RETRIES))) {
1996
		sinfo->tx_retries = sta->status_stats.retry_count;
1997
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_RETRIES);
1998 1999
	}

2000
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_FAILED))) {
2001
		sinfo->tx_failed = sta->status_stats.retry_failed;
2002
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_FAILED);
2003
	}
2004

2005
	sinfo->rx_dropped_misc = sta->rx_stats.dropped;
2006

2007 2008 2009 2010 2011 2012 2013
	if (sdata->vif.type == NL80211_IFTYPE_STATION &&
	    !(sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)) {
		sinfo->filled |= BIT(NL80211_STA_INFO_BEACON_RX) |
				 BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG);
		sinfo->rx_beacon_signal_avg = ieee80211_ave_rssi(&sdata->vif);
	}

2014 2015
	if (ieee80211_hw_check(&sta->local->hw, SIGNAL_DBM) ||
	    ieee80211_hw_check(&sta->local->hw, SIGNAL_UNSPEC)) {
2016
		if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL))) {
2017
			sinfo->signal = (s8)sta->rx_stats.last_signal;
2018
			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL);
2019 2020
		}

2021
		if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL_AVG))) {
J
Johannes Berg 已提交
2022
			sinfo->signal_avg =
2023
				-ewma_signal_read(&sta->rx_stats.avg_signal);
2024
			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL_AVG);
2025
		}
2026
	}
2027

2028
	if (sta->rx_stats.chains &&
2029 2030 2031 2032
	    !(sinfo->filled & (BIT(NL80211_STA_INFO_CHAIN_SIGNAL) |
			       BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)))) {
		sinfo->filled |= BIT(NL80211_STA_INFO_CHAIN_SIGNAL) |
				 BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG);
2033

2034
		sinfo->chains = sta->rx_stats.chains;
2035
		for (i = 0; i < ARRAY_SIZE(sinfo->chain_signal); i++) {
2036 2037
			sinfo->chain_signal[i] =
				sta->rx_stats.chain_signal_last[i];
2038
			sinfo->chain_signal_avg[i] =
2039
				-ewma_signal_read(&sta->rx_stats.chain_signal_avg[i]);
2040 2041 2042
		}
	}

2043
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE))) {
2044 2045
		sta_set_rate_info_tx(sta, &sta->tx_stats.last_rate,
				     &sinfo->txrate);
2046
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE);
2047 2048
	}

2049
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE))) {
2050
		sta_set_rate_info_rx(sta, &sinfo->rxrate);
2051
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BITRATE);
2052
	}
2053

2054 2055 2056 2057 2058 2059
	sinfo->filled |= BIT(NL80211_STA_INFO_TID_STATS);
	for (i = 0; i < IEEE80211_NUM_TIDS + 1; i++) {
		struct cfg80211_tid_stats *tidstats = &sinfo->pertid[i];

		if (!(tidstats->filled & BIT(NL80211_TID_STATS_RX_MSDU))) {
			tidstats->filled |= BIT(NL80211_TID_STATS_RX_MSDU);
2060
			tidstats->rx_msdu = sta->rx_stats.msdu[i];
2061 2062 2063 2064
		}

		if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU))) {
			tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU);
2065
			tidstats->tx_msdu = sta->tx_stats.msdu[i];
2066 2067 2068 2069
		}

		if (!(tidstats->filled &
				BIT(NL80211_TID_STATS_TX_MSDU_RETRIES)) &&
2070
		    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
2071 2072
			tidstats->filled |=
				BIT(NL80211_TID_STATS_TX_MSDU_RETRIES);
2073 2074
			tidstats->tx_msdu_retries =
				sta->status_stats.msdu_retries[i];
2075 2076 2077 2078
		}

		if (!(tidstats->filled &
				BIT(NL80211_TID_STATS_TX_MSDU_FAILED)) &&
2079
		    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
2080 2081
			tidstats->filled |=
				BIT(NL80211_TID_STATS_TX_MSDU_FAILED);
2082 2083
			tidstats->tx_msdu_failed =
				sta->status_stats.msdu_failed[i];
2084 2085 2086
		}
	}

2087 2088
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
#ifdef CONFIG_MAC80211_MESH
2089 2090 2091 2092 2093 2094
		sinfo->filled |= BIT(NL80211_STA_INFO_LLID) |
				 BIT(NL80211_STA_INFO_PLID) |
				 BIT(NL80211_STA_INFO_PLINK_STATE) |
				 BIT(NL80211_STA_INFO_LOCAL_PM) |
				 BIT(NL80211_STA_INFO_PEER_PM) |
				 BIT(NL80211_STA_INFO_NONPEER_PM);
2095

2096 2097 2098
		sinfo->llid = sta->mesh->llid;
		sinfo->plid = sta->mesh->plid;
		sinfo->plink_state = sta->mesh->plink_state;
2099
		if (test_sta_flag(sta, WLAN_STA_TOFFSET_KNOWN)) {
2100
			sinfo->filled |= BIT(NL80211_STA_INFO_T_OFFSET);
2101
			sinfo->t_offset = sta->mesh->t_offset;
2102
		}
2103 2104 2105
		sinfo->local_pm = sta->mesh->local_pm;
		sinfo->peer_pm = sta->mesh->peer_pm;
		sinfo->nonpeer_pm = sta->mesh->nonpeer_pm;
2106 2107 2108 2109 2110 2111 2112 2113 2114 2115
#endif
	}

	sinfo->bss_param.flags = 0;
	if (sdata->vif.bss_conf.use_cts_prot)
		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_CTS_PROT;
	if (sdata->vif.bss_conf.use_short_preamble)
		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_PREAMBLE;
	if (sdata->vif.bss_conf.use_short_slot)
		sinfo->bss_param.flags |= BSS_PARAM_FLAGS_SHORT_SLOT_TIME;
2116
	sinfo->bss_param.dtim_period = sdata->vif.bss_conf.dtim_period;
2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130
	sinfo->bss_param.beacon_interval = sdata->vif.bss_conf.beacon_int;

	sinfo->sta_flags.set = 0;
	sinfo->sta_flags.mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
				BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
				BIT(NL80211_STA_FLAG_WME) |
				BIT(NL80211_STA_FLAG_MFP) |
				BIT(NL80211_STA_FLAG_AUTHENTICATED) |
				BIT(NL80211_STA_FLAG_ASSOCIATED) |
				BIT(NL80211_STA_FLAG_TDLS_PEER);
	if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHORIZED);
	if (test_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_SHORT_PREAMBLE);
2131
	if (sta->sta.wme)
2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_WME);
	if (test_sta_flag(sta, WLAN_STA_MFP))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_MFP);
	if (test_sta_flag(sta, WLAN_STA_AUTH))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_AUTHENTICATED);
	if (test_sta_flag(sta, WLAN_STA_ASSOC))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_ASSOCIATED);
	if (test_sta_flag(sta, WLAN_STA_TDLS_PEER))
		sinfo->sta_flags.set |= BIT(NL80211_STA_FLAG_TDLS_PEER);

	/* check if the driver has a SW RC implementation */
	if (ref && ref->ops->get_expected_throughput)
		thr = ref->ops->get_expected_throughput(sta->rate_ctrl_priv);
	else
		thr = drv_get_expected_throughput(local, &sta->sta);

	if (thr != 0) {
2149
		sinfo->filled |= BIT(NL80211_STA_INFO_EXPECTED_THROUGHPUT);
2150 2151 2152
		sinfo->expected_throughput = thr;
	}
}