sta_info.c 39.4 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * Copyright 2002-2005, Instant802 Networks, Inc.
 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
 *
 * 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>
#include <linux/netdevice.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/skbuff.h>
#include <linux/if_arp.h>
17
#include <linux/timer.h>
18
#include <linux/rtnetlink.h>
19 20 21

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

29 30 31 32 33 34 35
/**
 * 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.
 *
36 37 38 39 40 41 42 43
 * 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.
44 45 46
 *
 * When the insertion fails (sta_info_insert()) returns non-zero), the
 * structure will have been freed by sta_info_insert()!
47
 *
48
 * Station entries are added by mac80211 when you establish a link with a
49 50
 * 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 已提交
51
 * receive an association response from the AP. For IBSS this occurs when
52
 * get to know about a peer on the same IBSS. For WDS we add the sta for
L
Lucas De Marchi 已提交
53
 * the peer immediately upon device open. When using AP mode we add stations
54
 * for each respective station upon request from userspace through nl80211.
55
 *
56 57
 * In order to remove a STA info structure, various sta_info_destroy_*()
 * calls are available.
58
 *
59 60 61 62
 * 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.
63
 */
64 65

/* Caller must hold local->sta_lock */
66 67
static int sta_info_hash_del(struct ieee80211_local *local,
			     struct sta_info *sta)
68 69 70
{
	struct sta_info *s;

J
Johannes Berg 已提交
71 72
	s = rcu_dereference_protected(local->sta_hash[STA_HASH(sta->sta.addr)],
				      lockdep_is_held(&local->sta_lock));
73
	if (!s)
74 75
		return -ENOENT;
	if (s == sta) {
76
		RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)],
77
				   s->hnext);
78
		return 0;
79 80
	}

J
Johannes Berg 已提交
81 82 83 84 85
	while (rcu_access_pointer(s->hnext) &&
	       rcu_access_pointer(s->hnext) != sta)
		s = rcu_dereference_protected(s->hnext,
					lockdep_is_held(&local->sta_lock));
	if (rcu_access_pointer(s->hnext)) {
86
		RCU_INIT_POINTER(s->hnext, sta->hnext);
87 88
		return 0;
	}
89

90
	return -ENOENT;
91 92
}

