sta_info.c 57.3 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 510 511
	sinfo = kzalloc(sizeof(struct station_info), GFP_KERNEL);
	if (!sinfo) {
		err = -ENOMEM;
		goto out_err;
	}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

573 574
	might_sleep();

575 576
	mutex_lock(&local->sta_mtx);

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

584
	err = sta_info_insert_finish(sta);
585 586 587
	if (err)
		goto out_free;

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

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

	rcu_read_unlock();

	return err;
}

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

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

621 622 623 624 625 626 627 628 629
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));
}

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

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

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

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

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

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

678 679 680 681 682 683 684 685 686
	/*
	 * 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;

687 688 689
	if (ignore_pending)
		ignore_for_tim = BIT(IEEE80211_NUM_ACS) - 1;

690 691
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		unsigned long tids;
692

693 694 695 696 697 698 699
		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;
700

701 702 703 704
		tids = ieee80211_tids_for_ac(ac);

		indicate_tim |=
			sta->driver_buffered_tids & tids;
705 706
		indicate_tim |=
			sta->txq_buffered_tids & tids;
707
	}
708

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

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

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

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

726
out_unlock:
727
	spin_unlock_bh(&local->tim_lock);
728 729
}

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

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

	if (!skb)
741
		return false;
742

743
	info = IEEE80211_SKB_CB(skb);
744 745

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


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

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

		/*
		 * 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;
785
		ieee80211_free_txskb(&local->hw, skb);
786 787 788 789 790 791 792 793
	}

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

803 804 805 806 807
		/*
		 * 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
		 */
808
		if (!skb)
809
			break;
810 811

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

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

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

	return have_buffered;
849 850
}

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

857
	might_sleep();
858

859 860
	if (!sta)
		return -ENOENT;
861

862 863
	local = sta->local;
	sdata = sta->sdata;
864

865 866
	lockdep_assert_held(&local->sta_mtx);

867 868 869 870 871 872
	/*
	 * 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 已提交
873
	set_sta_flag(sta, WLAN_STA_BLOCK_BA);
874
	ieee80211_sta_tear_down_BA_sessions(sta, AGG_STOP_DESTROY_STA);
875

876
	ret = sta_info_hash_del(local, sta);
877
	if (WARN_ON(ret))
878 879
		return ret;

880 881 882 883 884 885 886 887 888
	/*
	 * 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);
	}

889
	list_del_rcu(&sta->list);
890
	sta->removed = true;
891

892 893
	drv_sta_pre_rcu_remove(local, sta->sdata, sta);

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

898 899 900 901 902 903 904
	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;
905
	struct station_info *sinfo;
906 907 908 909 910 911 912 913 914 915
	int ret;

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

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

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

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

922 923 924 925 926
	sta->dead = true;

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

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

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

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

943 944 945 946 947
	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);
948

949 950 951
	rate_control_remove_sta_debugfs(sta);
	ieee80211_sta_debugfs_remove(sta);

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

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

	return 0;
J
Jiri Slaby 已提交
967 968
}

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

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

	return ret;
}

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

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

993 994
	return ret;
}
J
Jiri Benc 已提交
995

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

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

1008 1009
	if (local->quiescing)
		return;
1010

1011 1012 1013
	if (!timer_needed)
		return;

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

1018
u32 sta_addr_hash(const void *key, u32 length, u32 seed)
1019
{
1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030
	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;

1031
	spin_lock_init(&local->tim_lock);
1032
	mutex_init(&local->sta_mtx);
1033 1034
	INIT_LIST_HEAD(&local->sta_list);

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

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

1046

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

1054
	might_sleep();
1055

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

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

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

1076 1077 1078
	return ret;
}

1079 1080 1081 1082 1083 1084
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;

1085
	mutex_lock(&local->sta_mtx);
1086 1087

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

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

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

1099
			WARN_ON(__sta_info_destroy(sta));
1100
		}
1101 1102
	}

1103
	mutex_unlock(&local->sta_mtx);
1104
}
1105

1106
struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
1107 1108
						   const u8 *addr,
						   const u8 *localaddr)
1109
{
1110 1111 1112 1113 1114 1115
	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);
1116

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

1130
	return NULL;
1131
}
1132
EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
1133 1134 1135 1136

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

	if (!vif)
		return NULL;

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

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

1149
	return &sta->sta;
1150
}
1151
EXPORT_SYMBOL(ieee80211_find_sta);
1152

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

1163 1164 1165 1166 1167
	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)
1168
		ps = &sdata->bss->ps;
M
Marco Porsch 已提交
1169 1170
	else if (ieee80211_vif_is_mesh(&sdata->vif))
		ps = &sdata->u.mesh.ps;
1171 1172
	else
		return;
1173

J
Johannes Berg 已提交
1174
	clear_sta_flag(sta, WLAN_STA_SP);
J
Johannes Berg 已提交
1175

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

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

1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193
	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);
		}
	}

1194
	skb_queue_head_init(&pending);
1195

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

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

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

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

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

1228 1229
	atomic_dec(&ps->num_sta_ps);

1230
	/* This station just woke up and isn't aware of our SMPS state */
