2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
4 * Copyright 2013-2014 Intel Mobile Communications GmbH
5 * Copyright (C) 2015 - 2016 Intel Deutschland GmbH
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
12 #include <linux/module.h>
13 #include <linux/init.h>
14 #include <linux/etherdevice.h>
15 #include <linux/netdevice.h>
16 #include <linux/types.h>
17 #include <linux/slab.h>
18 #include <linux/skbuff.h>
19 #include <linux/if_arp.h>
20 #include <linux/timer.h>
21 #include <linux/rtnetlink.h>
23 #include <net/mac80211.h>
24 #include "ieee80211_i.h"
25 #include "driver-ops.h"
28 #include "debugfs_sta.h"
33 * DOC: STA information lifetime rules
35 * STA info structures (&struct sta_info) are managed in a hash table
36 * for faster lookup and a list for iteration. They are managed using
37 * RCU, i.e. access to the list and hash table is protected by RCU.
39 * Upon allocating a STA info structure with sta_info_alloc(), the caller
40 * owns that structure. It must then insert it into the hash table using
41 * either sta_info_insert() or sta_info_insert_rcu(); only in the latter
42 * case (which acquires an rcu read section but must not be called from
43 * within one) will the pointer still be valid after the call. Note that
44 * the caller may not do much with the STA info before inserting it, in
45 * particular, it may not start any mesh peer link management or add
48 * When the insertion fails (sta_info_insert()) returns non-zero), the
49 * structure will have been freed by sta_info_insert()!
51 * Station entries are added by mac80211 when you establish a link with a
52 * peer. This means different things for the different type of interfaces
53 * we support. For a regular station this mean we add the AP sta when we
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
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.
59 * In order to remove a STA info structure, various sta_info_destroy_*()
60 * calls are available.
62 * There is no concept of ownership on a STA entry, each structure is
63 * owned by the global hash table/list until it is removed. All users of
64 * the structure need to be RCU protected so that the structure won't be
65 * freed before they are done using it.
68 static const struct rhashtable_params sta_rht_params
= {
69 .nelem_hint
= 3, /* start small */
70 .insecure_elasticity
= true, /* Disable chain-length checks. */
71 .automatic_shrinking
= true,
72 .head_offset
= offsetof(struct sta_info
, hash_node
),
73 .key_offset
= offsetof(struct sta_info
, addr
),
75 .hashfn
= sta_addr_hash
,
76 .max_size
= CONFIG_MAC80211_STA_HASH_MAX_SIZE
,
79 /* Caller must hold local->sta_mtx */
80 static int sta_info_hash_del(struct ieee80211_local
*local
,
83 return rhashtable_remove_fast(&local
->sta_hash
, &sta
->hash_node
,
87 static void __cleanup_single_sta(struct sta_info
*sta
)
90 struct tid_ampdu_tx
*tid_tx
;
91 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
92 struct ieee80211_local
*local
= sdata
->local
;
93 struct fq
*fq
= &local
->fq
;
96 if (test_sta_flag(sta
, WLAN_STA_PS_STA
) ||
97 test_sta_flag(sta
, WLAN_STA_PS_DRIVER
) ||
98 test_sta_flag(sta
, WLAN_STA_PS_DELIVER
)) {
99 if (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP
||
100 sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
)
101 ps
= &sdata
->bss
->ps
;
102 else if (ieee80211_vif_is_mesh(&sdata
->vif
))
103 ps
= &sdata
->u
.mesh
.ps
;
107 clear_sta_flag(sta
, WLAN_STA_PS_STA
);
108 clear_sta_flag(sta
, WLAN_STA_PS_DRIVER
);
109 clear_sta_flag(sta
, WLAN_STA_PS_DELIVER
);
111 atomic_dec(&ps
->num_sta_ps
);
114 if (sta
->sta
.txq
[0]) {
115 for (i
= 0; i
< ARRAY_SIZE(sta
->sta
.txq
); i
++) {
116 struct txq_info
*txqi
= to_txq_info(sta
->sta
.txq
[i
]);
118 spin_lock_bh(&fq
->lock
);
119 ieee80211_txq_purge(local
, txqi
);
120 spin_unlock_bh(&fq
->lock
);
124 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++) {
125 local
->total_ps_buffered
-= skb_queue_len(&sta
->ps_tx_buf
[ac
]);
126 ieee80211_purge_tx_queue(&local
->hw
, &sta
->ps_tx_buf
[ac
]);
127 ieee80211_purge_tx_queue(&local
->hw
, &sta
->tx_filtered
[ac
]);
130 if (ieee80211_vif_is_mesh(&sdata
->vif
))
131 mesh_sta_cleanup(sta
);
133 cancel_work_sync(&sta
->drv_deliver_wk
);
136 * Destroy aggregation state here. It would be nice to wait for the
137 * driver to finish aggregation stop and then clean up, but for now
138 * drivers have to handle aggregation stop being requested, followed
139 * directly by station destruction.
141 for (i
= 0; i
< IEEE80211_NUM_TIDS
; i
++) {
142 kfree(sta
->ampdu_mlme
.tid_start_tx
[i
]);
143 tid_tx
= rcu_dereference_raw(sta
->ampdu_mlme
.tid_tx
[i
]);
146 ieee80211_purge_tx_queue(&local
->hw
, &tid_tx
->pending
);
151 static void cleanup_single_sta(struct sta_info
*sta
)
153 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
154 struct ieee80211_local
*local
= sdata
->local
;
156 __cleanup_single_sta(sta
);
157 sta_info_free(local
, sta
);
160 /* protected by RCU */
161 struct sta_info
*sta_info_get(struct ieee80211_sub_if_data
*sdata
,
164 struct ieee80211_local
*local
= sdata
->local
;
165 struct sta_info
*sta
;
166 struct rhash_head
*tmp
;
167 const struct bucket_table
*tbl
;
170 tbl
= rht_dereference_rcu(local
->sta_hash
.tbl
, &local
->sta_hash
);
172 for_each_sta_info(local
, tbl
, addr
, sta
, tmp
) {
173 if (sta
->sdata
== sdata
) {
175 /* this is safe as the caller must already hold
176 * another rcu read section or the mutex
186 * Get sta info either from the specified interface
187 * or from one of its vlans
189 struct sta_info
*sta_info_get_bss(struct ieee80211_sub_if_data
*sdata
,
192 struct ieee80211_local
*local
= sdata
->local
;
193 struct sta_info
*sta
;
194 struct rhash_head
*tmp
;
195 const struct bucket_table
*tbl
;
198 tbl
= rht_dereference_rcu(local
->sta_hash
.tbl
, &local
->sta_hash
);
200 for_each_sta_info(local
, tbl
, addr
, sta
, tmp
) {
201 if (sta
->sdata
== sdata
||
202 (sta
->sdata
->bss
&& sta
->sdata
->bss
== sdata
->bss
)) {
204 /* this is safe as the caller must already hold
205 * another rcu read section or the mutex
214 struct sta_info
*sta_info_get_by_idx(struct ieee80211_sub_if_data
*sdata
,
217 struct ieee80211_local
*local
= sdata
->local
;
218 struct sta_info
*sta
;
221 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
222 if (sdata
!= sta
->sdata
)
235 * sta_info_free - free STA
237 * @local: pointer to the global information
238 * @sta: STA info to free
240 * This function must undo everything done by sta_info_alloc()
241 * that may happen before sta_info_insert(). It may only be
242 * called when sta_info_insert() has not been attempted (and
243 * if that fails, the station is freed anyway.)
245 void sta_info_free(struct ieee80211_local
*local
, struct sta_info
*sta
)
248 rate_control_free_sta(sta
);
250 sta_dbg(sta
->sdata
, "Destroyed STA %pM\n", sta
->sta
.addr
);
253 kfree(to_txq_info(sta
->sta
.txq
[0]));
254 kfree(rcu_dereference_raw(sta
->sta
.rates
));
255 #ifdef CONFIG_MAC80211_MESH
258 free_percpu(sta
->pcpu_rx_stats
);
262 /* Caller must hold local->sta_mtx */
263 static int sta_info_hash_add(struct ieee80211_local
*local
,
264 struct sta_info
*sta
)
266 return rhashtable_insert_fast(&local
->sta_hash
, &sta
->hash_node
,
270 static void sta_deliver_ps_frames(struct work_struct
*wk
)
272 struct sta_info
*sta
;
274 sta
= container_of(wk
, struct sta_info
, drv_deliver_wk
);
280 if (!test_sta_flag(sta
, WLAN_STA_PS_STA
))
281 ieee80211_sta_ps_deliver_wakeup(sta
);
282 else if (test_and_clear_sta_flag(sta
, WLAN_STA_PSPOLL
))
283 ieee80211_sta_ps_deliver_poll_response(sta
);
284 else if (test_and_clear_sta_flag(sta
, WLAN_STA_UAPSD
))
285 ieee80211_sta_ps_deliver_uapsd(sta
);
289 static int sta_prepare_rate_control(struct ieee80211_local
*local
,
290 struct sta_info
*sta
, gfp_t gfp
)
292 if (ieee80211_hw_check(&local
->hw
, HAS_RATE_CONTROL
))
295 sta
->rate_ctrl
= local
->rate_ctrl
;
296 sta
->rate_ctrl_priv
= rate_control_alloc_sta(sta
->rate_ctrl
,
298 if (!sta
->rate_ctrl_priv
)
304 struct sta_info
*sta_info_alloc(struct ieee80211_sub_if_data
*sdata
,
305 const u8
*addr
, gfp_t gfp
)
307 struct ieee80211_local
*local
= sdata
->local
;
308 struct ieee80211_hw
*hw
= &local
->hw
;
309 struct sta_info
*sta
;
312 sta
= kzalloc(sizeof(*sta
) + hw
->sta_data_size
, gfp
);
316 if (ieee80211_hw_check(hw
, USES_RSS
)) {
318 alloc_percpu(struct ieee80211_sta_rx_stats
);
319 if (!sta
->pcpu_rx_stats
)
323 spin_lock_init(&sta
->lock
);
324 spin_lock_init(&sta
->ps_lock
);
325 INIT_WORK(&sta
->drv_deliver_wk
, sta_deliver_ps_frames
);
326 INIT_WORK(&sta
->ampdu_mlme
.work
, ieee80211_ba_session_work
);
327 mutex_init(&sta
->ampdu_mlme
.mtx
);
328 #ifdef CONFIG_MAC80211_MESH
329 if (ieee80211_vif_is_mesh(&sdata
->vif
)) {
330 sta
->mesh
= kzalloc(sizeof(*sta
->mesh
), gfp
);
333 spin_lock_init(&sta
->mesh
->plink_lock
);
334 if (ieee80211_vif_is_mesh(&sdata
->vif
) &&
335 !sdata
->u
.mesh
.user_mpm
)
336 init_timer(&sta
->mesh
->plink_timer
);
337 sta
->mesh
->nonpeer_pm
= NL80211_MESH_POWER_ACTIVE
;
341 memcpy(sta
->addr
, addr
, ETH_ALEN
);
342 memcpy(sta
->sta
.addr
, addr
, ETH_ALEN
);
343 sta
->sta
.max_rx_aggregation_subframes
=
344 local
->hw
.max_rx_aggregation_subframes
;
348 sta
->rx_stats
.last_rx
= jiffies
;
350 u64_stats_init(&sta
->rx_stats
.syncp
);
352 sta
->sta_state
= IEEE80211_STA_NONE
;
354 /* Mark TID as unreserved */
355 sta
->reserved_tid
= IEEE80211_TID_UNRESERVED
;
357 sta
->last_connected
= ktime_get_seconds();
358 ewma_signal_init(&sta
->rx_stats_avg
.signal
);
359 for (i
= 0; i
< ARRAY_SIZE(sta
->rx_stats_avg
.chain_signal
); i
++)
360 ewma_signal_init(&sta
->rx_stats_avg
.chain_signal
[i
]);
362 if (local
->ops
->wake_tx_queue
) {
364 int size
= sizeof(struct txq_info
) +
365 ALIGN(hw
->txq_data_size
, sizeof(void *));
367 txq_data
= kcalloc(ARRAY_SIZE(sta
->sta
.txq
), size
, gfp
);
371 for (i
= 0; i
< ARRAY_SIZE(sta
->sta
.txq
); i
++) {
372 struct txq_info
*txq
= txq_data
+ i
* size
;
374 ieee80211_txq_init(sdata
, sta
, txq
, i
);
378 if (sta_prepare_rate_control(local
, sta
, gfp
))
381 for (i
= 0; i
< IEEE80211_NUM_TIDS
; i
++) {
383 * timer_to_tid must be initialized with identity mapping
384 * to enable session_timer's data differentiation. See
385 * sta_rx_agg_session_timer_expired for usage.
387 sta
->timer_to_tid
[i
] = i
;
389 for (i
= 0; i
< IEEE80211_NUM_ACS
; i
++) {
390 skb_queue_head_init(&sta
->ps_tx_buf
[i
]);
391 skb_queue_head_init(&sta
->tx_filtered
[i
]);
394 for (i
= 0; i
< IEEE80211_NUM_TIDS
; i
++)
395 sta
->last_seq_ctrl
[i
] = cpu_to_le16(USHRT_MAX
);
397 sta
->sta
.smps_mode
= IEEE80211_SMPS_OFF
;
398 if (sdata
->vif
.type
== NL80211_IFTYPE_AP
||
399 sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
) {
400 struct ieee80211_supported_band
*sband
=
401 hw
->wiphy
->bands
[ieee80211_get_sdata_band(sdata
)];
402 u8 smps
= (sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SM_PS
) >>
403 IEEE80211_HT_CAP_SM_PS_SHIFT
;
405 * Assume that hostapd advertises our caps in the beacon and
406 * this is the known_smps_mode for a station that just assciated
409 case WLAN_HT_SMPS_CONTROL_DISABLED
:
410 sta
->known_smps_mode
= IEEE80211_SMPS_OFF
;
412 case WLAN_HT_SMPS_CONTROL_STATIC
:
413 sta
->known_smps_mode
= IEEE80211_SMPS_STATIC
;
415 case WLAN_HT_SMPS_CONTROL_DYNAMIC
:
416 sta
->known_smps_mode
= IEEE80211_SMPS_DYNAMIC
;
423 sta
->sta
.max_rc_amsdu_len
= IEEE80211_MAX_MPDU_LEN_HT_BA
;
425 sta_dbg(sdata
, "Allocated STA %pM\n", sta
->sta
.addr
);
431 kfree(to_txq_info(sta
->sta
.txq
[0]));
433 #ifdef CONFIG_MAC80211_MESH
440 static int sta_info_insert_check(struct sta_info
*sta
)
442 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
445 * Can't be a WARN_ON because it can be triggered through a race:
446 * something inserts a STA (on one CPU) without holding the RTNL
447 * and another CPU turns off the net device.
449 if (unlikely(!ieee80211_sdata_running(sdata
)))
452 if (WARN_ON(ether_addr_equal(sta
->sta
.addr
, sdata
->vif
.addr
) ||
453 is_multicast_ether_addr(sta
->sta
.addr
)))
456 /* Strictly speaking this isn't necessary as we hold the mutex, but
457 * the rhashtable code can't really deal with that distinction. We
458 * do require the mutex for correctness though.
461 lockdep_assert_held(&sdata
->local
->sta_mtx
);
462 if (ieee80211_hw_check(&sdata
->local
->hw
, NEEDS_UNIQUE_STA_ADDR
) &&
463 ieee80211_find_sta_by_ifaddr(&sdata
->local
->hw
, sta
->addr
, NULL
)) {
472 static int sta_info_insert_drv_state(struct ieee80211_local
*local
,
473 struct ieee80211_sub_if_data
*sdata
,
474 struct sta_info
*sta
)
476 enum ieee80211_sta_state state
;
479 for (state
= IEEE80211_STA_NOTEXIST
; state
< sta
->sta_state
; state
++) {
480 err
= drv_sta_state(local
, sdata
, sta
, state
, state
+ 1);
487 * Drivers using legacy sta_add/sta_remove callbacks only
488 * get uploaded set to true after sta_add is called.
490 if (!local
->ops
->sta_add
)
491 sta
->uploaded
= true;
495 if (sdata
->vif
.type
== NL80211_IFTYPE_ADHOC
) {
497 "failed to move IBSS STA %pM to state %d (%d) - keeping it anyway\n",
498 sta
->sta
.addr
, state
+ 1, err
);
502 /* unwind on error */
503 for (; state
> IEEE80211_STA_NOTEXIST
; state
--)
504 WARN_ON(drv_sta_state(local
, sdata
, sta
, state
, state
- 1));
510 * should be called with sta_mtx locked
511 * this function replaces the mutex lock
514 static int sta_info_insert_finish(struct sta_info
*sta
) __acquires(RCU
)
516 struct ieee80211_local
*local
= sta
->local
;
517 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
518 struct station_info
*sinfo
;
521 lockdep_assert_held(&local
->sta_mtx
);
523 sinfo
= kzalloc(sizeof(struct station_info
), GFP_KERNEL
);
529 /* check if STA exists already */
530 if (sta_info_get_bss(sdata
, sta
->sta
.addr
)) {
536 local
->sta_generation
++;
539 /* simplify things and don't accept BA sessions yet */
540 set_sta_flag(sta
, WLAN_STA_BLOCK_BA
);
542 /* make the station visible */
543 err
= sta_info_hash_add(local
, sta
);
547 list_add_tail_rcu(&sta
->list
, &local
->sta_list
);
550 err
= sta_info_insert_drv_state(local
, sdata
, sta
);
554 set_sta_flag(sta
, WLAN_STA_INSERTED
);
555 /* accept BA sessions now */
556 clear_sta_flag(sta
, WLAN_STA_BLOCK_BA
);
558 ieee80211_sta_debugfs_add(sta
);
559 rate_control_add_sta_debugfs(sta
);
561 sinfo
->generation
= local
->sta_generation
;
562 cfg80211_new_sta(sdata
->dev
, sta
->sta
.addr
, sinfo
, GFP_KERNEL
);
565 sta_dbg(sdata
, "Inserted STA %pM\n", sta
->sta
.addr
);
567 /* move reference to rcu-protected */
569 mutex_unlock(&local
->sta_mtx
);
571 if (ieee80211_vif_is_mesh(&sdata
->vif
))
572 mesh_accept_plinks_update(sdata
);
576 sta_info_hash_del(local
, sta
);
577 list_del_rcu(&sta
->list
);
581 __cleanup_single_sta(sta
);
583 mutex_unlock(&local
->sta_mtx
);
589 int sta_info_insert_rcu(struct sta_info
*sta
) __acquires(RCU
)
591 struct ieee80211_local
*local
= sta
->local
;
596 mutex_lock(&local
->sta_mtx
);
598 err
= sta_info_insert_check(sta
);
600 mutex_unlock(&local
->sta_mtx
);
605 err
= sta_info_insert_finish(sta
);
611 sta_info_free(local
, sta
);
615 int sta_info_insert(struct sta_info
*sta
)
617 int err
= sta_info_insert_rcu(sta
);
624 static inline void __bss_tim_set(u8
*tim
, u16 id
)
627 * This format has been mandated by the IEEE specifications,
628 * so this line may not be changed to use the __set_bit() format.
630 tim
[id
/ 8] |= (1 << (id
% 8));
633 static inline void __bss_tim_clear(u8
*tim
, u16 id
)
636 * This format has been mandated by the IEEE specifications,
637 * so this line may not be changed to use the __clear_bit() format.
639 tim
[id
/ 8] &= ~(1 << (id
% 8));
642 static inline bool __bss_tim_get(u8
*tim
, u16 id
)
645 * This format has been mandated by the IEEE specifications,
646 * so this line may not be changed to use the test_bit() format.
648 return tim
[id
/ 8] & (1 << (id
% 8));
651 static unsigned long ieee80211_tids_for_ac(int ac
)
653 /* If we ever support TIDs > 7, this obviously needs to be adjusted */
655 case IEEE80211_AC_VO
:
656 return BIT(6) | BIT(7);
657 case IEEE80211_AC_VI
:
658 return BIT(4) | BIT(5);
659 case IEEE80211_AC_BE
:
660 return BIT(0) | BIT(3);
661 case IEEE80211_AC_BK
:
662 return BIT(1) | BIT(2);
669 static void __sta_info_recalc_tim(struct sta_info
*sta
, bool ignore_pending
)
671 struct ieee80211_local
*local
= sta
->local
;
673 bool indicate_tim
= false;
674 u8 ignore_for_tim
= sta
->sta
.uapsd_queues
;
676 u16 id
= sta
->sta
.aid
;
678 if (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP
||
679 sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
) {
680 if (WARN_ON_ONCE(!sta
->sdata
->bss
))
683 ps
= &sta
->sdata
->bss
->ps
;
684 #ifdef CONFIG_MAC80211_MESH
685 } else if (ieee80211_vif_is_mesh(&sta
->sdata
->vif
)) {
686 ps
= &sta
->sdata
->u
.mesh
.ps
;
692 /* No need to do anything if the driver does all */
693 if (ieee80211_hw_check(&local
->hw
, AP_LINK_PS
))
700 * If all ACs are delivery-enabled then we should build
701 * the TIM bit for all ACs anyway; if only some are then
702 * we ignore those and build the TIM bit using only the
705 if (ignore_for_tim
== BIT(IEEE80211_NUM_ACS
) - 1)
709 ignore_for_tim
= BIT(IEEE80211_NUM_ACS
) - 1;
711 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++) {
714 if (ignore_for_tim
& BIT(ac
))
717 indicate_tim
|= !skb_queue_empty(&sta
->tx_filtered
[ac
]) ||
718 !skb_queue_empty(&sta
->ps_tx_buf
[ac
]);
722 tids
= ieee80211_tids_for_ac(ac
);
725 sta
->driver_buffered_tids
& tids
;
727 sta
->txq_buffered_tids
& tids
;
731 spin_lock_bh(&local
->tim_lock
);
733 if (indicate_tim
== __bss_tim_get(ps
->tim
, id
))
737 __bss_tim_set(ps
->tim
, id
);
739 __bss_tim_clear(ps
->tim
, id
);
741 if (local
->ops
->set_tim
&& !WARN_ON(sta
->dead
)) {
742 local
->tim_in_locked_section
= true;
743 drv_set_tim(local
, &sta
->sta
, indicate_tim
);
744 local
->tim_in_locked_section
= false;
748 spin_unlock_bh(&local
->tim_lock
);
751 void sta_info_recalc_tim(struct sta_info
*sta
)
753 __sta_info_recalc_tim(sta
, false);
756 static bool sta_info_buffer_expired(struct sta_info
*sta
, struct sk_buff
*skb
)
758 struct ieee80211_tx_info
*info
;
764 info
= IEEE80211_SKB_CB(skb
);
766 /* Timeout: (2 * listen_interval * beacon_int * 1024 / 1000000) sec */
767 timeout
= (sta
->listen_interval
*
768 sta
->sdata
->vif
.bss_conf
.beacon_int
*
770 if (timeout
< STA_TX_BUFFER_EXPIRE
)
771 timeout
= STA_TX_BUFFER_EXPIRE
;
772 return time_after(jiffies
, info
->control
.jiffies
+ timeout
);
776 static bool sta_info_cleanup_expire_buffered_ac(struct ieee80211_local
*local
,
777 struct sta_info
*sta
, int ac
)
783 * First check for frames that should expire on the filtered
784 * queue. Frames here were rejected by the driver and are on
785 * a separate queue to avoid reordering with normal PS-buffered
786 * frames. They also aren't accounted for right now in the
787 * total_ps_buffered counter.
790 spin_lock_irqsave(&sta
->tx_filtered
[ac
].lock
, flags
);
791 skb
= skb_peek(&sta
->tx_filtered
[ac
]);
792 if (sta_info_buffer_expired(sta
, skb
))
793 skb
= __skb_dequeue(&sta
->tx_filtered
[ac
]);
796 spin_unlock_irqrestore(&sta
->tx_filtered
[ac
].lock
, flags
);
799 * Frames are queued in order, so if this one
800 * hasn't expired yet we can stop testing. If
801 * we actually reached the end of the queue we
802 * also need to stop, of course.
806 ieee80211_free_txskb(&local
->hw
, skb
);
810 * Now also check the normal PS-buffered queue, this will
811 * only find something if the filtered queue was emptied
812 * since the filtered frames are all before the normal PS
816 spin_lock_irqsave(&sta
->ps_tx_buf
[ac
].lock
, flags
);
817 skb
= skb_peek(&sta
->ps_tx_buf
[ac
]);
818 if (sta_info_buffer_expired(sta
, skb
))
819 skb
= __skb_dequeue(&sta
->ps_tx_buf
[ac
]);
822 spin_unlock_irqrestore(&sta
->ps_tx_buf
[ac
].lock
, flags
);
825 * frames are queued in order, so if this one
826 * hasn't expired yet (or we reached the end of
827 * the queue) we can stop testing
832 local
->total_ps_buffered
--;
833 ps_dbg(sta
->sdata
, "Buffered frame expired (STA %pM)\n",
835 ieee80211_free_txskb(&local
->hw
, skb
);
839 * Finally, recalculate the TIM bit for this station -- it might
840 * now be clear because the station was too slow to retrieve its
843 sta_info_recalc_tim(sta
);
846 * Return whether there are any frames still buffered, this is
847 * used to check whether the cleanup timer still needs to run,
848 * if there are no frames we don't need to rearm the timer.
850 return !(skb_queue_empty(&sta
->ps_tx_buf
[ac
]) &&
851 skb_queue_empty(&sta
->tx_filtered
[ac
]));
854 static bool sta_info_cleanup_expire_buffered(struct ieee80211_local
*local
,
855 struct sta_info
*sta
)
857 bool have_buffered
= false;
860 /* This is only necessary for stations on BSS/MBSS interfaces */
861 if (!sta
->sdata
->bss
&&
862 !ieee80211_vif_is_mesh(&sta
->sdata
->vif
))
865 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++)
867 sta_info_cleanup_expire_buffered_ac(local
, sta
, ac
);
869 return have_buffered
;
872 static int __must_check
__sta_info_destroy_part1(struct sta_info
*sta
)
874 struct ieee80211_local
*local
;
875 struct ieee80211_sub_if_data
*sdata
;
886 lockdep_assert_held(&local
->sta_mtx
);
889 * Before removing the station from the driver and
890 * rate control, it might still start new aggregation
891 * sessions -- block that to make sure the tear-down
892 * will be sufficient.
894 set_sta_flag(sta
, WLAN_STA_BLOCK_BA
);
895 ieee80211_sta_tear_down_BA_sessions(sta
, AGG_STOP_DESTROY_STA
);
898 * Before removing the station from the driver there might be pending
899 * rx frames on RSS queues sent prior to the disassociation - wait for
900 * all such frames to be processed.
902 drv_sync_rx_queues(local
, sta
);
904 ret
= sta_info_hash_del(local
, sta
);
909 * for TDLS peers, make sure to return to the base channel before
912 if (test_sta_flag(sta
, WLAN_STA_TDLS_OFF_CHANNEL
)) {
913 drv_tdls_cancel_channel_switch(local
, sdata
, &sta
->sta
);
914 clear_sta_flag(sta
, WLAN_STA_TDLS_OFF_CHANNEL
);
917 list_del_rcu(&sta
->list
);
920 drv_sta_pre_rcu_remove(local
, sta
->sdata
, sta
);
922 if (sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
&&
923 rcu_access_pointer(sdata
->u
.vlan
.sta
) == sta
)
924 RCU_INIT_POINTER(sdata
->u
.vlan
.sta
, NULL
);
929 static void __sta_info_destroy_part2(struct sta_info
*sta
)
931 struct ieee80211_local
*local
= sta
->local
;
932 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
933 struct station_info
*sinfo
;
937 * NOTE: This assumes at least synchronize_net() was done
938 * after _part1 and before _part2!
942 lockdep_assert_held(&local
->sta_mtx
);
944 /* now keys can no longer be reached */
945 ieee80211_free_sta_keys(local
, sta
);
947 /* disable TIM bit - last chance to tell driver */
948 __sta_info_recalc_tim(sta
, true);
953 local
->sta_generation
++;
955 while (sta
->sta_state
> IEEE80211_STA_NONE
) {
956 ret
= sta_info_move_state(sta
, sta
->sta_state
- 1);
964 ret
= drv_sta_state(local
, sdata
, sta
, IEEE80211_STA_NONE
,
965 IEEE80211_STA_NOTEXIST
);
966 WARN_ON_ONCE(ret
!= 0);
969 sta_dbg(sdata
, "Removed STA %pM\n", sta
->sta
.addr
);
971 sinfo
= kzalloc(sizeof(*sinfo
), GFP_KERNEL
);
973 sta_set_sinfo(sta
, sinfo
);
974 cfg80211_del_sta_sinfo(sdata
->dev
, sta
->sta
.addr
, sinfo
, GFP_KERNEL
);
977 rate_control_remove_sta_debugfs(sta
);
978 ieee80211_sta_debugfs_remove(sta
);
980 cleanup_single_sta(sta
);
983 int __must_check
__sta_info_destroy(struct sta_info
*sta
)
985 int err
= __sta_info_destroy_part1(sta
);
992 __sta_info_destroy_part2(sta
);
997 int sta_info_destroy_addr(struct ieee80211_sub_if_data
*sdata
, const u8
*addr
)
999 struct sta_info
*sta
;
1002 mutex_lock(&sdata
->local
->sta_mtx
);
1003 sta
= sta_info_get(sdata
, addr
);
1004 ret
= __sta_info_destroy(sta
);
1005 mutex_unlock(&sdata
->local
->sta_mtx
);
1010 int sta_info_destroy_addr_bss(struct ieee80211_sub_if_data
*sdata
,
1013 struct sta_info
*sta
;
1016 mutex_lock(&sdata
->local
->sta_mtx
);
1017 sta
= sta_info_get_bss(sdata
, addr
);
1018 ret
= __sta_info_destroy(sta
);
1019 mutex_unlock(&sdata
->local
->sta_mtx
);
1024 static void sta_info_cleanup(unsigned long data
)
1026 struct ieee80211_local
*local
= (struct ieee80211_local
*) data
;
1027 struct sta_info
*sta
;
1028 bool timer_needed
= false;
1031 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
)
1032 if (sta_info_cleanup_expire_buffered(local
, sta
))
1033 timer_needed
= true;
1036 if (local
->quiescing
)
1042 mod_timer(&local
->sta_cleanup
,
1043 round_jiffies(jiffies
+ STA_INFO_CLEANUP_INTERVAL
));
1046 u32
sta_addr_hash(const void *key
, u32 length
, u32 seed
)
1048 return jhash(key
, ETH_ALEN
, seed
);
1051 int sta_info_init(struct ieee80211_local
*local
)
1055 err
= rhashtable_init(&local
->sta_hash
, &sta_rht_params
);
1059 spin_lock_init(&local
->tim_lock
);
1060 mutex_init(&local
->sta_mtx
);
1061 INIT_LIST_HEAD(&local
->sta_list
);
1063 setup_timer(&local
->sta_cleanup
, sta_info_cleanup
,
1064 (unsigned long)local
);
1068 void sta_info_stop(struct ieee80211_local
*local
)
1070 del_timer_sync(&local
->sta_cleanup
);
1071 rhashtable_destroy(&local
->sta_hash
);
1075 int __sta_info_flush(struct ieee80211_sub_if_data
*sdata
, bool vlans
)
1077 struct ieee80211_local
*local
= sdata
->local
;
1078 struct sta_info
*sta
, *tmp
;
1079 LIST_HEAD(free_list
);
1084 WARN_ON(vlans
&& sdata
->vif
.type
!= NL80211_IFTYPE_AP
);
1085 WARN_ON(vlans
&& !sdata
->bss
);
1087 mutex_lock(&local
->sta_mtx
);
1088 list_for_each_entry_safe(sta
, tmp
, &local
->sta_list
, list
) {
1089 if (sdata
== sta
->sdata
||
1090 (vlans
&& sdata
->bss
== sta
->sdata
->bss
)) {
1091 if (!WARN_ON(__sta_info_destroy_part1(sta
)))
1092 list_add(&sta
->free_list
, &free_list
);
1097 if (!list_empty(&free_list
)) {
1099 list_for_each_entry_safe(sta
, tmp
, &free_list
, free_list
)
1100 __sta_info_destroy_part2(sta
);
1102 mutex_unlock(&local
->sta_mtx
);
1107 void ieee80211_sta_expire(struct ieee80211_sub_if_data
*sdata
,
1108 unsigned long exp_time
)
1110 struct ieee80211_local
*local
= sdata
->local
;
1111 struct sta_info
*sta
, *tmp
;
1113 mutex_lock(&local
->sta_mtx
);
1115 list_for_each_entry_safe(sta
, tmp
, &local
->sta_list
, list
) {
1116 unsigned long last_active
= ieee80211_sta_last_active(sta
);
1118 if (sdata
!= sta
->sdata
)
1121 if (time_is_before_jiffies(last_active
+ exp_time
)) {
1122 sta_dbg(sta
->sdata
, "expiring inactive STA %pM\n",
1125 if (ieee80211_vif_is_mesh(&sdata
->vif
) &&
1126 test_sta_flag(sta
, WLAN_STA_PS_STA
))
1127 atomic_dec(&sdata
->u
.mesh
.ps
.num_sta_ps
);
1129 WARN_ON(__sta_info_destroy(sta
));
1133 mutex_unlock(&local
->sta_mtx
);
1136 struct ieee80211_sta
*ieee80211_find_sta_by_ifaddr(struct ieee80211_hw
*hw
,
1138 const u8
*localaddr
)
1140 struct ieee80211_local
*local
= hw_to_local(hw
);
1141 struct sta_info
*sta
;
1142 struct rhash_head
*tmp
;
1143 const struct bucket_table
*tbl
;
1145 tbl
= rht_dereference_rcu(local
->sta_hash
.tbl
, &local
->sta_hash
);
1148 * Just return a random station if localaddr is NULL
1149 * ... first in list.
1151 for_each_sta_info(local
, tbl
, addr
, sta
, tmp
) {
1153 !ether_addr_equal(sta
->sdata
->vif
.addr
, localaddr
))
1162 EXPORT_SYMBOL_GPL(ieee80211_find_sta_by_ifaddr
);
1164 struct ieee80211_sta
*ieee80211_find_sta(struct ieee80211_vif
*vif
,
1167 struct sta_info
*sta
;
1172 sta
= sta_info_get_bss(vif_to_sdata(vif
), addr
);
1181 EXPORT_SYMBOL(ieee80211_find_sta
);
1183 /* powersave support code */
1184 void ieee80211_sta_ps_deliver_wakeup(struct sta_info
*sta
)
1186 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
1187 struct ieee80211_local
*local
= sdata
->local
;
1188 struct sk_buff_head pending
;
1189 int filtered
= 0, buffered
= 0, ac
, i
;
1190 unsigned long flags
;
1193 if (sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
)
1194 sdata
= container_of(sdata
->bss
, struct ieee80211_sub_if_data
,
1197 if (sdata
->vif
.type
== NL80211_IFTYPE_AP
)
1198 ps
= &sdata
->bss
->ps
;
1199 else if (ieee80211_vif_is_mesh(&sdata
->vif
))
1200 ps
= &sdata
->u
.mesh
.ps
;
1204 clear_sta_flag(sta
, WLAN_STA_SP
);
1206 BUILD_BUG_ON(BITS_TO_LONGS(IEEE80211_NUM_TIDS
) > 1);
1207 sta
->driver_buffered_tids
= 0;
1208 sta
->txq_buffered_tids
= 0;
1210 if (!ieee80211_hw_check(&local
->hw
, AP_LINK_PS
))
1211 drv_sta_notify(local
, sdata
, STA_NOTIFY_AWAKE
, &sta
->sta
);
1213 if (sta
->sta
.txq
[0]) {
1214 for (i
= 0; i
< ARRAY_SIZE(sta
->sta
.txq
); i
++) {
1215 struct txq_info
*txqi
= to_txq_info(sta
->sta
.txq
[i
]);
1217 if (!txqi
->tin
.backlog_packets
)
1220 drv_wake_tx_queue(local
, txqi
);
1224 skb_queue_head_init(&pending
);
1226 /* sync with ieee80211_tx_h_unicast_ps_buf */
1227 spin_lock(&sta
->ps_lock
);
1228 /* Send all buffered frames to the station */
1229 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++) {
1230 int count
= skb_queue_len(&pending
), tmp
;
1232 spin_lock_irqsave(&sta
->tx_filtered
[ac
].lock
, flags
);
1233 skb_queue_splice_tail_init(&sta
->tx_filtered
[ac
], &pending
);
1234 spin_unlock_irqrestore(&sta
->tx_filtered
[ac
].lock
, flags
);
1235 tmp
= skb_queue_len(&pending
);
1236 filtered
+= tmp
- count
;
1239 spin_lock_irqsave(&sta
->ps_tx_buf
[ac
].lock
, flags
);
1240 skb_queue_splice_tail_init(&sta
->ps_tx_buf
[ac
], &pending
);
1241 spin_unlock_irqrestore(&sta
->ps_tx_buf
[ac
].lock
, flags
);
1242 tmp
= skb_queue_len(&pending
);
1243 buffered
+= tmp
- count
;
1246 ieee80211_add_pending_skbs(local
, &pending
);
1248 /* now we're no longer in the deliver code */
1249 clear_sta_flag(sta
, WLAN_STA_PS_DELIVER
);
1251 /* The station might have polled and then woken up before we responded,
1252 * so clear these flags now to avoid them sticking around.
1254 clear_sta_flag(sta
, WLAN_STA_PSPOLL
);
1255 clear_sta_flag(sta
, WLAN_STA_UAPSD
);
1256 spin_unlock(&sta
->ps_lock
);
1258 atomic_dec(&ps
->num_sta_ps
);
1260 /* This station just woke up and isn't aware of our SMPS state */
1261 if (!ieee80211_vif_is_mesh(&sdata
->vif
) &&
1262 !ieee80211_smps_is_restrictive(sta
->known_smps_mode
,
1263 sdata
->smps_mode
) &&
1264 sta
->known_smps_mode
!= sdata
->bss
->req_smps
&&
1265 sta_info_tx_streams(sta
) != 1) {
1267 "%pM just woke up and MIMO capable - update SMPS\n",
1269 ieee80211_send_smps_action(sdata
, sdata
->bss
->req_smps
,
1271 sdata
->vif
.bss_conf
.bssid
);
1274 local
->total_ps_buffered
-= buffered
;
1276 sta_info_recalc_tim(sta
);
1279 "STA %pM aid %d sending %d filtered/%d PS frames since STA not sleeping anymore\n",
1280 sta
->sta
.addr
, sta
->sta
.aid
, filtered
, buffered
);
1282 ieee80211_check_fast_xmit(sta
);
1285 static void ieee80211_send_null_response(struct sta_info
*sta
, int tid
,
1286 enum ieee80211_frame_release_type reason
,
1287 bool call_driver
, bool more_data
)
1289 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
1290 struct ieee80211_local
*local
= sdata
->local
;
1291 struct ieee80211_qos_hdr
*nullfunc
;
1292 struct sk_buff
*skb
;
1293 int size
= sizeof(*nullfunc
);
1295 bool qos
= sta
->sta
.wme
;
1296 struct ieee80211_tx_info
*info
;
1297 struct ieee80211_chanctx_conf
*chanctx_conf
;
1300 fc
= cpu_to_le16(IEEE80211_FTYPE_DATA
|
1301 IEEE80211_STYPE_QOS_NULLFUNC
|
1302 IEEE80211_FCTL_FROMDS
);
1305 fc
= cpu_to_le16(IEEE80211_FTYPE_DATA
|
1306 IEEE80211_STYPE_NULLFUNC
|
1307 IEEE80211_FCTL_FROMDS
);
1310 skb
= dev_alloc_skb(local
->hw
.extra_tx_headroom
+ size
);
1314 skb_reserve(skb
, local
->hw
.extra_tx_headroom
);
1316 nullfunc
= (void *) skb_put(skb
, size
);
1317 nullfunc
->frame_control
= fc
;
1318 nullfunc
->duration_id
= 0;
1319 memcpy(nullfunc
->addr1
, sta
->sta
.addr
, ETH_ALEN
);
1320 memcpy(nullfunc
->addr2
, sdata
->vif
.addr
, ETH_ALEN
);
1321 memcpy(nullfunc
->addr3
, sdata
->vif
.addr
, ETH_ALEN
);
1322 nullfunc
->seq_ctrl
= 0;
1324 skb
->priority
= tid
;
1325 skb_set_queue_mapping(skb
, ieee802_1d_to_ac
[tid
]);
1327 nullfunc
->qos_ctrl
= cpu_to_le16(tid
);
1329 if (reason
== IEEE80211_FRAME_RELEASE_UAPSD
) {
1330 nullfunc
->qos_ctrl
|=
1331 cpu_to_le16(IEEE80211_QOS_CTL_EOSP
);
1333 nullfunc
->frame_control
|=
1334 cpu_to_le16(IEEE80211_FCTL_MOREDATA
);
1338 info
= IEEE80211_SKB_CB(skb
);
1341 * Tell TX path to send this frame even though the
1342 * STA may still remain is PS mode after this frame
1343 * exchange. Also set EOSP to indicate this packet
1344 * ends the poll/service period.
1346 info
->flags
|= IEEE80211_TX_CTL_NO_PS_BUFFER
|
1347 IEEE80211_TX_STATUS_EOSP
|
1348 IEEE80211_TX_CTL_REQ_TX_STATUS
;
1350 info
->control
.flags
|= IEEE80211_TX_CTRL_PS_RESPONSE
;
1353 drv_allow_buffered_frames(local
, sta
, BIT(tid
), 1,
1356 skb
->dev
= sdata
->dev
;
1359 chanctx_conf
= rcu_dereference(sdata
->vif
.chanctx_conf
);
1360 if (WARN_ON(!chanctx_conf
)) {
1366 info
->band
= chanctx_conf
->def
.chan
->band
;
1367 ieee80211_xmit(sdata
, sta
, skb
);
1371 static int find_highest_prio_tid(unsigned long tids
)
1373 /* lower 3 TIDs aren't ordered perfectly */
1375 return fls(tids
) - 1;
1376 /* TID 0 is BE just like TID 3 */
1379 return fls(tids
) - 1;
1382 /* Indicates if the MORE_DATA bit should be set in the last
1383 * frame obtained by ieee80211_sta_ps_get_frames.
1384 * Note that driver_release_tids is relevant only if
1385 * reason = IEEE80211_FRAME_RELEASE_PSPOLL
1388 ieee80211_sta_ps_more_data(struct sta_info
*sta
, u8 ignored_acs
,
1389 enum ieee80211_frame_release_type reason
,
1390 unsigned long driver_release_tids
)
1394 /* If the driver has data on more than one TID then
1395 * certainly there's more data if we release just a
1396 * single frame now (from a single TID). This will
1397 * only happen for PS-Poll.
1399 if (reason
== IEEE80211_FRAME_RELEASE_PSPOLL
&&
1400 hweight16(driver_release_tids
) > 1)
1403 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++) {
1404 if (ignored_acs
& BIT(ac
))
1407 if (!skb_queue_empty(&sta
->tx_filtered
[ac
]) ||
1408 !skb_queue_empty(&sta
->ps_tx_buf
[ac
]))
1416 ieee80211_sta_ps_get_frames(struct sta_info
*sta
, int n_frames
, u8 ignored_acs
,
1417 enum ieee80211_frame_release_type reason
,
1418 struct sk_buff_head
*frames
,
1419 unsigned long *driver_release_tids
)
1421 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
1422 struct ieee80211_local
*local
= sdata
->local
;
1425 /* Get response frame(s) and more data bit for the last one. */
1426 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++) {
1429 if (ignored_acs
& BIT(ac
))
1432 tids
= ieee80211_tids_for_ac(ac
);
1434 /* if we already have frames from software, then we can't also
1435 * release from hardware queues
1437 if (skb_queue_empty(frames
)) {
1438 *driver_release_tids
|=
1439 sta
->driver_buffered_tids
& tids
;
1440 *driver_release_tids
|= sta
->txq_buffered_tids
& tids
;
1443 if (!*driver_release_tids
) {
1444 struct sk_buff
*skb
;
1446 while (n_frames
> 0) {
1447 skb
= skb_dequeue(&sta
->tx_filtered
[ac
]);
1450 &sta
->ps_tx_buf
[ac
]);
1452 local
->total_ps_buffered
--;
1457 __skb_queue_tail(frames
, skb
);
1461 /* If we have more frames buffered on this AC, then abort the
1462 * loop since we can't send more data from other ACs before
1463 * the buffered frames from this.
1465 if (!skb_queue_empty(&sta
->tx_filtered
[ac
]) ||
1466 !skb_queue_empty(&sta
->ps_tx_buf
[ac
]))
1472 ieee80211_sta_ps_deliver_response(struct sta_info
*sta
,
1473 int n_frames
, u8 ignored_acs
,
1474 enum ieee80211_frame_release_type reason
)
1476 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
1477 struct ieee80211_local
*local
= sdata
->local
;
1478 unsigned long driver_release_tids
= 0;
1479 struct sk_buff_head frames
;
1482 /* Service or PS-Poll period starts */
1483 set_sta_flag(sta
, WLAN_STA_SP
);
1485 __skb_queue_head_init(&frames
);
1487 ieee80211_sta_ps_get_frames(sta
, n_frames
, ignored_acs
, reason
,
1488 &frames
, &driver_release_tids
);
1490 more_data
= ieee80211_sta_ps_more_data(sta
, ignored_acs
, reason
, driver_release_tids
);
1492 if (driver_release_tids
&& reason
== IEEE80211_FRAME_RELEASE_PSPOLL
)
1493 driver_release_tids
=
1494 BIT(find_highest_prio_tid(driver_release_tids
));
1496 if (skb_queue_empty(&frames
) && !driver_release_tids
) {
1500 * For PS-Poll, this can only happen due to a race condition
1501 * when we set the TIM bit and the station notices it, but
1502 * before it can poll for the frame we expire it.
1504 * For uAPSD, this is said in the standard (11.2.1.5 h):
1505 * At each unscheduled SP for a non-AP STA, the AP shall
1506 * attempt to transmit at least one MSDU or MMPDU, but no
1507 * more than the value specified in the Max SP Length field
1508 * in the QoS Capability element from delivery-enabled ACs,
1509 * that are destined for the non-AP STA.
1511 * Since we have no other MSDU/MMPDU, transmit a QoS null frame.
1514 /* This will evaluate to 1, 3, 5 or 7. */
1515 tid
= 7 - ((ffs(~ignored_acs
) - 1) << 1);
1517 ieee80211_send_null_response(sta
, tid
, reason
, true, false);
1518 } else if (!driver_release_tids
) {
1519 struct sk_buff_head pending
;
1520 struct sk_buff
*skb
;
1523 bool need_null
= false;
1525 skb_queue_head_init(&pending
);
1527 while ((skb
= __skb_dequeue(&frames
))) {
1528 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
1529 struct ieee80211_hdr
*hdr
= (void *) skb
->data
;
1535 * Tell TX path to send this frame even though the
1536 * STA may still remain is PS mode after this frame
1539 info
->flags
|= IEEE80211_TX_CTL_NO_PS_BUFFER
;
1540 info
->control
.flags
|= IEEE80211_TX_CTRL_PS_RESPONSE
;
1543 * Use MoreData flag to indicate whether there are
1544 * more buffered frames for this STA
1546 if (more_data
|| !skb_queue_empty(&frames
))
1547 hdr
->frame_control
|=
1548 cpu_to_le16(IEEE80211_FCTL_MOREDATA
);
1550 hdr
->frame_control
&=
1551 cpu_to_le16(~IEEE80211_FCTL_MOREDATA
);
1553 if (ieee80211_is_data_qos(hdr
->frame_control
) ||
1554 ieee80211_is_qos_nullfunc(hdr
->frame_control
))
1555 qoshdr
= ieee80211_get_qos_ctl(hdr
);
1557 tids
|= BIT(skb
->priority
);
1559 __skb_queue_tail(&pending
, skb
);
1561 /* end service period after last frame or add one */
1562 if (!skb_queue_empty(&frames
))
1565 if (reason
!= IEEE80211_FRAME_RELEASE_UAPSD
) {
1566 /* for PS-Poll, there's only one frame */
1567 info
->flags
|= IEEE80211_TX_STATUS_EOSP
|
1568 IEEE80211_TX_CTL_REQ_TX_STATUS
;
1572 /* For uAPSD, things are a bit more complicated. If the
1573 * last frame has a QoS header (i.e. is a QoS-data or
1574 * QoS-nulldata frame) then just set the EOSP bit there
1576 * If the frame doesn't have a QoS header (which means
1577 * it should be a bufferable MMPDU) then we can't set
1578 * the EOSP bit in the QoS header; add a QoS-nulldata
1579 * frame to the list to send it after the MMPDU.
1581 * Note that this code is only in the mac80211-release
1582 * code path, we assume that the driver will not buffer
1583 * anything but QoS-data frames, or if it does, will
1584 * create the QoS-nulldata frame by itself if needed.
1586 * Cf. 802.11-2012 10.2.1.10 (c).
1589 *qoshdr
|= IEEE80211_QOS_CTL_EOSP
;
1591 info
->flags
|= IEEE80211_TX_STATUS_EOSP
|
1592 IEEE80211_TX_CTL_REQ_TX_STATUS
;
1594 /* The standard isn't completely clear on this
1595 * as it says the more-data bit should be set
1596 * if there are more BUs. The QoS-Null frame
1597 * we're about to send isn't buffered yet, we
1598 * only create it below, but let's pretend it
1599 * was buffered just in case some clients only
1600 * expect more-data=0 when eosp=1.
1602 hdr
->frame_control
|=
1603 cpu_to_le16(IEEE80211_FCTL_MOREDATA
);
1610 drv_allow_buffered_frames(local
, sta
, tids
, num
,
1613 ieee80211_add_pending_skbs(local
, &pending
);
1616 ieee80211_send_null_response(
1617 sta
, find_highest_prio_tid(tids
),
1618 reason
, false, false);
1620 sta_info_recalc_tim(sta
);
1625 * We need to release a frame that is buffered somewhere in the
1626 * driver ... it'll have to handle that.
1627 * Note that the driver also has to check the number of frames
1628 * on the TIDs we're releasing from - if there are more than
1629 * n_frames it has to set the more-data bit (if we didn't ask
1630 * it to set it anyway due to other buffered frames); if there
1631 * are fewer than n_frames it has to make sure to adjust that
1632 * to allow the service period to end properly.
1634 drv_release_buffered_frames(local
, sta
, driver_release_tids
,
1635 n_frames
, reason
, more_data
);
1638 * Note that we don't recalculate the TIM bit here as it would
1639 * most likely have no effect at all unless the driver told us
1640 * that the TID(s) became empty before returning here from the
1642 * Either way, however, when the driver tells us that the TID(s)
1643 * became empty or we find that a txq became empty, we'll do the
1644 * TIM recalculation.
1647 if (!sta
->sta
.txq
[0])
1650 for (tid
= 0; tid
< ARRAY_SIZE(sta
->sta
.txq
); tid
++) {
1651 struct txq_info
*txqi
= to_txq_info(sta
->sta
.txq
[tid
]);
1653 if (!(driver_release_tids
& BIT(tid
)) ||
1654 txqi
->tin
.backlog_packets
)
1657 sta_info_recalc_tim(sta
);
1663 void ieee80211_sta_ps_deliver_poll_response(struct sta_info
*sta
)
1665 u8 ignore_for_response
= sta
->sta
.uapsd_queues
;
1668 * If all ACs are delivery-enabled then we should reply
1669 * from any of them, if only some are enabled we reply
1670 * only from the non-enabled ones.
1672 if (ignore_for_response
== BIT(IEEE80211_NUM_ACS
) - 1)
1673 ignore_for_response
= 0;
1675 ieee80211_sta_ps_deliver_response(sta
, 1, ignore_for_response
,
1676 IEEE80211_FRAME_RELEASE_PSPOLL
);
1679 void ieee80211_sta_ps_deliver_uapsd(struct sta_info
*sta
)
1681 int n_frames
= sta
->sta
.max_sp
;
1682 u8 delivery_enabled
= sta
->sta
.uapsd_queues
;
1685 * If we ever grow support for TSPEC this might happen if
1686 * the TSPEC update from hostapd comes in between a trigger
1687 * frame setting WLAN_STA_UAPSD in the RX path and this
1688 * actually getting called.
1690 if (!delivery_enabled
)
1693 switch (sta
->sta
.max_sp
) {
1704 /* XXX: what is a good value? */
1709 ieee80211_sta_ps_deliver_response(sta
, n_frames
, ~delivery_enabled
,
1710 IEEE80211_FRAME_RELEASE_UAPSD
);
1713 void ieee80211_sta_block_awake(struct ieee80211_hw
*hw
,
1714 struct ieee80211_sta
*pubsta
, bool block
)
1716 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
1718 trace_api_sta_block_awake(sta
->local
, pubsta
, block
);
1721 set_sta_flag(sta
, WLAN_STA_PS_DRIVER
);
1722 ieee80211_clear_fast_xmit(sta
);
1726 if (!test_sta_flag(sta
, WLAN_STA_PS_DRIVER
))
1729 if (!test_sta_flag(sta
, WLAN_STA_PS_STA
)) {
1730 set_sta_flag(sta
, WLAN_STA_PS_DELIVER
);
1731 clear_sta_flag(sta
, WLAN_STA_PS_DRIVER
);
1732 ieee80211_queue_work(hw
, &sta
->drv_deliver_wk
);
1733 } else if (test_sta_flag(sta
, WLAN_STA_PSPOLL
) ||
1734 test_sta_flag(sta
, WLAN_STA_UAPSD
)) {
1735 /* must be asleep in this case */
1736 clear_sta_flag(sta
, WLAN_STA_PS_DRIVER
);
1737 ieee80211_queue_work(hw
, &sta
->drv_deliver_wk
);
1739 clear_sta_flag(sta
, WLAN_STA_PS_DRIVER
);
1740 ieee80211_check_fast_xmit(sta
);
1743 EXPORT_SYMBOL(ieee80211_sta_block_awake
);
1745 void ieee80211_sta_eosp(struct ieee80211_sta
*pubsta
)
1747 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
1748 struct ieee80211_local
*local
= sta
->local
;
1750 trace_api_eosp(local
, pubsta
);
1752 clear_sta_flag(sta
, WLAN_STA_SP
);
1754 EXPORT_SYMBOL(ieee80211_sta_eosp
);
1756 void ieee80211_send_eosp_nullfunc(struct ieee80211_sta
*pubsta
, int tid
)
1758 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
1759 enum ieee80211_frame_release_type reason
;
1762 trace_api_send_eosp_nullfunc(sta
->local
, pubsta
, tid
);
1764 reason
= IEEE80211_FRAME_RELEASE_UAPSD
;
1765 more_data
= ieee80211_sta_ps_more_data(sta
, ~sta
->sta
.uapsd_queues
,
1768 ieee80211_send_null_response(sta
, tid
, reason
, false, more_data
);
1770 EXPORT_SYMBOL(ieee80211_send_eosp_nullfunc
);
1772 void ieee80211_sta_set_buffered(struct ieee80211_sta
*pubsta
,
1773 u8 tid
, bool buffered
)
1775 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
1777 if (WARN_ON(tid
>= IEEE80211_NUM_TIDS
))
1780 trace_api_sta_set_buffered(sta
->local
, pubsta
, tid
, buffered
);
1783 set_bit(tid
, &sta
->driver_buffered_tids
);
1785 clear_bit(tid
, &sta
->driver_buffered_tids
);
1787 sta_info_recalc_tim(sta
);
1789 EXPORT_SYMBOL(ieee80211_sta_set_buffered
);
1792 ieee80211_recalc_p2p_go_ps_allowed(struct ieee80211_sub_if_data
*sdata
)
1794 struct ieee80211_local
*local
= sdata
->local
;
1795 bool allow_p2p_go_ps
= sdata
->vif
.p2p
;
1796 struct sta_info
*sta
;
1799 list_for_each_entry_rcu(sta
, &local
->sta_list
, list
) {
1800 if (sdata
!= sta
->sdata
||
1801 !test_sta_flag(sta
, WLAN_STA_ASSOC
))
1803 if (!sta
->sta
.support_p2p_ps
) {
1804 allow_p2p_go_ps
= false;
1810 if (allow_p2p_go_ps
!= sdata
->vif
.bss_conf
.allow_p2p_go_ps
) {
1811 sdata
->vif
.bss_conf
.allow_p2p_go_ps
= allow_p2p_go_ps
;
1812 ieee80211_bss_info_change_notify(sdata
, BSS_CHANGED_P2P_PS
);
1816 int sta_info_move_state(struct sta_info
*sta
,
1817 enum ieee80211_sta_state new_state
)
1821 if (sta
->sta_state
== new_state
)
1824 /* check allowed transitions first */
1826 switch (new_state
) {
1827 case IEEE80211_STA_NONE
:
1828 if (sta
->sta_state
!= IEEE80211_STA_AUTH
)
1831 case IEEE80211_STA_AUTH
:
1832 if (sta
->sta_state
!= IEEE80211_STA_NONE
&&
1833 sta
->sta_state
!= IEEE80211_STA_ASSOC
)
1836 case IEEE80211_STA_ASSOC
:
1837 if (sta
->sta_state
!= IEEE80211_STA_AUTH
&&
1838 sta
->sta_state
!= IEEE80211_STA_AUTHORIZED
)
1841 case IEEE80211_STA_AUTHORIZED
:
1842 if (sta
->sta_state
!= IEEE80211_STA_ASSOC
)
1846 WARN(1, "invalid state %d", new_state
);
1850 sta_dbg(sta
->sdata
, "moving STA %pM to state %d\n",
1851 sta
->sta
.addr
, new_state
);
1854 * notify the driver before the actual changes so it can
1855 * fail the transition
1857 if (test_sta_flag(sta
, WLAN_STA_INSERTED
)) {
1858 int err
= drv_sta_state(sta
->local
, sta
->sdata
, sta
,
1859 sta
->sta_state
, new_state
);
1864 /* reflect the change in all state variables */
1866 switch (new_state
) {
1867 case IEEE80211_STA_NONE
:
1868 if (sta
->sta_state
== IEEE80211_STA_AUTH
)
1869 clear_bit(WLAN_STA_AUTH
, &sta
->_flags
);
1871 case IEEE80211_STA_AUTH
:
1872 if (sta
->sta_state
== IEEE80211_STA_NONE
) {
1873 set_bit(WLAN_STA_AUTH
, &sta
->_flags
);
1874 } else if (sta
->sta_state
== IEEE80211_STA_ASSOC
) {
1875 clear_bit(WLAN_STA_ASSOC
, &sta
->_flags
);
1876 ieee80211_recalc_min_chandef(sta
->sdata
);
1877 if (!sta
->sta
.support_p2p_ps
)
1878 ieee80211_recalc_p2p_go_ps_allowed(sta
->sdata
);
1881 case IEEE80211_STA_ASSOC
:
1882 if (sta
->sta_state
== IEEE80211_STA_AUTH
) {
1883 set_bit(WLAN_STA_ASSOC
, &sta
->_flags
);
1884 ieee80211_recalc_min_chandef(sta
->sdata
);
1885 if (!sta
->sta
.support_p2p_ps
)
1886 ieee80211_recalc_p2p_go_ps_allowed(sta
->sdata
);
1887 } else if (sta
->sta_state
== IEEE80211_STA_AUTHORIZED
) {
1888 if (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP
||
1889 (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
&&
1890 !sta
->sdata
->u
.vlan
.sta
))
1891 atomic_dec(&sta
->sdata
->bss
->num_mcast_sta
);
1892 clear_bit(WLAN_STA_AUTHORIZED
, &sta
->_flags
);
1893 ieee80211_clear_fast_xmit(sta
);
1894 ieee80211_clear_fast_rx(sta
);
1897 case IEEE80211_STA_AUTHORIZED
:
1898 if (sta
->sta_state
== IEEE80211_STA_ASSOC
) {
1899 if (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP
||
1900 (sta
->sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
&&
1901 !sta
->sdata
->u
.vlan
.sta
))
1902 atomic_inc(&sta
->sdata
->bss
->num_mcast_sta
);
1903 set_bit(WLAN_STA_AUTHORIZED
, &sta
->_flags
);
1904 ieee80211_check_fast_xmit(sta
);
1905 ieee80211_check_fast_rx(sta
);
1912 sta
->sta_state
= new_state
;
1917 u8
sta_info_tx_streams(struct sta_info
*sta
)
1919 struct ieee80211_sta_ht_cap
*ht_cap
= &sta
->sta
.ht_cap
;
1922 if (!sta
->sta
.ht_cap
.ht_supported
)
1925 if (sta
->sta
.vht_cap
.vht_supported
) {
1928 le16_to_cpu(sta
->sta
.vht_cap
.vht_mcs
.tx_mcs_map
);
1930 for (i
= 7; i
>= 0; i
--)
1931 if ((tx_mcs_map
& (0x3 << (i
* 2))) !=
1932 IEEE80211_VHT_MCS_NOT_SUPPORTED
)
1936 if (ht_cap
->mcs
.rx_mask
[3])
1938 else if (ht_cap
->mcs
.rx_mask
[2])
1940 else if (ht_cap
->mcs
.rx_mask
[1])
1945 if (!(ht_cap
->mcs
.tx_params
& IEEE80211_HT_MCS_TX_RX_DIFF
))
1948 return ((ht_cap
->mcs
.tx_params
& IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK
)
1949 >> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT
) + 1;
1952 static struct ieee80211_sta_rx_stats
*
1953 sta_get_last_rx_stats(struct sta_info
*sta
)
1955 struct ieee80211_sta_rx_stats
*stats
= &sta
->rx_stats
;
1956 struct ieee80211_local
*local
= sta
->local
;
1959 if (!ieee80211_hw_check(&local
->hw
, USES_RSS
))
1962 for_each_possible_cpu(cpu
) {
1963 struct ieee80211_sta_rx_stats
*cpustats
;
1965 cpustats
= per_cpu_ptr(sta
->pcpu_rx_stats
, cpu
);
1967 if (time_after(cpustats
->last_rx
, stats
->last_rx
))
1974 static void sta_stats_decode_rate(struct ieee80211_local
*local
, u16 rate
,
1975 struct rate_info
*rinfo
)
1977 rinfo
->bw
= (rate
& STA_STATS_RATE_BW_MASK
) >>
1978 STA_STATS_RATE_BW_SHIFT
;
1980 if (rate
& STA_STATS_RATE_VHT
) {
1981 rinfo
->flags
= RATE_INFO_FLAGS_VHT_MCS
;
1982 rinfo
->mcs
= rate
& 0xf;
1983 rinfo
->nss
= (rate
& 0xf0) >> 4;
1984 } else if (rate
& STA_STATS_RATE_HT
) {
1985 rinfo
->flags
= RATE_INFO_FLAGS_MCS
;
1986 rinfo
->mcs
= rate
& 0xff;
1987 } else if (rate
& STA_STATS_RATE_LEGACY
) {
1988 struct ieee80211_supported_band
*sband
;
1992 sband
= local
->hw
.wiphy
->bands
[(rate
>> 4) & 0xf];
1993 brate
= sband
->bitrates
[rate
& 0xf].bitrate
;
1994 if (rinfo
->bw
== RATE_INFO_BW_5
)
1996 else if (rinfo
->bw
== RATE_INFO_BW_10
)
2000 rinfo
->legacy
= DIV_ROUND_UP(brate
, 1 << shift
);
2003 if (rate
& STA_STATS_RATE_SGI
)
2004 rinfo
->flags
|= RATE_INFO_FLAGS_SHORT_GI
;
2007 static void sta_set_rate_info_rx(struct sta_info
*sta
, struct rate_info
*rinfo
)
2009 u16 rate
= ACCESS_ONCE(sta_get_last_rx_stats(sta
)->last_rate
);
2011 if (rate
== STA_STATS_RATE_INVALID
)
2014 sta_stats_decode_rate(sta
->local
, rate
, rinfo
);
2017 static void sta_set_tidstats(struct sta_info
*sta
,
2018 struct cfg80211_tid_stats
*tidstats
,
2021 struct ieee80211_local
*local
= sta
->local
;
2023 if (!(tidstats
->filled
& BIT(NL80211_TID_STATS_RX_MSDU
))) {
2027 start
= u64_stats_fetch_begin(&sta
->rx_stats
.syncp
);
2028 tidstats
->rx_msdu
= sta
->rx_stats
.msdu
[tid
];
2029 } while (u64_stats_fetch_retry(&sta
->rx_stats
.syncp
, start
));
2031 tidstats
->filled
|= BIT(NL80211_TID_STATS_RX_MSDU
);
2034 if (!(tidstats
->filled
& BIT(NL80211_TID_STATS_TX_MSDU
))) {
2035 tidstats
->filled
|= BIT(NL80211_TID_STATS_TX_MSDU
);
2036 tidstats
->tx_msdu
= sta
->tx_stats
.msdu
[tid
];
2039 if (!(tidstats
->filled
& BIT(NL80211_TID_STATS_TX_MSDU_RETRIES
)) &&
2040 ieee80211_hw_check(&local
->hw
, REPORTS_TX_ACK_STATUS
)) {
2041 tidstats
->filled
|= BIT(NL80211_TID_STATS_TX_MSDU_RETRIES
);
2042 tidstats
->tx_msdu_retries
= sta
->status_stats
.msdu_retries
[tid
];
2045 if (!(tidstats
->filled
& BIT(NL80211_TID_STATS_TX_MSDU_FAILED
)) &&
2046 ieee80211_hw_check(&local
->hw
, REPORTS_TX_ACK_STATUS
)) {
2047 tidstats
->filled
|= BIT(NL80211_TID_STATS_TX_MSDU_FAILED
);
2048 tidstats
->tx_msdu_failed
= sta
->status_stats
.msdu_failed
[tid
];
2052 static inline u64
sta_get_stats_bytes(struct ieee80211_sta_rx_stats
*rxstats
)
2058 start
= u64_stats_fetch_begin(&rxstats
->syncp
);
2059 value
= rxstats
->bytes
;
2060 } while (u64_stats_fetch_retry(&rxstats
->syncp
, start
));
2065 void sta_set_sinfo(struct sta_info
*sta
, struct station_info
*sinfo
)
2067 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
2068 struct ieee80211_local
*local
= sdata
->local
;
2069 struct rate_control_ref
*ref
= NULL
;
2072 struct ieee80211_sta_rx_stats
*last_rxstats
;
2074 last_rxstats
= sta_get_last_rx_stats(sta
);
2076 if (test_sta_flag(sta
, WLAN_STA_RATE_CONTROL
))
2077 ref
= local
->rate_ctrl
;
2079 sinfo
->generation
= sdata
->local
->sta_generation
;
2081 /* do before driver, so beacon filtering drivers have a
2082 * chance to e.g. just add the number of filtered beacons
2083 * (or just modify the value entirely, of course)
2085 if (sdata
->vif
.type
== NL80211_IFTYPE_STATION
)
2086 sinfo
->rx_beacon
= sdata
->u
.mgd
.count_beacon_signal
;
2088 drv_sta_statistics(local
, sdata
, &sta
->sta
, sinfo
);
2090 sinfo
->filled
|= BIT(NL80211_STA_INFO_INACTIVE_TIME
) |
2091 BIT(NL80211_STA_INFO_STA_FLAGS
) |
2092 BIT(NL80211_STA_INFO_BSS_PARAM
) |
2093 BIT(NL80211_STA_INFO_CONNECTED_TIME
) |
2094 BIT(NL80211_STA_INFO_RX_DROP_MISC
);
2096 if (sdata
->vif
.type
== NL80211_IFTYPE_STATION
) {
2097 sinfo
->beacon_loss_count
= sdata
->u
.mgd
.beacon_loss_count
;
2098 sinfo
->filled
|= BIT(NL80211_STA_INFO_BEACON_LOSS
);
2101 sinfo
->connected_time
= ktime_get_seconds() - sta
->last_connected
;
2102 sinfo
->inactive_time
=
2103 jiffies_to_msecs(jiffies
- ieee80211_sta_last_active(sta
));
2105 if (!(sinfo
->filled
& (BIT(NL80211_STA_INFO_TX_BYTES64
) |
2106 BIT(NL80211_STA_INFO_TX_BYTES
)))) {
2107 sinfo
->tx_bytes
= 0;
2108 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++)
2109 sinfo
->tx_bytes
+= sta
->tx_stats
.bytes
[ac
];
2110 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_BYTES64
);
2113 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_TX_PACKETS
))) {
2114 sinfo
->tx_packets
= 0;
2115 for (ac
= 0; ac
< IEEE80211_NUM_ACS
; ac
++)
2116 sinfo
->tx_packets
+= sta
->tx_stats
.packets
[ac
];
2117 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_PACKETS
);
2120 if (!(sinfo
->filled
& (BIT(NL80211_STA_INFO_RX_BYTES64
) |
2121 BIT(NL80211_STA_INFO_RX_BYTES
)))) {
2122 sinfo
->rx_bytes
+= sta_get_stats_bytes(&sta
->rx_stats
);
2124 if (sta
->pcpu_rx_stats
) {
2125 for_each_possible_cpu(cpu
) {
2126 struct ieee80211_sta_rx_stats
*cpurxs
;
2128 cpurxs
= per_cpu_ptr(sta
->pcpu_rx_stats
, cpu
);
2129 sinfo
->rx_bytes
+= sta_get_stats_bytes(cpurxs
);
2133 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_BYTES64
);
2136 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_RX_PACKETS
))) {
2137 sinfo
->rx_packets
= sta
->rx_stats
.packets
;
2138 if (sta
->pcpu_rx_stats
) {
2139 for_each_possible_cpu(cpu
) {
2140 struct ieee80211_sta_rx_stats
*cpurxs
;
2142 cpurxs
= per_cpu_ptr(sta
->pcpu_rx_stats
, cpu
);
2143 sinfo
->rx_packets
+= cpurxs
->packets
;
2146 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_PACKETS
);
2149 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_TX_RETRIES
))) {
2150 sinfo
->tx_retries
= sta
->status_stats
.retry_count
;
2151 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_RETRIES
);
2154 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_TX_FAILED
))) {
2155 sinfo
->tx_failed
= sta
->status_stats
.retry_failed
;
2156 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_FAILED
);
2159 sinfo
->rx_dropped_misc
= sta
->rx_stats
.dropped
;
2160 if (sta
->pcpu_rx_stats
) {
2161 for_each_possible_cpu(cpu
) {
2162 struct ieee80211_sta_rx_stats
*cpurxs
;
2164 cpurxs
= per_cpu_ptr(sta
->pcpu_rx_stats
, cpu
);
2165 sinfo
->rx_packets
+= cpurxs
->dropped
;
2169 if (sdata
->vif
.type
== NL80211_IFTYPE_STATION
&&
2170 !(sdata
->vif
.driver_flags
& IEEE80211_VIF_BEACON_FILTER
)) {
2171 sinfo
->filled
|= BIT(NL80211_STA_INFO_BEACON_RX
) |
2172 BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG
);
2173 sinfo
->rx_beacon_signal_avg
= ieee80211_ave_rssi(&sdata
->vif
);
2176 if (ieee80211_hw_check(&sta
->local
->hw
, SIGNAL_DBM
) ||
2177 ieee80211_hw_check(&sta
->local
->hw
, SIGNAL_UNSPEC
)) {
2178 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_SIGNAL
))) {
2179 sinfo
->signal
= (s8
)last_rxstats
->last_signal
;
2180 sinfo
->filled
|= BIT(NL80211_STA_INFO_SIGNAL
);
2183 if (!sta
->pcpu_rx_stats
&&
2184 !(sinfo
->filled
& BIT(NL80211_STA_INFO_SIGNAL_AVG
))) {
2186 -ewma_signal_read(&sta
->rx_stats_avg
.signal
);
2187 sinfo
->filled
|= BIT(NL80211_STA_INFO_SIGNAL_AVG
);
2191 /* for the average - if pcpu_rx_stats isn't set - rxstats must point to
2192 * the sta->rx_stats struct, so the check here is fine with and without
2195 if (last_rxstats
->chains
&&
2196 !(sinfo
->filled
& (BIT(NL80211_STA_INFO_CHAIN_SIGNAL
) |
2197 BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG
)))) {
2198 sinfo
->filled
|= BIT(NL80211_STA_INFO_CHAIN_SIGNAL
);
2199 if (!sta
->pcpu_rx_stats
)
2200 sinfo
->filled
|= BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG
);
2202 sinfo
->chains
= last_rxstats
->chains
;
2204 for (i
= 0; i
< ARRAY_SIZE(sinfo
->chain_signal
); i
++) {
2205 sinfo
->chain_signal
[i
] =
2206 last_rxstats
->chain_signal_last
[i
];
2207 sinfo
->chain_signal_avg
[i
] =
2208 -ewma_signal_read(&sta
->rx_stats_avg
.chain_signal
[i
]);
2212 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_TX_BITRATE
))) {
2213 sta_set_rate_info_tx(sta
, &sta
->tx_stats
.last_rate
,
2215 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_BITRATE
);
2218 if (!(sinfo
->filled
& BIT(NL80211_STA_INFO_RX_BITRATE
))) {
2219 sta_set_rate_info_rx(sta
, &sinfo
->rxrate
);
2220 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_BITRATE
);
2223 sinfo
->filled
|= BIT(NL80211_STA_INFO_TID_STATS
);
2224 for (i
= 0; i
< IEEE80211_NUM_TIDS
+ 1; i
++) {
2225 struct cfg80211_tid_stats
*tidstats
= &sinfo
->pertid
[i
];
2227 sta_set_tidstats(sta
, tidstats
, i
);
2230 if (ieee80211_vif_is_mesh(&sdata
->vif
)) {
2231 #ifdef CONFIG_MAC80211_MESH
2232 sinfo
->filled
|= BIT(NL80211_STA_INFO_LLID
) |
2233 BIT(NL80211_STA_INFO_PLID
) |
2234 BIT(NL80211_STA_INFO_PLINK_STATE
) |
2235 BIT(NL80211_STA_INFO_LOCAL_PM
) |
2236 BIT(NL80211_STA_INFO_PEER_PM
) |
2237 BIT(NL80211_STA_INFO_NONPEER_PM
);
2239 sinfo
->llid
= sta
->mesh
->llid
;
2240 sinfo
->plid
= sta
->mesh
->plid
;
2241 sinfo
->plink_state
= sta
->mesh
->plink_state
;
2242 if (test_sta_flag(sta
, WLAN_STA_TOFFSET_KNOWN
)) {
2243 sinfo
->filled
|= BIT(NL80211_STA_INFO_T_OFFSET
);
2244 sinfo
->t_offset
= sta
->mesh
->t_offset
;
2246 sinfo
->local_pm
= sta
->mesh
->local_pm
;
2247 sinfo
->peer_pm
= sta
->mesh
->peer_pm
;
2248 sinfo
->nonpeer_pm
= sta
->mesh
->nonpeer_pm
;
2252 sinfo
->bss_param
.flags
= 0;
2253 if (sdata
->vif
.bss_conf
.use_cts_prot
)
2254 sinfo
->bss_param
.flags
|= BSS_PARAM_FLAGS_CTS_PROT
;
2255 if (sdata
->vif
.bss_conf
.use_short_preamble
)
2256 sinfo
->bss_param
.flags
|= BSS_PARAM_FLAGS_SHORT_PREAMBLE
;
2257 if (sdata
->vif
.bss_conf
.use_short_slot
)
2258 sinfo
->bss_param
.flags
|= BSS_PARAM_FLAGS_SHORT_SLOT_TIME
;
2259 sinfo
->bss_param
.dtim_period
= sdata
->vif
.bss_conf
.dtim_period
;
2260 sinfo
->bss_param
.beacon_interval
= sdata
->vif
.bss_conf
.beacon_int
;
2262 sinfo
->sta_flags
.set
= 0;
2263 sinfo
->sta_flags
.mask
= BIT(NL80211_STA_FLAG_AUTHORIZED
) |
2264 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
) |
2265 BIT(NL80211_STA_FLAG_WME
) |
2266 BIT(NL80211_STA_FLAG_MFP
) |
2267 BIT(NL80211_STA_FLAG_AUTHENTICATED
) |
2268 BIT(NL80211_STA_FLAG_ASSOCIATED
) |
2269 BIT(NL80211_STA_FLAG_TDLS_PEER
);
2270 if (test_sta_flag(sta
, WLAN_STA_AUTHORIZED
))
2271 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_AUTHORIZED
);
2272 if (test_sta_flag(sta
, WLAN_STA_SHORT_PREAMBLE
))
2273 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
);
2275 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_WME
);
2276 if (test_sta_flag(sta
, WLAN_STA_MFP
))
2277 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_MFP
);
2278 if (test_sta_flag(sta
, WLAN_STA_AUTH
))
2279 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_AUTHENTICATED
);
2280 if (test_sta_flag(sta
, WLAN_STA_ASSOC
))
2281 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_ASSOCIATED
);
2282 if (test_sta_flag(sta
, WLAN_STA_TDLS_PEER
))
2283 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_TDLS_PEER
);
2285 thr
= sta_get_expected_throughput(sta
);
2288 sinfo
->filled
|= BIT(NL80211_STA_INFO_EXPECTED_THROUGHPUT
);
2289 sinfo
->expected_throughput
= thr
;
2293 u32
sta_get_expected_throughput(struct sta_info
*sta
)
2295 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
2296 struct ieee80211_local
*local
= sdata
->local
;
2297 struct rate_control_ref
*ref
= NULL
;
2300 if (test_sta_flag(sta
, WLAN_STA_RATE_CONTROL
))
2301 ref
= local
->rate_ctrl
;
2303 /* check if the driver has a SW RC implementation */
2304 if (ref
&& ref
->ops
->get_expected_throughput
)
2305 thr
= ref
->ops
->get_expected_throughput(sta
->rate_ctrl_priv
);
2307 thr
= drv_get_expected_throughput(local
, sta
);
2312 unsigned long ieee80211_sta_last_active(struct sta_info
*sta
)
2314 struct ieee80211_sta_rx_stats
*stats
= sta_get_last_rx_stats(sta
);
2316 if (time_after(stats
->last_rx
, sta
->status_stats
.last_ack
))
2317 return stats
->last_rx
;
2318 return sta
->status_stats
.last_ack
;