93
/* protected by RCU */
94 95
struct sta_info *sta_info_get(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
96
{
97
	struct ieee80211_local *local = sdata->local;
98 99
	struct sta_info *sta;

100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120
	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
				    lockdep_is_held(&local->sta_lock) ||
				    lockdep_is_held(&local->sta_mtx));
	while (sta) {
		if (sta->sdata == sdata && !sta->dummy &&
		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
			break;
		sta = rcu_dereference_check(sta->hnext,
					    lockdep_is_held(&local->sta_lock) ||
					    lockdep_is_held(&local->sta_mtx));
	}
	return sta;
}

/* get a station info entry even if it is a dummy station*/
struct sta_info *sta_info_get_rx(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
{
	struct ieee80211_local *local = sdata->local;
	struct sta_info *sta;

121 122 123
	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
				    lockdep_is_held(&local->sta_lock) ||
				    lockdep_is_held(&local->sta_mtx));
124
	while (sta) {
125 126
		if (sta->sdata == sdata &&
		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
127
			break;
128 129 130
		sta = rcu_dereference_check(sta->hnext,
					    lockdep_is_held(&local->sta_lock) ||
					    lockdep_is_held(&local->sta_mtx));
131
	}
132 133 134
	return sta;
}

135 136 137 138 139 140 141 142 143 144
/*
 * 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;

145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170
	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
				    lockdep_is_held(&local->sta_lock) ||
				    lockdep_is_held(&local->sta_mtx));
	while (sta) {
		if ((sta->sdata == sdata ||
		     (sta->sdata->bss && sta->sdata->bss == sdata->bss)) &&
		    !sta->dummy &&
		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
			break;
		sta = rcu_dereference_check(sta->hnext,
					    lockdep_is_held(&local->sta_lock) ||
					    lockdep_is_held(&local->sta_mtx));
	}
	return sta;
}

/*
 * Get sta info either from the specified interface
 * or from one of its vlans (including dummy stations)
 */
struct sta_info *sta_info_get_bss_rx(struct ieee80211_sub_if_data *sdata,
				  const u8 *addr)
{
	struct ieee80211_local *local = sdata->local;
	struct sta_info *sta;

171 172 173
	sta = rcu_dereference_check(local->sta_hash[STA_HASH(addr)],
				    lockdep_is_held(&local->sta_lock) ||
				    lockdep_is_held(&local->sta_mtx));
174 175
	while (sta) {
		if ((sta->sdata == sdata ||
176
		     (sta->sdata->bss && sta->sdata->bss == sdata->bss)) &&
177 178
		    memcmp(sta->sta.addr, addr, ETH_ALEN) == 0)
			break;
179 180 181
		sta = rcu_dereference_check(sta->hnext,
					    lockdep_is_held(&local->sta_lock) ||
					    lockdep_is_held(&local->sta_mtx));
182 183 184 185
	}
	return sta;
}

186 187
struct sta_info *sta_info_get_by_idx(struct ieee80211_sub_if_data *sdata,
				     int idx)
188
{
189
	struct ieee80211_local *local = sdata->local;
190 191 192
	struct sta_info *sta;
	int i = 0;

193
	list_for_each_entry_rcu(sta, &local->sta_list, list) {
194
		if (sdata != sta->sdata)
195
			continue;
196 197 198 199
		if (i < idx) {
			++i;
			continue;
		}
200
		return sta;
201 202 203 204
	}

	return NULL;
}
205

206 207 208
/**
 * __sta_info_free - internal STA free helper
 *
R
Randy Dunlap 已提交
209
 * @local: pointer to the global information
210 211 212 213 214 215 216 217
 * @sta: STA info to free
 *
 * This function must undo everything done by sta_info_alloc()
 * that may happen before sta_info_insert().
 */
static void __sta_info_free(struct ieee80211_local *local,
			    struct sta_info *sta)
{
218 219 220 221
	if (sta->rate_ctrl) {
		rate_control_free_sta(sta);
		rate_control_put(sta->rate_ctrl);
	}
222 223

#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
J
Joe Perches 已提交
224
	wiphy_debug(local->hw.wiphy, "Destroyed STA %pM\n", sta->sta.addr);
225 226 227 228 229
#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */

	kfree(sta);
}

230 231 232
/* Caller must hold local->sta_lock */
static void sta_info_hash_add(struct ieee80211_local *local,
			      struct sta_info *sta)
233
{
234
	sta->hnext = local->sta_hash[STA_HASH(sta->sta.addr)];
235
	RCU_INIT_POINTER(local->sta_hash[STA_HASH(sta->sta.addr)], sta);
236 237
}

238 239 240 241 242 243 244 245 246
static void sta_unblock(struct work_struct *wk)
{
	struct sta_info *sta;

	sta = container_of(wk, struct sta_info, drv_unblock_wk);

	if (sta->dead)
		return;

J
Johannes Berg 已提交
247
	if (!test_sta_flag(sta, WLAN_STA_PS_STA))
248
		ieee80211_sta_ps_deliver_wakeup(sta);
J
Johannes Berg 已提交
249 250
	else if (test_and_clear_sta_flag(sta, WLAN_STA_PSPOLL)) {
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
251 252

		local_bh_disable();
253
		ieee80211_sta_ps_deliver_poll_response(sta);
254
		local_bh_enable();
J
Johannes Berg 已提交
255 256
	} else if (test_and_clear_sta_flag(sta, WLAN_STA_UAPSD)) {
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
257 258

		local_bh_disable();
J
Johannes Berg 已提交
259
		ieee80211_sta_ps_deliver_uapsd(sta);
260
		local_bh_enable();
261
	} else
J
Johannes Berg 已提交
262
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
263 264
}

265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281
static int sta_prepare_rate_control(struct ieee80211_local *local,
				    struct sta_info *sta, gfp_t gfp)
{
	if (local->hw.flags & IEEE80211_HW_HAS_RATE_CONTROL)
		return 0;

	sta->rate_ctrl = rate_control_get(local->rate_ctrl);
	sta->rate_ctrl_priv = rate_control_alloc_sta(sta->rate_ctrl,
						     &sta->sta, gfp);
	if (!sta->rate_ctrl_priv) {
		rate_control_put(sta->rate_ctrl);
		return -ENOMEM;
	}

	return 0;
}

J
Johannes Berg 已提交
282 283
struct sta_info *sta_info_alloc(struct ieee80211_sub_if_data *sdata,
				u8 *addr, gfp_t gfp)
284
{
285
	struct ieee80211_local *local = sdata->local;
286
	struct sta_info *sta;
287
	struct timespec uptime;
288
	int i;
289

290
	sta = kzalloc(sizeof(*sta) + local->hw.sta_data_size, gfp);
291
	if (!sta)
J
Johannes Berg 已提交
292
		return NULL;
293

294
	spin_lock_init(&sta->lock);
295
	INIT_WORK(&sta->drv_unblock_wk, sta_unblock);
J
Johannes Berg 已提交
296
	INIT_WORK(&sta->ampdu_mlme.work, ieee80211_ba_session_work);
297
	mutex_init(&sta->ampdu_mlme.mtx);
298

299
	memcpy(sta->sta.addr, addr, ETH_ALEN);
300 301
	sta->local = local;
	sta->sdata = sdata;
302
	sta->last_rx = jiffies;
303

304 305
	do_posix_clock_monotonic_gettime(&uptime);
	sta->last_connected = uptime.tv_sec;
306 307
	ewma_init(&sta->avg_signal, 1024, 8);

308
	if (sta_prepare_rate_control(local, sta, gfp)) {
309
		kfree(sta);
J
Johannes Berg 已提交
310
		return NULL;
311 312
	}

313
	for (i = 0; i < STA_TID_NUM; i++) {
314 315 316 317 318
		/*
		 * 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.
		 */
319 320
		sta->timer_to_tid[i] = i;
	}
321 322 323 324
	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 已提交
325

326
	for (i = 0; i < NUM_RX_DATA_QUEUES; i++)
327
		sta->last_seq_ctrl[i] = cpu_to_le16(USHRT_MAX);
328

J
Johannes Berg 已提交
329
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
J
Joe Perches 已提交
330
	wiphy_debug(local->hw.wiphy, "Allocated STA %pM\n", sta->sta.addr);
J
Johannes Berg 已提交
331 332
#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */

333
#ifdef CONFIG_MAC80211_MESH
334
	sta->plink_state = NL80211_PLINK_LISTEN;
335 336 337
	init_timer(&sta->plink_timer);
#endif

J
Johannes Berg 已提交
338 339 340
	return sta;
}

341 342
static int sta_info_finish_insert(struct sta_info *sta,
				bool async, bool dummy_reinsert)
J
Johannes Berg 已提交
343 344 345
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
346
	struct station_info sinfo;
J
Johannes Berg 已提交
347
	unsigned long flags;
348
	int err = 0;
J
Johannes Berg 已提交
349

350
	lockdep_assert_held(&local->sta_mtx);
351

352 353 354 355 356 357 358 359 360 361 362
	if (!sta->dummy || dummy_reinsert) {
		/* notify driver */
		err = drv_sta_add(local, sdata, &sta->sta);
		if (err) {
			if (!async)
				return err;
			printk(KERN_DEBUG "%s: failed to add IBSS STA %pM to "
					  "driver (%d) - keeping it anyway.\n",
			       sdata->name, sta->sta.addr, err);
		} else {
			sta->uploaded = true;
363
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
364 365 366 367
			if (async)
				wiphy_debug(local->hw.wiphy,
					    "Finished adding IBSS STA %pM\n",
					    sta->sta.addr);
368
#endif
369 370 371
		}

		sdata = sta->sdata;
372 373
	}

374 375 376 377 378
	if (!dummy_reinsert) {
		if (!async) {
			local->num_sta++;
			local->sta_generation++;
			smp_mb();
379

380 381 382 383 384
			/* make the station visible */
			spin_lock_irqsave(&local->sta_lock, flags);
			sta_info_hash_add(local, sta);
			spin_unlock_irqrestore(&local->sta_lock, flags);
		}
385

386 387 388
		list_add(&sta->list, &local->sta_list);
	} else {
		sta->dummy = false;
389 390
	}

391 392 393
	if (!sta->dummy) {
		ieee80211_sta_debugfs_add(sta);
		rate_control_add_sta_debugfs(sta);
394

395 396 397 398 399
		memset(&sinfo, 0, sizeof(sinfo));
		sinfo.filled = 0;
		sinfo.generation = local->sta_generation;
		cfg80211_new_sta(sdata->dev, sta->sta.addr, &sinfo, GFP_KERNEL);
	}
400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415

	return 0;
}

static void sta_info_finish_pending(struct ieee80211_local *local)
{
	struct sta_info *sta;
	unsigned long flags;

	spin_lock_irqsave(&local->sta_lock, flags);
	while (!list_empty(&local->sta_pending_list)) {
		sta = list_first_entry(&local->sta_pending_list,
				       struct sta_info, list);
		list_del(&sta->list);
		spin_unlock_irqrestore(&local->sta_lock, flags);

416
		sta_info_finish_insert(sta, true, false);
417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432

		spin_lock_irqsave(&local->sta_lock, flags);
	}
	spin_unlock_irqrestore(&local->sta_lock, flags);
}

static void sta_info_finish_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local, sta_finish_work);

	mutex_lock(&local->sta_mtx);
	sta_info_finish_pending(local);
	mutex_unlock(&local->sta_mtx);
}