1231 1232
	if (!ieee80211_vif_is_mesh(&sdata->vif) &&
	    !ieee80211_smps_is_restrictive(sta->known_smps_mode,
1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243
					   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);
	}

1244 1245
	local->total_ps_buffered -= buffered;

J
Johannes Berg 已提交
1246 1247
	sta_info_recalc_tim(sta);

J
Johannes Berg 已提交
1248 1249 1250
	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 已提交
1251 1252

	ieee80211_check_fast_xmit(sta);
1253 1254
}

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

1269 1270 1271 1272 1273 1274 1275 1276 1277
	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);
1278 1279
	}

1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291
	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);
1292
	nullfunc->seq_ctrl = 0;
1293

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

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

	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
1313 1314
	 * exchange. Also set EOSP to indicate this packet
	 * ends the poll/service period.
1315
	 */
1316
	info->flags |= IEEE80211_TX_CTL_NO_PS_BUFFER |
1317 1318
		       IEEE80211_TX_STATUS_EOSP |
		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1319

1320 1321
	info->control.flags |= IEEE80211_TX_CTRL_PS_RESPONSE;

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

1326 1327
	skb->dev = sdata->dev;

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

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

1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
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;
}

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 1379 1380 1381 1382 1383 1384
/* 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 已提交
1385
static void
1386 1387 1388 1389
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)
1390 1391 1392
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1393 1394
	int ac;

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

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

1402 1403
		tids = ieee80211_tids_for_ac(ac);

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

1413
		if (!*driver_release_tids) {
1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
			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--;
1427
				__skb_queue_tail(frames, skb);
1428
			}
1429
		}
1430

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

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

1466
	if (skb_queue_empty(&frames) && !driver_release_tids) {
1467
		int tid;
1468 1469

		/*
1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481
		 * 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.
1482 1483
		 */

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

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

J
Johannes Berg 已提交
1495
		skb_queue_head_init(&pending);
1496

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

			num++;
1503

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

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

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

1527
			tids |= BIT(skb->priority);
1528

1529 1530 1531 1532 1533 1534 1535 1536
			__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 */
1537 1538
				info->flags |= IEEE80211_TX_STATUS_EOSP |
					       IEEE80211_TX_CTL_REQ_TX_STATUS;
1539
				break;
1540
			}
1541

1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559
			/* 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;
1560

1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577
				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 已提交
1578
		}
1579

1580 1581 1582
		drv_allow_buffered_frames(local, sta, tids, num,
					  reason, more_data);

J
Johannes Berg 已提交
1583
		ieee80211_add_pending_skbs(local, &pending);
1584

1585 1586
		if (need_null)
			ieee80211_send_null_response(
1587 1588
				sta, find_highest_prio_tid(tids),
				reason, false, false);
1589

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

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

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

		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;
		}
1630 1631 1632
	}
}

J
Johannes Berg 已提交
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 1669 1670 1671 1672 1673 1674
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? */
1675
		n_frames = 128;
J
Johannes Berg 已提交
1676 1677 1678 1679 1680 1681 1682
		break;
	}

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

1683 1684 1685 1686 1687
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 已提交
1688 1689
	trace_api_sta_block_awake(sta->local, pubsta, block);

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

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

	trace_api_eosp(local, pubsta);

