sta_info.c 57.2 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 119 120 121
	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]);
		}
	}

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

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

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

	/*
	 * 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.
	 */
139
	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
140
		kfree(sta->ampdu_mlme.tid_start_tx[i]);
141 142 143
		tid_tx = rcu_dereference_raw(sta->ampdu_mlme.tid_tx[i]);
		if (!tid_tx)
			continue;
144
		ieee80211_purge_tx_queue(&local->hw, &tid_tx->pending);
145 146
		kfree(tid_tx);
	}
147
}
148

149 150 151 152 153 154
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);
155 156 157
	sta_info_free(local, sta);
}

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

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

170 171 172 173 174 175 176 177 178 179 180
	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;
181 182
}

183 184 185 186 187 188 189 190 191
/*
 * 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;
192 193
	struct rhash_head *tmp;
	const struct bucket_table *tbl;
194

195 196 197 198 199 200 201 202 203 204 205 206
	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;
		}
207
	}
208 209
	rcu_read_unlock();
	return NULL;
210 211
}

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

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

	return NULL;
}
231

232
/**
233
 * sta_info_free - free STA
234
 *
R
Randy Dunlap 已提交
235
 * @local: pointer to the global information
236 237 238
 * @sta: STA info to free
 *
 * This function must undo everything done by sta_info_alloc()
239 240 241
 * 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.)
242
 */
243
void sta_info_free(struct ieee80211_local *local, struct sta_info *sta)
244
{
245
	if (sta->rate_ctrl)
246
		rate_control_free_sta(sta);
247

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

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

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

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

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

	if (sta->dead)
		return;

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

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

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

	return 0;
}

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

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

313
	spin_lock_init(&sta->lock);
314
	spin_lock_init(&sta->ps_lock);
315
	INIT_WORK(&sta->drv_deliver_wk, sta_deliver_ps_frames);
J
Johannes Berg 已提交
316
	INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work);
317
	mutex_init(&sta->ampdu_mlme.mtx);
318
#ifdef CONFIG_MAC80211_MESH
319 320 321 322 323 324 325 326 327 328
	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;
	}
329
#endif
330

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

337 338
	sta->sta_state = IEEE80211_STA_NONE;

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

A
Arnd Bergmann 已提交
342
	sta->last_connected = ktime_get_seconds();
343 344 345
	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]);
346

347 348 349 350 351 352 353 354 355 356 357 358 359 360
	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);
		}
361
	}
362

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

366
	for (i = 0; i < IEEE80211_NUM_TIDS; i++) {
367 368 369 370 371
		/*
		 * 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.
		 */
372 373
		sta->timer_to_tid[i] = i;
	}
374 375 376 377
	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 已提交
378

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

382
	sta->sta.smps_mode = IEEE80211_SMPS_OFF;
383 384 385
	if (sdata->vif.type == NL80211_IFTYPE_AP ||
	    sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
		struct ieee80211_supported_band *sband =
386
			hw->wiphy->bands[ieee80211_get_sdata_band(sdata)];
387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406
		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);
		}
	}
407

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

410
	return sta;
411 412 413 414 415

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

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

427 428 429 430 431
	/*
	 * 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.
	 */
432 433
	if (unlikely(!ieee80211_sdata_running(sdata)))
		return -ENETDOWN;
434

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

439 440 441 442 443 444 445 446 447 448 449 450 451
	/* 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();

452 453 454
	return 0;
}

J
Johannes Berg 已提交
455 456 457 458 459 460 461 462 463 464 465 466 467 468
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) {
469 470 471 472 473 474
		/*
		 * 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 已提交
475 476 477 478
		return 0;
	}

	if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
J
Johannes Berg 已提交
479 480 481
		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 已提交
482 483 484 485 486 487 488 489 490 491
		err = 0;
	}

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

	return err;
}

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

	lockdep_assert_held(&local->sta_mtx);
505

506 507 508 509
	/* check if STA exists already */
	if (sta_info_get_bss(sdata, sta->sta.addr)) {
		err = -EEXIST;
		goto out_err;
510
	}
511

512 513 514
	local->num_sta++;
	local->sta_generation++;
	smp_mb();
515

516 517 518
	/* simplify things and don't accept BA sessions yet */
	set_sta_flag(sta, WLAN_STA_BLOCK_BA);

519 520
	/* make the station visible */
	sta_info_hash_add(local, sta);
521

522
	list_add_tail_rcu(&sta->list, &local->sta_list);
523

524 525 526 527 528
	/* notify driver */
	err = sta_info_insert_drv_state(local, sdata, sta);
	if (err)
		goto out_remove;

529
	set_sta_flag(sta, WLAN_STA_INSERTED);
530 531
	/* accept BA sessions now */
	clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
532

533
	ieee80211_recalc_min_chandef(sdata);
534 535
	ieee80211_sta_debugfs_add(sta);
	rate_control_add_sta_debugfs(sta);
536

537 538 539 540
	memset(&sinfo, 0, sizeof(sinfo));
	sinfo.filled = 0;
	sinfo.generation = local->sta_generation;
	cfg80211_new_sta(sdata->dev, sta->sta.addr, &sinfo, GFP_KERNEL);
541

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

544 545 546
	/* move reference to rcu-protected */
	rcu_read_lock();
	mutex_unlock(&local->sta_mtx);