433
static int sta_info_insert_check(struct sta_info *sta)
434 435 436
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;

437 438 439 440 441
	/*
	 * 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.
	 */
442 443
	if (unlikely(!ieee80211_sdata_running(sdata)))
		return -ENETDOWN;
444

445
	if (WARN_ON(compare_ether_addr(sta->sta.addr, sdata->vif.addr) == 0 ||
446 447 448 449 450 451 452 453 454 455 456 457 458 459
		    is_multicast_ether_addr(sta->sta.addr)))
		return -EINVAL;

	return 0;
}

static int sta_info_insert_ibss(struct sta_info *sta) __acquires(RCU)
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	unsigned long flags;

	spin_lock_irqsave(&local->sta_lock, flags);
	/* check if STA exists already */
460
	if (sta_info_get_bss_rx(sdata, sta->sta.addr)) {
461
		spin_unlock_irqrestore(&local->sta_lock, flags);
462
		rcu_read_lock();
463
		return -EEXIST;
464
	}
465

466 467 468 469
	local->num_sta++;
	local->sta_generation++;
	smp_mb();
	sta_info_hash_add(local, sta);
470

471
	list_add_tail(&sta->list, &local->sta_pending_list);
472

473 474
	rcu_read_lock();
	spin_unlock_irqrestore(&local->sta_lock, flags);
475 476

#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
477 478
	wiphy_debug(local->hw.wiphy, "Added IBSS STA %pM\n",
			sta->sta.addr);
479 480
#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */

481
	ieee80211_queue_work(&local->hw, &local->sta_finish_work);
482

483 484 485 486 487 488 489 490 491 492 493 494 495
	return 0;
}

/*
 * should be called with sta_mtx locked
 * this function replaces the mutex lock
 * with a RCU lock
 */
static int sta_info_insert_non_ibss(struct sta_info *sta) __acquires(RCU)
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	unsigned long flags;
496 497
	struct sta_info *exist_sta;
	bool dummy_reinsert = false;
498 499 500
	int err = 0;

	lockdep_assert_held(&local->sta_mtx);
501 502 503

	/*
	 * On first glance, this will look racy, because the code
504
	 * in this function, which inserts a station with sleeping,
505 506 507 508
	 * unlocks the sta_lock between checking existence in the
	 * hash table and inserting into it.
	 *
	 * However, it is not racy against itself because it keeps
509
	 * the mutex locked.
510 511
	 */

512
	spin_lock_irqsave(&local->sta_lock, flags);
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529
	/*
	 * check if STA exists already.
	 * only accept a scenario of a second call to sta_info_insert_non_ibss
	 * with a dummy station entry that was inserted earlier
	 * in that case - assume that the dummy station flag should
	 * be removed.
	 */
	exist_sta = sta_info_get_bss_rx(sdata, sta->sta.addr);
	if (exist_sta) {
		if (exist_sta == sta && sta->dummy) {
			dummy_reinsert = true;
		} else {
			spin_unlock_irqrestore(&local->sta_lock, flags);
			mutex_unlock(&local->sta_mtx);
			rcu_read_lock();
			return -EEXIST;
		}
530
	}