1722
	clear_sta_flag(sta, WLAN_STA_SP);
1723
}
1724
EXPORT_SYMBOL(ieee80211_sta_eosp);
1725

1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741
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);

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

1747
	if (WARN_ON(tid >= IEEE80211_NUM_TIDS))
1748 1749
		return;

1750 1751
	trace_api_sta_set_buffered(sta->local, pubsta, tid, buffered);

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

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

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

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

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

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

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:
1817
		if (sta->sta_state == IEEE80211_STA_NONE) {
1818
			set_bit(WLAN_STA_AUTH, &sta->_flags);
1819
		} else if (sta->sta_state == IEEE80211_STA_ASSOC) {
1820
			clear_bit(WLAN_STA_ASSOC, &sta->_flags);
1821 1822
			ieee80211_recalc_min_chandef(sta->sdata);
		}
1823 1824
		break;
	case IEEE80211_STA_ASSOC:
1825
		if (sta->sta_state == IEEE80211_STA_AUTH) {
1826
			set_bit(WLAN_STA_ASSOC, &sta->_flags);
1827
			ieee80211_recalc_min_chandef(sta->sdata);
1828
		} else if (sta->sta_state == IEEE80211_STA_AUTHORIZED) {
1829 1830 1831 1832
			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);
1833
			clear_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1834
			ieee80211_clear_fast_xmit(sta);
J
Johannes Berg 已提交
1835
		}
1836 1837
		break;
	case IEEE80211_STA_AUTHORIZED:
1838
		if (sta->sta_state == IEEE80211_STA_ASSOC) {
1839 1840 1841 1842
			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);
1843
			set_bit(WLAN_STA_AUTHORIZED, &sta->_flags);
J
Johannes Berg 已提交
1844
			ieee80211_check_fast_xmit(sta);
J
Johannes Berg 已提交
1845
		}
1846 1847
		break;
	default:
J
Johannes Berg 已提交
1848
		break;
1849 1850 1851 1852 1853 1854
	}

	sta->sta_state = new_state;

	return 0;
}
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 1881 1882 1883 1884 1885 1886 1887 1888 1889

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

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

1895
	if (sta->rx_stats.last_rate_flag & RX_FLAG_HT) {
1896
		rinfo->flags |= RATE_INFO_FLAGS_MCS;
1897 1898
		rinfo->mcs = sta->rx_stats.last_rate_idx;
	} else if (sta->rx_stats.last_rate_flag & RX_FLAG_VHT) {
1899
		rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
1900 1901
		rinfo->nss = sta->rx_stats.last_rate_vht_nss;
		rinfo->mcs = sta->rx_stats.last_rate_idx;
1902 1903 1904 1905 1906 1907 1908
	} 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)];
1909
		brate = sband->bitrates[sta->rx_stats.last_rate_idx].bitrate;
1910 1911 1912
		rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
	}

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

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

1930 1931 1932 1933
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;
1934
	struct rate_control_ref *ref = NULL;
1935 1936 1937
	u32 thr = 0;
	int i, ac;

1938 1939 1940
	if (test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
		ref = local->rate_ctrl;

1941 1942
	sinfo->generation = sdata->local->sta_generation;

1943 1944 1945 1946 1947 1948 1949
	/* 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;

1950 1951
	drv_sta_statistics(local, sdata, &sta->sta, sinfo);

1952 1953 1954 1955
	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) |
1956 1957 1958 1959 1960 1961
			 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);
	}
1962

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

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

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

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

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

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

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

2003
	sinfo->rx_dropped_misc = sta->rx_stats.dropped;
2004

2005 2006 2007 2008 2009 2010 2011
	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);
	}

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

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

2026
	if (sta->rx_stats.chains &&
2027 2028 2029 2030
	    !(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);
2031

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

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

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

2052 2053 2054 2055 2056 2057
	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);
2058
			tidstats->rx_msdu = sta->rx_stats.msdu[i];
2059 2060 2061 2062
		}

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

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

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

2085 2086
	if (ieee80211_vif_is_mesh(&sdata->vif)) {
#ifdef CONFIG_MAC80211_MESH
2087 2088 2089 2090 2091 2092
		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);
2093

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