J
Jiri Benc 已提交
547

J
Johannes Berg 已提交
548 549 550
	if (ieee80211_vif_is_mesh(&sdata->vif))
		mesh_accept_plinks_update(sdata);

551
	return 0;
552 553 554 555 556 557
 out_remove:
	sta_info_hash_del(local, sta);
	list_del_rcu(&sta->list);
	local->num_sta--;
	synchronize_net();
	__cleanup_single_sta(sta);
558 559 560 561
 out_err:
	mutex_unlock(&local->sta_mtx);
	rcu_read_lock();
	return err;
562 563 564 565 566
}

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

569 570
	might_sleep();

571 572
	mutex_lock(&local->sta_mtx);

573 574
	err = sta_info_insert_check(sta);
	if (err) {
575
		mutex_unlock(&local->sta_mtx);
576 577 578 579
		rcu_read_lock();
		goto out_free;
	}

580
	err = sta_info_insert_finish(sta);
581 582 583
	if (err)
		goto out_free;

J
Johannes Berg 已提交
584
	return 0;
585
 out_free:
586
	sta_info_free(local, sta);
587
	return err;
588 589
}

590 591 592 593 594 595 596 597 598
int sta_info_insert(struct sta_info *sta)
{
	int err = sta_info_insert_rcu(sta);

	rcu_read_unlock();

	return err;
}

599
static inline void __bss_tim_set(u8 *tim, u16 id)
600 601 602 603 604
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the __set_bit() format.
	 */
605
	tim[id / 8] |= (1 << (id % 8));
606 607
}

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

617 618 619 620 621 622 623 624 625
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));
}

626
static unsigned long ieee80211_tids_for_ac(int ac)
627
{
628 629 630 631 632 633 634 635 636 637 638 639 640
	/* 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;
641
	}
642 643
}

644
static void __sta_info_recalc_tim(struct sta_info *sta, bool ignore_pending)
645
{
J
Johannes Berg 已提交
646
	struct ieee80211_local *local = sta->local;
647
	struct ps_data *ps;
648 649 650
	bool indicate_tim = false;
	u8 ignore_for_tim = sta->sta.uapsd_queues;
	int ac;
651
	u16 id = sta->sta.aid;
652 653 654 655 656

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

658
		ps = &sta->sdata->bss->ps;
M
Marco Porsch 已提交
659 660 661 662
#ifdef CONFIG_MAC80211_MESH
	} else if (ieee80211_vif_is_mesh(&sta->sdata->vif)) {
		ps = &sta->sdata->u.mesh.ps;
#endif
663
	} else {
J
Johannes Berg 已提交
664
		return;
665
	}
666

J
Johannes Berg 已提交
667
	/* No need to do anything if the driver does all */
668
	if (ieee80211_hw_check(&local->hw, AP_LINK_PS))
J
Johannes Berg 已提交
669
		return;
670

J
Johannes Berg 已提交
671 672
	if (sta->dead)
		goto done;
673

674 675 676 677 678 679 680 681 682
	/*
	 * 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;

683 684 685
	if (ignore_pending)
		ignore_for_tim = BIT(IEEE80211_NUM_ACS) - 1;

686 687
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		unsigned long tids;
688

689 690 691 692 693 694 695
		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;
696

697 698 699 700
		tids = ieee80211_tids_for_ac(ac);

		indicate_tim |=
			sta->driver_buffered_tids & tids;
701 702
		indicate_tim |=
			sta->txq_buffered_tids & tids;
703
	}
704

J
Johannes Berg 已提交
705
 done:
706
	spin_lock_bh(&local->tim_lock);
707

708 709 710
	if (indicate_tim == __bss_tim_get(ps->tim, id))
		goto out_unlock;

711
	if (indicate_tim)
712
		__bss_tim_set(ps->tim, id);
J
Johannes Berg 已提交
713
	else
714
		__bss_tim_clear(ps->tim, id);
715

716
	if (local->ops->set_tim && !WARN_ON(sta->dead)) {
J
Johannes Berg 已提交
717
		local->tim_in_locked_section = true;
718
		drv_set_tim(local, &sta->sta, indicate_tim);
J
Johannes Berg 已提交
719 720
		local->tim_in_locked_section = false;
	}
721

722
out_unlock:
723
	spin_unlock_bh(&local->tim_lock);
724 725
}

726 727 728 729 730
void sta_info_recalc_tim(struct sta_info *sta)
{
	__sta_info_recalc_tim(sta, false);
}

731
static bool sta_info_buffer_expired(struct sta_info *sta, struct sk_buff *skb)
732
{
733
	struct ieee80211_tx_info *info;
734 735 736
	int timeout;

	if (!skb)
737
		return false;
738

739
	info = IEEE80211_SKB_CB(skb);
740 741

	/* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */
742 743 744
	timeout = (sta->listen_interval *
		   sta->sdata->vif.bss_conf.beacon_int *
		   32 / 15625) * HZ;
745 746
	if (timeout < STA_TX_BUFFER_EXPIRE)
		timeout = STA_TX_BUFFER_EXPIRE;
747
	return time_after(jiffies, info->control.jiffies + timeout);
748 749 750
}


751 752
static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local *local,
						struct sta_info *sta, int ac)