531

532
	spin_unlock_irqrestore(&local->sta_lock, flags);
533

534
	err = sta_info_finish_insert(sta, false, dummy_reinsert);
535 536 537
	if (err) {
		mutex_unlock(&local->sta_mtx);
		rcu_read_lock();
538
		return err;
539
	}
540

541
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
542 543
	wiphy_debug(local->hw.wiphy, "Inserted %sSTA %pM\n",
			sta->dummy ? "dummy " : "", sta->sta.addr);
544 545
#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */

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

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

553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
	return 0;
}

int sta_info_insert_rcu(struct sta_info *sta) __acquires(RCU)
{
	struct ieee80211_local *local = sta->local;
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	int err = 0;

	err = sta_info_insert_check(sta);
	if (err) {
		rcu_read_lock();
		goto out_free;
	}

	/*
	 * In ad-hoc mode, we sometimes need to insert stations
	 * from tasklet context from the RX path. To avoid races,
	 * always do so in that case -- see the comment below.
	 */
	if (sdata->vif.type == NL80211_IFTYPE_ADHOC) {
		err = sta_info_insert_ibss(sta);
		if (err)
			goto out_free;

		return 0;
	}

	/*
	 * It might seem that the function called below is in race against
	 * the function call above that atomically inserts the station... That,
	 * however, is not true because the above code can only
	 * be invoked for IBSS interfaces, and the below code will
	 * not be -- and the two do not race against each other as
	 * the hash table also keys off the interface.
	 */

	might_sleep();

	mutex_lock(&local->sta_mtx);

	err = sta_info_insert_non_ibss(sta);
	if (err)
		goto out_free;

J
Johannes Berg 已提交
598
	return 0;
599 600 601 602
 out_free:
	BUG_ON(!err);
	__sta_info_free(local, sta);
	return err;
603 604
}

605 606 607 608 609 610 611 612 613
int sta_info_insert(struct sta_info *sta)
{
	int err = sta_info_insert_rcu(sta);

	rcu_read_unlock();

	return err;
}

614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632
/* Caller must hold sta->local->sta_mtx */
int sta_info_reinsert(struct sta_info *sta)
{
	struct ieee80211_local *local = sta->local;
	int err = 0;

	err = sta_info_insert_check(sta);
	if (err) {
		mutex_unlock(&local->sta_mtx);
		return err;
	}

	might_sleep();

	err = sta_info_insert_non_ibss(sta);
	rcu_read_unlock();
	return err;
}

633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650
static inline void __bss_tim_set(struct ieee80211_if_ap *bss, u16 aid)
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the __set_bit() format.
	 */
	bss->tim[aid / 8] |= (1 << (aid % 8));
}

static inline void __bss_tim_clear(struct ieee80211_if_ap *bss, u16 aid)
{
	/*
	 * This format has been mandated by the IEEE specifications,
	 * so this line may not be changed to use the __clear_bit() format.
	 */
	bss->tim[aid / 8] &= ~(1 << (aid % 8));
}

651
static unsigned long ieee80211_tids_for_ac(int ac)
652
{
653 654 655 656 657 658 659 660 661 662 663 664 665
	/* 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;
666
	}
667 668
}

J
Johannes Berg 已提交
669
void sta_info_recalc_tim(struct sta_info *sta)
670
{
J
Johannes Berg 已提交
671 672
	struct ieee80211_local *local = sta->local;
	struct ieee80211_if_ap *bss = sta->sdata->bss;
673
	unsigned long flags;
674 675 676
	bool indicate_tim = false;
	u8 ignore_for_tim = sta->sta.uapsd_queues;
	int ac;
677

J
Johannes Berg 已提交
678 679
	if (WARN_ON_ONCE(!sta->sdata->bss))
		return;
680

J
Johannes Berg 已提交
681 682 683
	/* No need to do anything if the driver does all */
	if (local->hw.flags & IEEE80211_HW_AP_LINK_PS)
		return;
684

J
Johannes Berg 已提交
685 686
	if (sta->dead)
		goto done;
687

688 689 690 691 692 693 694 695 696 697 698
	/*
	 * 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;

	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		unsigned long tids;
699

700 701 702 703 704 705 706
		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;
707

708 709 710 711
		tids = ieee80211_tids_for_ac(ac);

		indicate_tim |=
			sta->driver_buffered_tids & tids;
712
	}
713

J
Johannes Berg 已提交
714 715
 done:
	spin_lock_irqsave(&local->sta_lock, flags);
716

717
	if (indicate_tim)
J
Johannes Berg 已提交
718 719 720
		__bss_tim_set(bss, sta->sta.aid);
	else
		__bss_tim_clear(bss, sta->sta.aid);
721

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

J
Johannes Berg 已提交
728
	spin_unlock_irqrestore(&local->sta_lock, flags);
729 730
}

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 781 782 783 784 785 786 787 788 789

		/*
		 * 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;
		dev_kfree_skb(skb);
	}

	/*
	 * 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--;
808
#ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
809 810
		printk(KERN_DEBUG "Buffered frame expired (STA %pM)\n",
		       sta->sta.addr);
811
#endif
812
		dev_kfree_skb(skb);
813
	}
814

815 816 817 818 819 820 821 822 823 824 825 826
	/*
	 * 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.
	 */
827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845
	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;

	/* This is only necessary for stations on BSS interfaces */
	if (!sta->sdata->bss)
		return false;

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

	return have_buffered;
846 847
}

848
static int __must_check __sta_info_destroy(struct sta_info *sta)
849
{
850 851 852
	struct ieee80211_local *local;
	struct ieee80211_sub_if_data *sdata;
	unsigned long flags;
853
	int ret, i, ac;
854
	struct tid_ampdu_tx *tid_tx;
855

856
	might_sleep();
857

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

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

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

873 874 875 876 877 878 879 880 881
	spin_lock_irqsave(&local->sta_lock, flags);
	ret = sta_info_hash_del(local, sta);
	/* this might still be the pending list ... which is fine */
	if (!ret)
		list_del(&sta->list);
	spin_unlock_irqrestore(&local->sta_lock, flags);
	if (ret)
		return ret;

882
	mutex_lock(&local->key_mtx);
883
	for (i = 0; i < NUM_DEFAULT_KEYS; i++)
J
Johannes Berg 已提交
884
		__ieee80211_key_free(key_mtx_dereference(local, sta->gtk[i]));
885
	if (sta->ptk)
J
Johannes Berg 已提交
886
		__ieee80211_key_free(key_mtx_dereference(local, sta->ptk));
887
	mutex_unlock(&local->key_mtx);
888 889 890

	sta->dead = true;

J
Johannes Berg 已提交
891 892
	if (test_sta_flag(sta, WLAN_STA_PS_STA) ||
	    test_sta_flag(sta, WLAN_STA_PS_DRIVER)) {
893 894
		BUG_ON(!sdata->bss);

J
Johannes Berg 已提交
895 896 897
		clear_sta_flag(sta, WLAN_STA_PS_STA);
		clear_sta_flag(sta, WLAN_STA_PS_DRIVER);

898
		atomic_dec(&sdata->bss->num_sta_ps);
J
Johannes Berg 已提交
899
		sta_info_recalc_tim(sta);
900 901 902 903 904 905
	}

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

	if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
906
		RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
907 908 909 910 911 912 913 914 915 916

	if (sta->uploaded) {
		if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
			sdata = container_of(sdata->bss,
					     struct ieee80211_sub_if_data,
					     u.ap);
		drv_sta_remove(local, sdata, &sta->sta);
		sdata = sta->sdata;
	}

917 918 919 920 921 922 923 924
	/*
	 * At this point, after we wait for an RCU grace period,
	 * neither mac80211 nor the driver can reference this
	 * sta struct any more except by still existing timers
	 * associated with this station that we clean up below.
	 */
	synchronize_rcu();

925 926 927 928 929
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		local->total_ps_buffered -= skb_queue_len(&sta->ps_tx_buf[ac]);
		__skb_queue_purge(&sta->ps_tx_buf[ac]);
		__skb_queue_purge(&sta->tx_filtered[ac]);
	}
J
Johannes Berg 已提交
930

931
#ifdef CONFIG_MAC80211_MESH
932
	if (ieee80211_vif_is_mesh(&sdata->vif))
933 934 935 936
		mesh_accept_plinks_update(sdata);
#endif

#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
J
Joe Perches 已提交
937
	wiphy_debug(local->hw.wiphy, "Removed STA %pM\n", sta->sta.addr);
938 939 940
#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
	cancel_work_sync(&sta->drv_unblock_wk);

941 942
	cfg80211_del_sta(sdata->dev, sta->sta.addr, GFP_KERNEL);

943 944 945 946 947 948 949 950 951 952
	rate_control_remove_sta_debugfs(sta);
	ieee80211_sta_debugfs_remove(sta);

#ifdef CONFIG_MAC80211_MESH
	if (ieee80211_vif_is_mesh(&sta->sdata->vif)) {
		mesh_plink_deactivate(sta);
		del_timer_sync(&sta->plink_timer);
	}
#endif

953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976
	/* There could be some memory leaks because of ampdu tx pending queue
	 * not being freed before destroying the station info.
	 *
	 * Make sure that such queues are purged before freeing the station
	 * info.
	 * TODO: We have to somehow postpone the full destruction
	 * until the aggregation stop completes. Refer
	 * http://thread.gmane.org/gmane.linux.kernel.wireless.general/81936
	 */
	for (i = 0; i < STA_TID_NUM; i++) {
		if (!sta->ampdu_mlme.tid_tx[i])
			continue;
		tid_tx = sta->ampdu_mlme.tid_tx[i];
		if (skb_queue_len(&tid_tx->pending)) {
#ifdef CONFIG_MAC80211_HT_DEBUG
			wiphy_debug(local->hw.wiphy, "TX A-MPDU  purging %d "
				"packets for tid=%d\n",
				skb_queue_len(&tid_tx->pending), i);
#endif /* CONFIG_MAC80211_HT_DEBUG */
			__skb_queue_purge(&tid_tx->pending);
		}
		kfree_rcu(tid_tx, rcu_head);
	}

977 978 979
	__sta_info_free(local, sta);

	return 0;
J
Jiri Slaby 已提交
980 981
}

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

987
	mutex_lock(&sdata->local->sta_mtx);
988
	sta = sta_info_get_rx(sdata, addr);
989 990
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
J
Jiri Slaby 已提交
991 992 993 994

	return ret;
}

995 996
int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data *sdata,
			      const u8 *addr)
J
Jiri Benc 已提交
997
{
998 999
	struct sta_info *sta;
	int ret;
J
Jiri Benc 已提交
1000

1001
	mutex_lock(&sdata->local->sta_mtx);
1002
	sta = sta_info_get_bss_rx(sdata, addr);
1003 1004
	ret = __sta_info_destroy(sta);
	mutex_unlock(&sdata->local->sta_mtx);
1005

1006 1007
	return ret;
}
J
Jiri Benc 已提交
1008