753 754 755 756
{
	unsigned long flags;
	struct sk_buff *skb;

757 758 759 760 761 762 763 764
	/*
	 * 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 (;;) {
765 766
		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
		skb = skb_peek(&sta->tx_filtered[ac]);
767
		if (sta_info_buffer_expired(sta, skb))
768
			skb = __skb_dequeue(&sta->tx_filtered[ac]);
769 770
		else
			skb = NULL;
771
		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
772 773 774 775 776 777 778 779 780

		/*
		 * 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;
781
		ieee80211_free_txskb(&local->hw, skb);
782 783 784 785 786 787 788 789
	}

	/*
	 * 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.
	 */
790
	for (;;) {
791 792
		spin_lock_irqsave(&sta->ps_tx_buf[ac].lock, flags);
		skb = skb_peek(&sta->ps_tx_buf[ac]);
793
		if (sta_info_buffer_expired(sta, skb))
794
			skb = __skb_dequeue(&sta->ps_tx_buf[ac]);
795
		else
796
			skb = NULL;
797
		spin_unlock_irqrestore(&sta->ps_tx_buf[ac].lock, flags);
798

799 800 801 802 803
		/*
		 * 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
		 */
804
		if (!skb)
805
			break;
806 807

		local->total_ps_buffered--;
J
Johannes Berg 已提交
808 809
		ps_dbg(sta->sdata, "Buffered frame expired (STA %pM)\n",
		       sta->sta.addr);
810
		ieee80211_free_txskb(&local->hw, skb);
811
	}
812

813 814 815 816 817 818 819 820 821 822 823 824
	/*
	 * 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.
	 */
825 826 827 828 829 830 831 832 833 834
	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 已提交
835 836 837
	/* This is only necessary for stations on BSS/MBSS interfaces */
	if (!sta->sdata->bss &&
	    !ieee80211_vif_is_mesh(&sta->sdata->vif))
838 839 840 841 842 843 844
		return false;

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

	return have_buffered;
845 846
}

847
static int __must_check __sta_info_destroy_part1(struct sta_info *sta)
848
{
849 850
	struct ieee80211_local *local;
	struct ieee80211_sub_if_data *sdata;
851
	int ret;
852

853
	might_sleep();
854

855 856
	if (!sta)
		return -ENOENT;
857

858 859
	local = sta->local;
	sdata = sta->sdata;
860

861 862
	lockdep_assert_held(&local->sta_mtx);

863 864 865 866 867 868
	/*
	 * 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 已提交
869
	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
870
	ieee80211_sta_tear_down_BA_sessions(sta, AGG_STOP_DESTROY_STA);
871

872
	ret = sta_info_hash_del(local, sta);
873
	if (WARN_ON(ret))
874 875
		return ret;

876 877 878 879 880 881 882 883 884
	/*
	 * 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);
	}

885
	list_del_rcu(&sta->list);
886
	sta->removed = true;
887

888 889
	drv_sta_pre_rcu_remove(local, sta->sdata, sta);

890 891 892 893
	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
	    rcu_access_pointer(sdata->u.vlan.sta) == sta)
		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);

894 895 896 897 898 899 900
	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;
901
	struct station_info sinfo = {};
902 903 904 905 906 907 908 909 910 911
	int ret;

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

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

912
	/* now keys can no longer be reached */
913
	ieee80211_free_sta_keys(local, sta);
914

915 916 917
	/* disable TIM bit - last chance to tell driver */
	__sta_info_recalc_tim(sta, true);

918 919 920 921 922
	sta->dead = true;

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

923
	while (sta->sta_state > IEEE80211_STA_NONE) {
J
Johannes Berg 已提交
924 925
		ret = sta_info_move_state(sta, sta->sta_state - 1);
		if (ret) {
926 927 928 929
			WARN_ON_ONCE(1);
			break;
		}
	}
930

J
Johannes Berg 已提交
931 932 933 934 935
	if (sta->uploaded) {
		ret = drv_sta_state(local, sdata, sta, IEEE80211_STA_NONE,
				    IEEE80211_STA_NOTEXIST);
		WARN_ON_ONCE(ret != 0);
	}
936

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

939 940
	sta_set_sinfo(sta, &sinfo);
	cfg80211_del_sta_sinfo(sdata->dev, sta->sta.addr, &sinfo, GFP_KERNEL);
941

942 943
	rate_control_remove_sta_debugfs(sta);
	ieee80211_sta_debugfs_remove(sta);
944
	ieee80211_recalc_min_chandef(sdata);
945

946
	cleanup_single_sta(sta);
947 948 949 950 951 952 953 954 955 956 957 958
}

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);
959 960

	return 0;
J
Jiri Slaby 已提交
961 962
}

963
int sta_info_destroy_addr(struct ieee80211_sub_if_data *sdata, const u8 *addr)
J
Jiri Slaby 已提交
964
{
965 966
	struct sta_info *sta;
	int ret;
J
Jiri Slaby 已提交
967

968
	mutex_lock(&sdata->local->sta_mtx);
969
	sta = sta_info_get(sdata, addr);
970 971
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
J
Jiri Slaby 已提交
972 973 974 975

	return ret;
}

976 977
int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
J
Jiri Benc 已提交
978
{
979 980
	struct sta_info *sta;
	int ret;
J
Jiri Benc 已提交
981

982
	mutex_lock(&sdata->local->sta_mtx);
983
	sta = sta_info_get_bss(sdata, addr);
984 985
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
986

987 988
	return ret;
}
J
Jiri Benc 已提交
989