1009 1010 1011 1012
static void sta_info_cleanup(unsigned long data)
{
	struct ieee80211_local *local = (struct ieee80211_local *) data;
	struct sta_info *sta;
1013
	bool timer_needed = false;
1014 1015 1016

	rcu_read_lock();
	list_for_each_entry_rcu(sta, &local->sta_list, list)
1017 1018
		if (sta_info_cleanup_expire_buffered(local, sta))
			timer_needed = true;
1019
	rcu_read_unlock();
J
Jiri Benc 已提交
1020

1021 1022
	if (local->quiescing)
		return;
1023

1024 1025 1026
	if (!timer_needed)
		return;

1027 1028
	mod_timer(&local->sta_cleanup,
		  round_jiffies(jiffies + STA_INFO_CLEANUP_INTERVAL));
J
Jiri Benc 已提交
1029 1030
}

1031 1032
void sta_info_init(struct ieee80211_local *local)
{
1033
	spin_lock_init(&local->sta_lock);
1034
	mutex_init(&local->sta_mtx);
1035
	INIT_LIST_HEAD(&local->sta_list);
1036 1037
	INIT_LIST_HEAD(&local->sta_pending_list);
	INIT_WORK(&local->sta_finish_work, sta_info_finish_work);
1038

1039 1040
	setup_timer(&local->sta_cleanup, sta_info_cleanup,
		    (unsigned long)local);
1041 1042 1043 1044 1045
}

void sta_info_stop(struct ieee80211_local *local)
{
	del_timer(&local->sta_cleanup);
1046
	sta_info_flush(local, NULL);
1047 1048 1049 1050
}

/**
 * sta_info_flush - flush matching STA entries from the STA table
1051 1052 1053
 *
 * Returns the number of removed STA entries.
 *
1054
 * @local: local interface data
1055
 * @sdata: matching rule for the net device (sta->dev) or %NULL to match all STAs
1056
 */
1057
int sta_info_flush(struct ieee80211_local *local,
1058
		   struct ieee80211_sub_if_data *sdata)
1059 1060
{
	struct sta_info *sta, *tmp;
1061
	int ret = 0;
1062

1063
	might_sleep();
1064

1065 1066 1067 1068
	mutex_lock(&local->sta_mtx);

	sta_info_finish_pending(local);

1069
	list_for_each_entry_safe(sta, tmp, &local->sta_list, list) {
1070 1071
		if (!sdata || sdata == sta->sdata)
			WARN_ON(__sta_info_destroy(sta));
1072
	}
1073
	mutex_unlock(&local->sta_mtx);
1074 1075

	return ret;
1076
}
J
Johannes Berg 已提交
1077

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

1084
	mutex_lock(&local->sta_mtx);
1085 1086 1087
	list_for_each_entry_safe(sta, tmp, &local->sta_list, list)
		if (time_after(jiffies, sta->last_rx + exp_time)) {
#ifdef CONFIG_MAC80211_IBSS_DEBUG
1088
			printk(KERN_DEBUG "%s: expiring inactive STA %pM\n",
1089
			       sdata->name, sta->sta.addr);
1090
#endif
1091
			WARN_ON(__sta_info_destroy(sta));
1092
		}
1093
	mutex_unlock(&local->sta_mtx);
1094
}
1095

1096 1097 1098
struct ieee80211_sta *ieee80211_find_sta_by_ifaddr(struct ieee80211_hw *hw,
					       const u8 *addr,
					       const u8 *localaddr)
1099
{
1100
	struct sta_info *sta, *nxt;
1101

1102 1103 1104 1105
	/*
	 * Just return a random station if localaddr is NULL
	 * ... first in list.
	 */
1106
	for_each_sta_info(hw_to_local(hw), addr, sta, nxt) {
1107 1108 1109
		if (localaddr &&
		    compare_ether_addr(sta->sdata->vif.addr, localaddr) != 0)
			continue;
1110 1111
		if (!sta->uploaded)
			return NULL;
1112
		return &sta->sta;
1113 1114
	}

1115
	return NULL;
1116
}
1117
EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr);
1118 1119 1120 1121

struct ieee80211_sta *ieee80211_find_sta(struct ieee80211_vif *vif,
					 const u8 *addr)
{
1122
	struct sta_info *sta;
1123 1124 1125 1126

	if (!vif)
		return NULL;

1127 1128 1129 1130 1131 1132
	sta = sta_info_get_bss(vif_to_sdata(vif), addr);
	if (!sta)
		return NULL;

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

1134
	return &sta->sta;
1135
}
1136
EXPORT_SYMBOL(ieee80211_find_sta);
1137

1138 1139 1140 1141
static void clear_sta_ps_flags(void *_sta)
{
	struct sta_info *sta = _sta;

J
Johannes Berg 已提交
1142 1143
	clear_sta_flag(sta, WLAN_STA_PS_DRIVER);
	clear_sta_flag(sta, WLAN_STA_PS_STA);
1144 1145
}

1146 1147 1148 1149 1150
/* powersave support code */
void ieee80211_sta_ps_deliver_wakeup(struct sta_info *sta)
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1151 1152 1153
	struct sk_buff_head pending;
	int filtered = 0, buffered = 0, ac;

J
Johannes Berg 已提交
1154
	clear_sta_flag(sta, WLAN_STA_SP);
J
Johannes Berg 已提交
1155

1156 1157
	BUILD_BUG_ON(BITS_TO_LONGS(STA_TID_NUM) > 1);
	sta->driver_buffered_tids = 0;
1158

1159 1160
	if (!(local->hw.flags & IEEE80211_HW_AP_LINK_PS))
		drv_sta_notify(local, sdata, STA_NOTIFY_AWAKE, &sta->sta);
1161

1162
	skb_queue_head_init(&pending);
1163 1164

	/* Send all buffered frames to the station */
1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		int count = skb_queue_len(&pending), tmp;

		skb_queue_splice_tail_init(&sta->tx_filtered[ac], &pending);
		tmp = skb_queue_len(&pending);
		filtered += tmp - count;
		count = tmp;

		skb_queue_splice_tail_init(&sta->ps_tx_buf[ac], &pending);
		tmp = skb_queue_len(&pending);
		buffered += tmp - count;
	}

	ieee80211_add_pending_skbs_fn(local, &pending, clear_sta_ps_flags, sta);

1180 1181
	local->total_ps_buffered -= buffered;

J
Johannes Berg 已提交
1182 1183
	sta_info_recalc_tim(sta);

1184 1185
#ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
	printk(KERN_DEBUG "%s: STA %pM aid %d sending %d filtered/%d PS frames "
1186
	       "since STA not sleeping anymore\n", sdata->name,
1187
	       sta->sta.addr, sta->sta.aid, filtered, buffered);
1188 1189 1190
#endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
}

1191 1192
static void ieee80211_send_null_response(struct ieee80211_sub_if_data *sdata,
					 struct sta_info *sta, int tid,
1193
					 enum ieee80211_frame_release_type reason)
1194 1195
{
	struct ieee80211_local *local = sdata->local;
1196
	struct ieee80211_qos_hdr *nullfunc;
1197
	struct sk_buff *skb;
1198 1199
	int size = sizeof(*nullfunc);
	__le16 fc;
J
Johannes Berg 已提交
1200
	bool qos = test_sta_flag(sta, WLAN_STA_WME);
1201
	struct ieee80211_tx_info *info;
1202

1203 1204 1205 1206 1207 1208 1209 1210 1211
	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);
1212 1213
	}

1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
	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);

1227 1228
	skb->priority = tid;
	skb_set_queue_mapping(skb, ieee802_1d_to_ac[tid]);
1229 1230 1231
	if (qos) {
		nullfunc->qos_ctrl = cpu_to_le16(tid);

1232
		if (reason == IEEE80211_FRAME_RELEASE_UAPSD)
1233 1234 1235 1236 1237 1238 1239 1240 1241
			nullfunc->qos_ctrl |=
				cpu_to_le16(IEEE80211_QOS_CTL_EOSP);
	}

	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
1242 1243
	 * exchange. Also set EOSP to indicate this packet
	 * ends the poll/service period.
1244
	 */
1245 1246 1247
	info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE |
		       IEEE80211_TX_STATUS_EOSP |
		       IEEE80211_TX_CTL_REQ_TX_STATUS;
1248

1249 1250
	drv_allow_buffered_frames(local, sta, BIT(tid), 1, reason, false);

1251 1252 1253
	ieee80211_xmit(sdata, skb);
}

J
Johannes Berg 已提交
1254 1255 1256 1257
static void
ieee80211_sta_ps_deliver_response(struct sta_info *sta,
				  int n_frames, u8 ignored_acs,
				  enum ieee80211_frame_release_type reason)
1258 1259 1260
{
	struct ieee80211_sub_if_data *sdata = sta->sdata;
	struct ieee80211_local *local = sdata->local;
1261
	bool found = false;
1262 1263
	bool more_data = false;
	int ac;
1264
	unsigned long driver_release_tids = 0;
J
Johannes Berg 已提交
1265
	struct sk_buff_head frames;
1266

1267
	/* Service or PS-Poll period starts */
J
Johannes Berg 已提交
1268
	set_sta_flag(sta, WLAN_STA_SP);
1269

J
Johannes Berg 已提交
1270
	__skb_queue_head_init(&frames);
1271 1272

	/*
J
Johannes Berg 已提交
1273
	 * Get response frame(s) and more data bit for it.
1274 1275
	 */
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1276 1277
		unsigned long tids;

J
Johannes Berg 已提交
1278
		if (ignored_acs & BIT(ac))
1279 1280
			continue;

1281 1282 1283 1284 1285 1286 1287
		tids = ieee80211_tids_for_ac(ac);

		if (!found) {
			driver_release_tids = sta->driver_buffered_tids & tids;
			if (driver_release_tids) {
				found = true;
			} else {
J
Johannes Berg 已提交
1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300
				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--;
1301
					found = true;
J
Johannes Berg 已提交
1302 1303
					__skb_queue_tail(&frames, skb);
				}
1304 1305
			}

1306 1307 1308 1309 1310
			/*
			 * 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).
			 */
J
Johannes Berg 已提交
1311 1312
			if (reason == IEEE80211_FRAME_RELEASE_PSPOLL &&
			    hweight16(driver_release_tids) > 1) {
1313 1314 1315 1316 1317 1318
				more_data = true;
				driver_release_tids =
					BIT(ffs(driver_release_tids) - 1);
				break;
			}
		}
1319 1320 1321 1322 1323 1324

		if (!skb_queue_empty(&sta->tx_filtered[ac]) ||
		    !skb_queue_empty(&sta->ps_tx_buf[ac])) {
			more_data = true;
			break;
		}
1325 1326
	}

1327
	if (!found) {
1328
		int tid;
1329 1330

		/*
1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342
		 * 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.
1343 1344
		 */

1345 1346
		/* This will evaluate to 1, 3, 5 or 7. */
		tid = 7 - ((ffs(~ignored_acs) - 1) << 1);
1347

1348
		ieee80211_send_null_response(sdata, sta, tid, reason);
1349 1350
		return;
	}
1351