990 991 992 993
static void sta_info_cleanup(unsigned long data)
{
	struct ieee80211_local *local = (struct ieee80211_local *) data;
	struct sta_info *sta;
994
	bool timer_needed = false;
995 996 997

	rcu_read_lock();
	list_for_each_entry_rcu(sta, &local->sta_list, list)
998 999
		if (sta_info_cleanup_expire_buffered(local, sta))
			timer_needed = true;
1000
	rcu_read_unlock();
J
Jiri Benc 已提交
1001

1002 1003
	if (local->quiescing)
		return;
1004

1005 1006 1007
	if (!timer_needed)
		return;

1008 1009
	mod_timer(&local->sta_cleanup,
		  round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL));
J
Jiri Benc 已提交
1010 1011
}

1012
u32 sta_addr_hash(const void *key, u32 length, u32 seed)
1013
{
1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
	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;

1025
	spin_lock_init(&local->tim_lock);
1026
	mutex_init(&local->sta_mtx);
1027 1028
	INIT_LIST_HEAD(&local->sta_list);

1029 1030
	setup_timer(&local->sta_cleanup, sta_info_cleanup,
		    (unsigned long)local);
1031
	return 0;
1032 1033 1034 1035
}

void sta_info_stop(struct ieee80211_local *local)
{
1036
	del_timer_sync(&local->sta_cleanup);
1037
	rhashtable_destroy(&local->sta_hash);
1038 1039
}

1040

1041
int __sta_info_flush(struct ieee80211_sub_if_data *sdata, bool vlans)
1042
{
1043
	struct ieee80211_local *local = sdata->local;
1044
	struct sta_info *sta, *tmp;
1045
	LIST_HEAD(free_list);
1046
	int ret = 0;
1047

1048
	might_sleep();
1049

1050 1051 1052
	WARN_ON(vlans && sdata->vif.type != NL80211_IFTYPE_AP);
	WARN_ON(vlans && !sdata->bss);

1053
	mutex_lock(&local->sta_mtx);
1054
	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1055 1056
		if (sdata == sta->sdata ||
		    (vlans && sdata->bss == sta->sdata->bss)) {
1057 1058
			if (!WARN_ON(__sta_info_destroy_part1(sta)))
				list_add(&sta->free_list, &free_list);
1059 1060
			ret++;
		}
1061
	}
1062 1063 1064 1065 1066 1067

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

1070 1071 1072
	return ret;
}

1073 1074 1075 1076 1077 1078
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;

1079
	mutex_lock(&local->sta_mtx);
1080 1081

	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1082 1083 1084
		if (sdata != sta->sdata)
			continue;

1085
		if (time_after(jiffies, sta->rx_stats.last_rx + exp_time)) {
1086 1087
			sta_dbg(sta->sdata, "expiring inactive STA %pM\n",
				sta->sta.addr);
M
Marco Porsch 已提交
1088 1089 1090 1091 1092

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

1093
			WARN_ON(__sta_info_destroy(sta));
1094
		}
1095 1096
	}

1097
	mutex_unlock(&local->sta_mtx);
1098
}
1099

1100
struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
1101 1102
						   const u8 *addr,
						   const u8 *localaddr)
1103
{
1104 1105 1106 1107 1108 1109
	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);
1110

1111 1112 1113 1114
	/*
	 * Just return a random station if localaddr is NULL
	 * ... first in list.
	 */
1115
	for_each_sta_info(local, tbl, addr, sta, tmp) {
1116
		if (localaddr &&
1117
		    !ether_addr_equal(sta->sdata->vif.addr, localaddr))
1118
			continue;
1119 1120
		if (!sta->uploaded)
			return NULL;
1121
		return &sta->sta;
1122 1123
	}

1124
	return NULL;
1125
}
1126
EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
1127 1128 1129 1130

struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif,
					 const u8 *addr)
{
1131
	struct sta_info *sta;
1132 1133 1134 1135

	if (!vif)
		return NULL;

1136 1137 1138 1139 1140 1141
	sta = sta_info_get_bss(vif_to_sdata(vif), addr);
	if (!sta)
		return NULL;

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

1143
	return &sta->sta;
1144
}
1145
EXPORT_SYMBOL(ieee80211_find_sta);
1146

1147 1148
/* powersave support code */
void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta)
1149
{
1150
	struct ieee80211_sub_if_data *sdata = sta->sdata;
1151 1152
	struct ieee80211_local *local = sdata->local;
	struct sk_buff_head pending;
1153
	int filtered = 0, buffered = 0, ac, i;
1154
	unsigned long flags;
1155 1156
	struct ps_data *ps;

1157 1158 1159 1160 1161
	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)
1162
		ps = &sdata->bss->ps;
M
Marco Porsch 已提交
1163 1164
	else if (ieee80211_vif_is_mesh(&sdata->vif))
		ps = &sdata->u.mesh.ps;
1165 1166
	else
		return;
1167

J
Johannes Berg 已提交
1168
	clear_sta_flag(sta, WLAN_STA_SP);
J
Johannes Berg 已提交
1169

1170
	BUILD_BUG_ON(BITS_TO_LONGS(IEEE80211_NUM_TIDS) > 1);
1171
	sta->driver_buffered_tids = 0;