J
Johannes Berg 已提交
1352 1353 1354
	if (!driver_release_tids) {
		struct sk_buff_head pending;
		struct sk_buff *skb;
1355 1356
		int num = 0;
		u16 tids = 0;
1357

J
Johannes Berg 已提交
1358
		skb_queue_head_init(&pending);
1359

J
Johannes Berg 已提交
1360 1361 1362
		while ((skb = __skb_dequeue(&frames))) {
			struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
			struct ieee80211_hdr *hdr = (void *) skb->data;
1363 1364 1365
			u8 *qoshdr = NULL;

			num++;
1366

J
Johannes Berg 已提交
1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377
			/*
			 * Tell TX path to send this frame even though the
			 * STA may still remain is PS mode after this frame
			 * exchange.
			 */
			info->flags |= IEEE80211_TX_CTL_POLL_RESPONSE;

			/*
			 * Use MoreData flag to indicate whether there are
			 * more buffered frames for this STA
			 */
1378
			if (more_data || !skb_queue_empty(&frames))
J
Johannes Berg 已提交
1379 1380
				hdr->frame_control |=
					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
1381 1382 1383
			else
				hdr->frame_control &=
					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
J
Johannes Berg 已提交
1384

1385 1386 1387 1388 1389
			if (ieee80211_is_data_qos(hdr->frame_control) ||
			    ieee80211_is_qos_nullfunc(hdr->frame_control))
				qoshdr = ieee80211_get_qos_ctl(hdr);

			/* set EOSP for the frame */
J
Johannes Berg 已提交
1390
			if (reason == IEEE80211_FRAME_RELEASE_UAPSD &&
1391 1392
			    qoshdr && skb_queue_empty(&frames))
				*qoshdr |= IEEE80211_QOS_CTL_EOSP;
1393

1394 1395 1396
			info->flags |= IEEE80211_TX_STATUS_EOSP |
				       IEEE80211_TX_CTL_REQ_TX_STATUS;

1397 1398 1399 1400 1401
			if (qoshdr)
				tids |= BIT(*qoshdr & IEEE80211_QOS_CTL_TID_MASK);
			else
				tids |= BIT(0);

J
Johannes Berg 已提交
1402 1403
			__skb_queue_tail(&pending, skb);
		}
1404

1405 1406 1407
		drv_allow_buffered_frames(local, sta, tids, num,
					  reason, more_data);

J
Johannes Berg 已提交
1408
		ieee80211_add_pending_skbs(local, &pending);
1409

J
Johannes Berg 已提交
1410
		sta_info_recalc_tim(sta);
1411 1412
	} else {
		/*
1413 1414 1415 1416 1417 1418 1419 1420 1421 1422
		 * We need to release a frame that is buffered somewhere in the
		 * driver ... it'll have to handle that.
		 * Note that, as per the comment above, it'll also have to see
		 * if there is more than just one frame on the specific TID that
		 * we're releasing from, and it needs to set the more-data bit
		 * accordingly if we tell it that there's no more data. If we do
		 * tell it there's more data, then of course the more-data bit
		 * needs to be set anyway.
		 */
		drv_release_buffered_frames(local, sta, driver_release_tids,
J
Johannes Berg 已提交
1423
					    n_frames, reason, more_data);
1424 1425 1426 1427 1428 1429 1430 1431

		/*
		 * 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
		 * that the TID became empty before returning here from the
		 * release function.
		 * Either way, however, when the driver tells us that the TID
		 * became empty we'll do the TIM recalculation.
1432 1433 1434 1435
		 */
	}
}

J
Johannes Berg 已提交
1436 1437 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 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485
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? */
		n_frames = 8;
		break;
	}

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

1486 1487 1488 1489 1490
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 已提交
1491 1492
	trace_api_sta_block_awake(sta->local, pubsta, block);

1493
	if (block)
J
Johannes Berg 已提交
1494 1495
		set_sta_flag(sta, WLAN_STA_PS_DRIVER);
	else if (test_sta_flag(sta, WLAN_STA_PS_DRIVER))
1496 1497 1498
		ieee80211_queue_work(hw, &sta->drv_unblock_wk);
}
EXPORT_SYMBOL(ieee80211_sta_block_awake);
1499

1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
void ieee80211_sta_eosp_irqsafe(struct ieee80211_sta *pubsta)
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
	struct ieee80211_local *local = sta->local;
	struct sk_buff *skb;
	struct skb_eosp_msg_data *data;

	trace_api_eosp(local, pubsta);

	skb = alloc_skb(0, GFP_ATOMIC);
	if (!skb) {
		/* too bad ... but race is better than loss */
		clear_sta_flag(sta, WLAN_STA_SP);
		return;
	}

	data = (void *)skb->cb;
	memcpy(data->sta, pubsta->addr, ETH_ALEN);
	memcpy(data->iface, sta->sdata->vif.addr, ETH_ALEN);
	skb->pkt_type = IEEE80211_EOSP_MSG;
	skb_queue_tail(&local->skb_queue, skb);
	tasklet_schedule(&local->tasklet);
}
EXPORT_SYMBOL(ieee80211_sta_eosp_irqsafe);

1525 1526
void ieee80211_sta_set_buffered(struct ieee80211_sta *pubsta,
				u8 tid, bool buffered)
1527 1528 1529
{
	struct sta_info *sta = container_of(pubsta, struct sta_info, sta);

1530
	if (WARN_ON(tid >= STA_TID_NUM))
1531 1532
		return;

1533 1534 1535 1536 1537
	if (buffered)
		set_bit(tid, &sta->driver_buffered_tids);
	else
		clear_bit(tid, &sta->driver_buffered_tids);

J
Johannes Berg 已提交
1538
	sta_info_recalc_tim(sta);
1539
}
1540
EXPORT_SYMBOL(ieee80211_sta_set_buffered);