1172
	sta->txq_buffered_tids = 0;
1173

1174
	if (!ieee80211_hw_check(&local->hw, AP_LINK_PS))
1175
		drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta);
1176

1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187
	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);
		}
	}

1188
	skb_queue_head_init(&pending);
1189

1190 1191
	/* sync with ieee80211_tx_h_unicast_ps_buf */
	spin_lock(&sta->ps_lock);
1192
	/* Send all buffered frames to the station */
1193 1194 1195
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		int count = skb_queue_len(&pending), tmp;

1196
		spin_lock_irqsave(&sta->tx_filtered[ac].lock, flags);
1197
		skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending);
1198
		spin_unlock_irqrestore(&sta->tx_filtered[ac].lock, flags);
1199 1200 1201 1202
		tmp = skb_queue_len(&pending);
		filtered += tmp - count;
		count = tmp;

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

1210
	ieee80211_add_pending_skbs(local, &pending);
1211 1212 1213 1214 1215 1216 1217 1218 1219

	/* 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);
1220
	spin_unlock(&sta->ps_lock);
1221

1222 1223
	atomic_dec(&ps->num_sta_ps);

1224
	/* This station just woke up and isn't aware of our SMPS state */
1225 1226
	if (!ieee80211_vif_is_mesh(&sdata->vif) &&
	    !ieee80211_smps_is_restrictive(sta->known_smps_mode,
1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237
					   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);
	}

1238 1239
	local->total_ps_buffered -= buffered;

J
Johannes Berg 已提交
1240 1241
	sta_info_recalc_tim(sta);

J
Johannes Berg 已提交
1242 1243 1244
	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 已提交
1245 1246

	ieee80211_check_fast_xmit(sta);
1247 1248
}

1249
static void ieee80211_send_null_response(struct sta_info *sta, int tid,
1250
					 enum ieee80211_frame_release_type reason,
1251
					 bool call_driver, bool more_data)
1252
{
1253
	struct ieee80211_sub_if_data *sdata = sta->sdata;
1254
	struct ieee80211_local *local = sdata->local;
1255
	struct ieee80211_qos_hdr *nullfunc;
1256
	struct sk_buff *skb;
1257 1258
	int size = sizeof(*nullfunc);
	__le16 fc;
1259
	bool qos = sta->sta.wme;
1260
	struct ieee80211_tx_info *info;
J
Johannes Berg 已提交
1261
	struct ieee80211_chanctx_conf *chanctx_conf;
1262

1263 1264 1265 1266 1267 1268 1269 1270 1271
	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);
1272 1273
	}

1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285
	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);
1286
	nullfunc->seq_ctrl = 0;
1287

1288 1289
	skb->priority = tid;
	skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]);
1290 1291 1292
	if (qos) {
		nullfunc->qos_ctrl = cpu_to_le16(tid);

1293
		if (reason == IEEE80211_FRAME_RELEASE_UAPSD) {
1294 1295
			nullfunc->qos_ctrl |=
				cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
1296 1297 1298 1299
			if (more_data)
				nullfunc->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
		}
1300 1301 1302 1303 1304 1305 1306
	}

	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
1307 1308
	 * exchange. Also set EOSP to indicate this packet
	 * ends the poll/service period.
1309
	 */
1310
	info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER |
1311 1312
		       IEEE80211_TX_STATUS_EOSP |
		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1313

1314 1315
	info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;

1316 1317 1318
	if (call_driver)
		drv_allow_buffered_frames(local, sta, BIT(tid), 1,
					  reason, false);
1319

1320 1321
	skb->dev = sdata->dev;

J
Johannes Berg 已提交
1322 1323 1324 1325 1326 1327 1328 1329
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	if (WARN_ON(!chanctx_conf)) {
		rcu_read_unlock();
		kfree_skb(skb);
		return;
	}

1330
	info->band = chanctx_conf->def.chan->band;
1331
	ieee80211_xmit(sdata, sta, skb);
J
Johannes Berg 已提交
1332
	rcu_read_unlock();
1333 1334
}

1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345
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;
}

1346 1347 1348 1349 1350 1351 1352 1353 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
/* 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 已提交
1379
static void
1380 1381 1382 1383
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)
1384 1385 1386
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1387 1388
	int ac;

1389
	/* Get response frame(s) and more data bit for the last one. */
1390
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1391 1392
		unsigned long tids;

J
Johannes Berg 已提交
1393
		if (ignored_acs & BIT(ac))
1394 1395
			continue;

1396 1397
		tids = ieee80211_tids_for_ac(ac);

1398 1399 1400
		/* if we already have frames from software, then we can't also
		 * release from hardware queues
		 */
1401 1402 1403 1404
		if (skb_queue_empty(frames)) {
			*driver_release_tids |=
				sta->driver_buffered_tids & tids;
			*driver_release_tids |= sta->txq_buffered_tids & tids;
1405
		}
1406

1407
		if (!*driver_release_tids) {
1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420
			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--;
1421
				__skb_queue_tail(frames, skb);
1422
			}
1423
		}
1424

1425 1426 1427
		/* 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.
1428
		 */
1429
		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
1430
		    !skb_queue_empty(&sta->ps_tx_buf[ac]))
1431
			break;
1432
	}
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458
}

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);

	if (reason == IEEE80211_FRAME_RELEASE_PSPOLL)
		driver_release_tids =
			BIT(find_highest_prio_tid(driver_release_tids));
1459

1460
	if (skb_queue_empty(&frames) && !driver_release_tids) {
1461
		int tid;
1462 1463

		/*
1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475
		 * 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.
1476 1477
		 */

1478 1479
		/* This will evaluate to 1, 3, 5 or 7. */
		tid = 7 - ((ffs(~ignored_acs) - 1) << 1);
1480

1481
		ieee80211_send_null_response(sta, tid, reason, true, false);
1482
	} else if (!driver_release_tids) {
J
Johannes Berg 已提交
1483 1484
		struct sk_buff_head pending;
		struct sk_buff *skb;
1485 1486
		int num = 0;
		u16 tids = 0;
1487
		bool need_null = false;
1488

J
Johannes Berg 已提交
1489
		skb_queue_head_init(&pending);
1490

J
Johannes Berg 已提交
1491 1492 1493
		while ((skb = __skb_dequeue(&frames))) {
			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
			struct ieee80211_hdr *hdr = (void *) skb->data;
1494 1495 1496
			u8 *qoshdr = NULL;

			num++;
1497

J
Johannes Berg 已提交
1498 1499 1500 1501 1502
			/*
			 * Tell TX path to send this frame even though the
			 * STA may still remain is PS mode after this frame
			 * exchange.
			 */
1503 1504
			info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER;
			info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;
J
Johannes Berg 已提交
1505 1506 1507 1508 1509

			/*
			 * Use MoreData flag to indicate whether there are
			 * more buffered frames for this STA
			 */
1510
			if (more_data || !skb_queue_empty(&frames))
J
Johannes Berg 已提交
1511 1512
				hdr->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
1513 1514 1515
			else
				hdr->frame_control &=
					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
J
Johannes Berg 已提交
1516

1517 1518 1519 1520
			if (ieee80211_is_data_qos(hdr->frame_control) ||
			    ieee80211_is_qos_nullfunc(hdr->frame_control))
				qoshdr = ieee80211_get_qos_ctl(hdr);

1521
			tids |= BIT(skb->priority);
1522

1523 1524 1525 1526 1527 1528 1529 1530
			__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 */
1531 1532
				info->flags |= IEEE80211_TX_STATUS_EOSP |
					       IEEE80211_TX_CTL_REQ_TX_STATUS;
1533
				break;
1534
			}
1535

1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553
			/* 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;
1554

1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571
				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 已提交
1572
		}
1573

1574 1575 1576
		drv_allow_buffered_frames(local, sta, tids, num,
					  reason, more_data);

J
Johannes Berg 已提交
1577
		ieee80211_add_pending_skbs(local, &pending);
1578

1579 1580
		if (need_null)
			ieee80211_send_null_response(
1581 1582
				sta, find_highest_prio_tid(tids),
				reason, false, false);
1583

J
Johannes Berg 已提交
1584
		sta_info_recalc_tim(sta);
1585
	} else {
1586 1587 1588
		unsigned long tids = sta->txq_buffered_tids & driver_release_tids;
		int tid;

1589
		/*
1590 1591
		 * We need to release a frame that is buffered somewhere in the
		 * driver ... it'll have to handle that.
1592 1593 1594 1595 1596 1597
		 * 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.
1598 1599
		 */
		drv_release_buffered_frames(local, sta, driver_release_tids,
J
Johannes Berg 已提交
1600
					    n_frames, reason, more_data);
1601 1602 1603 1604

		/*
		 * 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
1605
		 * that the TID(s) became empty before returning here from the
1606
		 * release function.
1607
		 * Either way, however, when the driver tells us that the TID(s)
1608 1609
		 * became empty or we find that a txq became empty, we'll do the
		 * TIM recalculation.
1610
		 */
1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623

		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;
		}
1624 1625 1626
	}
}

J
Johannes Berg 已提交
1627 1628 1629 1630 1631 1632 1633 1634 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
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? */
1669
		n_frames = 128;
J
Johannes Berg 已提交
1670 1671 1672 1673 1674 1675 1676
		break;
	}

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

1677 1678 1679 1680 1681
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 已提交
1682 1683
	trace_api_sta_block_awake(sta->local, pubsta, block);

1684
	if (block) {
J
Johannes Berg 已提交
1685
		set_sta_flag(sta, WLAN_STA_PS_DRIVER);
J
Johannes Berg 已提交
1686
		ieee80211_clear_fast_xmit(sta);
1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703
		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 已提交
1704
		ieee80211_check_fast_xmit(sta);
1705
	}
1706 1707
}
EXPORT_SYMBOL(ieee80211_sta_block_awake);
1708

1709
void ieee80211_sta_eosp(struct ieee80211_sta *pubsta)
1710 1711 1712 1713 1714 1715
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
	struct ieee80211_local *local = sta->local;

	trace_api_eosp(local, pubsta);

1716
	clear_sta_flag(sta, WLAN_STA_SP);
1717
}
1718
EXPORT_SYMBOL(ieee80211_sta_eosp);
1719

1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735
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);

1736 1737
void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta,
				u8 tid, bool buffered)
1738 1739 1740
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);

1741
	if (WARN_ON(tid >= IEEE80211_NUM_TIDS))
1742 1743
		return;

1744 1745
	trace_api_sta_set_buffered(sta->local, pubsta, tid, buffered);

1746 1747 1748 1749 1750
	if (buffered)
		set_bit(tid, &sta->driver_buffered_tids);
	else
		clear_bit(tid, &sta->driver_buffered_tids);

J
Johannes Berg 已提交
1751
	sta_info_recalc_tim(sta);
1752
}
1753
EXPORT_SYMBOL(ieee80211_sta_set_buffered);
1754

1755 1756
int sta_info_move_state(struct sta_info *sta,
			enum ieee80211_sta_state new_state)
1757
{
1758
	might_sleep();
1759 1760 1761 1762

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

J
Johannes Berg 已提交
1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788
	/* 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 已提交
1789 1790
	sta_dbg(sta->sdata, "moving STA %pM to state %d\n",
		sta->sta.addr, new_state);
J
Johannes Berg 已提交
1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804

	/*
	 * 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 */

1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816
	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:
		if (sta->sta_state == IEEE80211_STA_NONE)
			set_bit(WLAN_STA_AUTH, &sta->_flags);
		else if (sta->sta_state == IEEE80211_STA_ASSOC)
			clear_bit(WLAN_STA_ASSOC, &sta->_flags);
		break;
	case IEEE80211_STA_ASSOC:
1817
		if (sta->sta_state == IEEE80211_STA_AUTH) {
1818
			set_bit(WLAN_STA_ASSOC, &sta->_flags);
1819
		} else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) {
1820 1821 1822 1823
			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);
1824
			clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1825
			ieee80211_clear_fast_xmit(sta);
J
Johannes Berg 已提交
1826
		}
1827 1828
		break;
	case IEEE80211_STA_AUTHORIZED:
1829
		if (sta->sta_state == IEEE80211_STA_ASSOC) {
1830 1831 1832 1833
			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);
1834
			set_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1835
			ieee80211_check_fast_xmit(sta);
J
Johannes Berg 已提交
1836
		}
1837 1838
		break;
	default:
J
Johannes Berg 已提交
1839
		break;
1840 1841 1842 1843 1844 1845
	}

	sta->sta_state = new_state;

	return 0;
}
1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880

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;
}
1881

1882 1883 1884 1885
static void sta_set_rate_info_rx(struct sta_info *sta, struct rate_info *rinfo)
{
	rinfo->flags = 0;

1886
	if (sta->rx_stats.last_rate_flag & RX_FLAG_HT) {
1887
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
1888 1889
		rinfo->mcs = sta->rx_stats.last_rate_idx;
	} else if (sta->rx_stats.last_rate_flag & RX_FLAG_VHT) {
1890
		rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
1891 1892
		rinfo->nss = sta->rx_stats.last_rate_vht_nss;
		rinfo->mcs = sta->rx_stats.last_rate_idx;
1893 1894 1895 1896 1897 1898 1899
	} 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)];
1900
		brate = sband->bitrates[sta->rx_stats.last_rate_idx].bitrate;
1901 1902 1903
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
	}

1904
	if (sta->rx_stats.last_rate_flag & RX_FLAG_SHORT_GI)
1905 1906
		rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;

1907
	if (sta->rx_stats.last_rate_flag & RX_FLAG_5MHZ)
1908
		rinfo->bw = RATE_INFO_BW_5;
1909
	else if (sta->rx_stats.last_rate_flag & RX_FLAG_10MHZ)
1910
		rinfo->bw = RATE_INFO_BW_10;
1911
	else if (sta->rx_stats.last_rate_flag & RX_FLAG_40MHZ)
1912
		rinfo->bw = RATE_INFO_BW_40;
1913
	else if (sta->rx_stats.last_rate_vht_flag & RX_VHT_FLAG_80MHZ)
1914
		rinfo->bw = RATE_INFO_BW_80;
1915
	else if (sta->rx_stats.last_rate_vht_flag & RX_VHT_FLAG_160MHZ)
1916 1917 1918 1919 1920
		rinfo->bw = RATE_INFO_BW_160;
	else
		rinfo->bw = RATE_INFO_BW_20;
}

1921 1922 1923 1924
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;
1925
	struct rate_control_ref *ref = NULL;
1926 1927 1928
	u32 thr = 0;
	int i, ac;

1929 1930 1931
	if (test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
		ref = local->rate_ctrl;

1932 1933
	sinfo->generation = sdata->local->sta_generation;

1934 1935 1936 1937 1938 1939 1940
	/* 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;

1941 1942
	drv_sta_statistics(local, sdata, &sta->sta, sinfo);

1943 1944 1945 1946
	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) |
1947 1948 1949 1950 1951 1952
			 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);
	}
1953

A
Arnd Bergmann 已提交
1954
	sinfo->connected_time = ktime_get_seconds() - sta->last_connected;
1955 1956
	sinfo->inactive_time =
		jiffies_to_msecs(jiffies - sta->rx_stats.last_rx);
1957

1958 1959
	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES64) |
			       BIT(NL80211_STA_INFO_TX_BYTES)))) {
1960 1961
		sinfo->tx_bytes = 0;
		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
1962
			sinfo->tx_bytes += sta->tx_stats.bytes[ac];
1963
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64);
1964 1965
	}

1966
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_PACKETS))) {
1967 1968
		sinfo->tx_packets = 0;
		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
1969
			sinfo->tx_packets += sta->tx_stats.packets[ac];
1970
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS);
1971 1972
	}

1973 1974
	if (!(sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES64) |
			       BIT(NL80211_STA_INFO_RX_BYTES)))) {
1975
		sinfo->rx_bytes = sta->rx_stats.bytes;
1976
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64);
1977 1978
	}

1979
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_PACKETS))) {
1980
		sinfo->rx_packets = sta->rx_stats.packets;
1981
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS);
1982 1983
	}

1984
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_RETRIES))) {
1985
		sinfo->tx_retries = sta->status_stats.retry_count;
1986
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_RETRIES);
1987 1988
	}

1989
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_FAILED))) {
1990
		sinfo->tx_failed = sta->status_stats.retry_failed;
1991
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_FAILED);
1992
	}
1993

1994
	sinfo->rx_dropped_misc = sta->rx_stats.dropped;
1995

1996 1997 1998 1999 2000 2001 2002
	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);
	}

2003 2004
	if (ieee80211_hw_check(&sta->local->hw, SIGNAL_DBM) ||
	    ieee80211_hw_check(&sta->local->hw, SIGNAL_UNSPEC)) {
2005
		if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL))) {
2006
			sinfo->signal = (s8)sta->rx_stats.last_signal;
2007
			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL);
2008 2009
		}

2010
		if (!(sinfo->filled & BIT(NL80211_STA_INFO_SIGNAL_AVG))) {
J
Johannes Berg 已提交
2011
			sinfo->signal_avg =
2012
				-ewma_signal_read(&sta->rx_stats.avg_signal);
2013
			sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL_AVG);
2014
		}
2015
	}
2016

2017
	if (sta->rx_stats.chains &&
2018 2019 2020 2021
	    !(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);
2022

2023
		sinfo->chains = sta->rx_stats.chains;
2024
		for (i = 0; i < ARRAY_SIZE(sinfo->chain_signal); i++) {
2025 2026
			sinfo->chain_signal[i] =
				sta->rx_stats.chain_signal_last[i];
2027
			sinfo->chain_signal_avg[i] =
2028
				-ewma_signal_read(&sta->rx_stats.chain_signal_avg[i]);
2029 2030 2031
		}
	}

2032
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE))) {
2033 2034
		sta_set_rate_info_tx(sta, &sta->tx_stats.last_rate,
				     &sinfo->txrate);
2035
		sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE);
2036 2037
	}

2038
	if (!(sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE))) {
2039
		sta_set_rate_info_rx(sta, &sinfo->rxrate);
2040
		sinfo->filled |= BIT(NL80211_STA_INFO_RX_BITRATE);
2041
	}
2042

2043 2044 2045 2046 2047 2048
	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);
2049
			tidstats->rx_msdu = sta->rx_stats.msdu[i];
2050 2051 2052 2053
		}

		if (!(tidstats->filled & BIT(NL80211_TID_STATS_TX_MSDU))) {
			tidstats->filled |= BIT(NL80211_TID_STATS_TX_MSDU);
2054
			tidstats->tx_msdu = sta->tx_stats.msdu[i];
2055 2056 2057 2058
		}

		if (!(tidstats->filled &
				BIT(NL80211_TID_STATS_TX_MSDU_RETRIES)) &&
2059
		    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
2060 2061
			tidstats->filled |=
				BIT(NL80211_TID_STATS_TX_MSDU_RETRIES);
2062 2063
			tidstats->tx_msdu_retries =
				sta->status_stats.msdu_retries[i];
2064 2065 2066 2067
		}

		if (!(tidstats->filled &
				BIT(NL80211_TID_STATS_TX_MSDU_FAILED)) &&
2068
		    ieee80211_hw_check(&local->hw, REPORTS_TX_ACK_STATUS)) {
2069 2070
			tidstats->filled |=
				BIT(NL80211_TID_STATS_TX_MSDU_FAILED);
2071 2072
			tidstats->tx_msdu_failed =
				sta->status_stats.msdu_failed[i];
2073 2074 2075
		}
	}

2076 2077
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
#ifdef CONFIG_MAC80211_MESH
2078 2079 2080 2081 2082 2083
		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);
2084

2085 2086 2087
		sinfo->llid = sta->mesh->llid;
		sinfo->plid = sta->mesh->plid;
		sinfo->plink_state = sta->mesh->plink_state;
2088
		if (test_sta_flag(sta, WLAN_STA_TOFFSET_KNOWN)) {
2089
			sinfo->filled |= BIT(NL80211_STA_INFO_T_OFFSET);
2090
			sinfo->t_offset = sta->mesh->t_offset;
2091
		}
2092 2093 2094
		sinfo->local_pm = sta->mesh->local_pm;
		sinfo->peer_pm = sta->mesh->peer_pm;
		sinfo->nonpeer_pm = sta->mesh->nonpeer_pm;
2095 2096 2097 2098 2099 2100 2101 2102 2103 2104
#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;
2105
	sinfo->bss_param.dtim_period = sdata->vif.bss_conf.dtim_period;
2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119
	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);
2120
	if (sta->sta.wme)
2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137
		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) {
2138
		sinfo->filled |= BIT(NL80211_STA_INFO_EXPECTED_THROUGHPUT);
2139 2140 2141
		sinfo->expected_throughput = thr;
	}
}