4 * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
5 * Copyright 2002-2005, Instant802 Networks, Inc.
6 * Copyright 2005-2006, Devicescape Software, Inc.
7 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
8 * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
9 * Copyright 2007-2010, Intel Corporation
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/ieee80211.h>
17 #include <linux/slab.h>
18 #include <linux/export.h>
19 #include <net/mac80211.h>
20 #include "ieee80211_i.h"
21 #include "driver-ops.h"
25 * DOC: TX A-MPDU aggregation
27 * Aggregation on the TX side requires setting the hardware flag
28 * %IEEE80211_HW_AMPDU_AGGREGATION. The driver will then be handed
29 * packets with a flag indicating A-MPDU aggregation. The driver
30 * or device is responsible for actually aggregating the frames,
31 * as well as deciding how many and which to aggregate.
33 * When TX aggregation is started by some subsystem (usually the rate
34 * control algorithm would be appropriate) by calling the
35 * ieee80211_start_tx_ba_session() function, the driver will be
36 * notified via its @ampdu_action function, with the
37 * %IEEE80211_AMPDU_TX_START action.
39 * In response to that, the driver is later required to call the
40 * ieee80211_start_tx_ba_cb_irqsafe() function, which will really
41 * start the aggregation session after the peer has also responded.
42 * If the peer responds negatively, the session will be stopped
43 * again right away. Note that it is possible for the aggregation
44 * session to be stopped before the driver has indicated that it
45 * is done setting it up, in which case it must not indicate the
48 * Also note that, since we also need to wait for a response from
49 * the peer, the driver is notified of the completion of the
50 * handshake by the %IEEE80211_AMPDU_TX_OPERATIONAL action to the
51 * @ampdu_action callback.
53 * Similarly, when the aggregation session is stopped by the peer
54 * or something calling ieee80211_stop_tx_ba_session(), the driver's
55 * @ampdu_action function will be called with the action
56 * %IEEE80211_AMPDU_TX_STOP. In this case, the call must not fail,
57 * and the driver must later call ieee80211_stop_tx_ba_cb_irqsafe().
58 * Note that the sta can get destroyed before the BA tear down is
62 static void ieee80211_send_addba_request(struct ieee80211_sub_if_data
*sdata
,
63 const u8
*da
, u16 tid
,
64 u8 dialog_token
, u16 start_seq_num
,
65 u16 agg_size
, u16 timeout
)
67 struct ieee80211_local
*local
= sdata
->local
;
69 struct ieee80211_mgmt
*mgmt
;
72 skb
= dev_alloc_skb(sizeof(*mgmt
) + local
->hw
.extra_tx_headroom
);
77 skb_reserve(skb
, local
->hw
.extra_tx_headroom
);
78 mgmt
= (struct ieee80211_mgmt
*) skb_put(skb
, 24);
80 memcpy(mgmt
->da
, da
, ETH_ALEN
);
81 memcpy(mgmt
->sa
, sdata
->vif
.addr
, ETH_ALEN
);
82 if (sdata
->vif
.type
== NL80211_IFTYPE_AP
||
83 sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
||
84 sdata
->vif
.type
== NL80211_IFTYPE_MESH_POINT
)
85 memcpy(mgmt
->bssid
, sdata
->vif
.addr
, ETH_ALEN
);
86 else if (sdata
->vif
.type
== NL80211_IFTYPE_STATION
)
87 memcpy(mgmt
->bssid
, sdata
->u
.mgd
.bssid
, ETH_ALEN
);
88 else if (sdata
->vif
.type
== NL80211_IFTYPE_ADHOC
)
89 memcpy(mgmt
->bssid
, sdata
->u
.ibss
.bssid
, ETH_ALEN
);
91 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
92 IEEE80211_STYPE_ACTION
);
94 skb_put(skb
, 1 + sizeof(mgmt
->u
.action
.u
.addba_req
));
96 mgmt
->u
.action
.category
= WLAN_CATEGORY_BACK
;
97 mgmt
->u
.action
.u
.addba_req
.action_code
= WLAN_ACTION_ADDBA_REQ
;
99 mgmt
->u
.action
.u
.addba_req
.dialog_token
= dialog_token
;
100 capab
= (u16
)(1 << 1); /* bit 1 aggregation policy */
101 capab
|= (u16
)(tid
<< 2); /* bit 5:2 TID number */
102 capab
|= (u16
)(agg_size
<< 6); /* bit 15:6 max size of aggergation */
104 mgmt
->u
.action
.u
.addba_req
.capab
= cpu_to_le16(capab
);
106 mgmt
->u
.action
.u
.addba_req
.timeout
= cpu_to_le16(timeout
);
107 mgmt
->u
.action
.u
.addba_req
.start_seq_num
=
108 cpu_to_le16(start_seq_num
<< 4);
110 ieee80211_tx_skb_tid(sdata
, skb
, tid
);
113 void ieee80211_send_bar(struct ieee80211_vif
*vif
, u8
*ra
, u16 tid
, u16 ssn
)
115 struct ieee80211_sub_if_data
*sdata
= vif_to_sdata(vif
);
116 struct ieee80211_local
*local
= sdata
->local
;
118 struct ieee80211_bar
*bar
;
121 skb
= dev_alloc_skb(sizeof(*bar
) + local
->hw
.extra_tx_headroom
);
125 skb_reserve(skb
, local
->hw
.extra_tx_headroom
);
126 bar
= (struct ieee80211_bar
*)skb_put(skb
, sizeof(*bar
));
127 memset(bar
, 0, sizeof(*bar
));
128 bar
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_CTL
|
129 IEEE80211_STYPE_BACK_REQ
);
130 memcpy(bar
->ra
, ra
, ETH_ALEN
);
131 memcpy(bar
->ta
, sdata
->vif
.addr
, ETH_ALEN
);
132 bar_control
|= (u16
)IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL
;
133 bar_control
|= (u16
)IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA
;
134 bar_control
|= (u16
)(tid
<< IEEE80211_BAR_CTRL_TID_INFO_SHIFT
);
135 bar
->control
= cpu_to_le16(bar_control
);
136 bar
->start_seq_num
= cpu_to_le16(ssn
);
138 IEEE80211_SKB_CB(skb
)->flags
|= IEEE80211_TX_INTFL_DONT_ENCRYPT
|
139 IEEE80211_TX_CTL_REQ_TX_STATUS
;
140 ieee80211_tx_skb_tid(sdata
, skb
, tid
);
142 EXPORT_SYMBOL(ieee80211_send_bar
);
144 void ieee80211_assign_tid_tx(struct sta_info
*sta
, int tid
,
145 struct tid_ampdu_tx
*tid_tx
)
147 lockdep_assert_held(&sta
->ampdu_mlme
.mtx
);
148 lockdep_assert_held(&sta
->lock
);
149 rcu_assign_pointer(sta
->ampdu_mlme
.tid_tx
[tid
], tid_tx
);
152 static inline int ieee80211_ac_from_tid(int tid
)
154 return ieee802_1d_to_ac
[tid
& 7];
158 * When multiple aggregation sessions on multiple stations
159 * are being created/destroyed simultaneously, we need to
160 * refcount the global queue stop caused by that in order
161 * to not get into a situation where one of the aggregation
162 * setup or teardown re-enables queues before the other is
163 * ready to handle that.
165 * These two functions take care of this issue by keeping
166 * a global "agg_queue_stop" refcount.
168 static void __acquires(agg_queue
)
169 ieee80211_stop_queue_agg(struct ieee80211_sub_if_data
*sdata
, int tid
)
171 int queue
= sdata
->vif
.hw_queue
[ieee80211_ac_from_tid(tid
)];
173 if (atomic_inc_return(&sdata
->local
->agg_queue_stop
[queue
]) == 1)
174 ieee80211_stop_queue_by_reason(
175 &sdata
->local
->hw
, queue
,
176 IEEE80211_QUEUE_STOP_REASON_AGGREGATION
);
177 __acquire(agg_queue
);
180 static void __releases(agg_queue
)
181 ieee80211_wake_queue_agg(struct ieee80211_sub_if_data
*sdata
, int tid
)
183 int queue
= sdata
->vif
.hw_queue
[ieee80211_ac_from_tid(tid
)];
185 if (atomic_dec_return(&sdata
->local
->agg_queue_stop
[queue
]) == 0)
186 ieee80211_wake_queue_by_reason(
187 &sdata
->local
->hw
, queue
,
188 IEEE80211_QUEUE_STOP_REASON_AGGREGATION
);
189 __release(agg_queue
);
193 * splice packets from the STA's pending to the local pending,
194 * requires a call to ieee80211_agg_splice_finish later
196 static void __acquires(agg_queue
)
197 ieee80211_agg_splice_packets(struct ieee80211_sub_if_data
*sdata
,
198 struct tid_ampdu_tx
*tid_tx
, u16 tid
)
200 struct ieee80211_local
*local
= sdata
->local
;
201 int queue
= sdata
->vif
.hw_queue
[ieee80211_ac_from_tid(tid
)];
204 ieee80211_stop_queue_agg(sdata
, tid
);
207 "TID %d gone but expected when splicing aggregates from the pending queue\n",
211 if (!skb_queue_empty(&tid_tx
->pending
)) {
212 spin_lock_irqsave(&local
->queue_stop_reason_lock
, flags
);
213 /* copy over remaining packets */
214 skb_queue_splice_tail_init(&tid_tx
->pending
,
215 &local
->pending
[queue
]);
216 spin_unlock_irqrestore(&local
->queue_stop_reason_lock
, flags
);
220 static void __releases(agg_queue
)
221 ieee80211_agg_splice_finish(struct ieee80211_sub_if_data
*sdata
, u16 tid
)
223 ieee80211_wake_queue_agg(sdata
, tid
);
226 static void ieee80211_remove_tid_tx(struct sta_info
*sta
, int tid
)
228 struct tid_ampdu_tx
*tid_tx
;
230 lockdep_assert_held(&sta
->ampdu_mlme
.mtx
);
231 lockdep_assert_held(&sta
->lock
);
233 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
236 * When we get here, the TX path will not be lockless any more wrt.
237 * aggregation, since the OPERATIONAL bit has long been cleared.
238 * Thus it will block on getting the lock, if it occurs. So if we
239 * stop the queue now, we will not get any more packets, and any
240 * that might be being processed will wait for us here, thereby
241 * guaranteeing that no packets go to the tid_tx pending queue any
245 ieee80211_agg_splice_packets(sta
->sdata
, tid_tx
, tid
);
247 /* future packets must not find the tid_tx struct any more */
248 ieee80211_assign_tid_tx(sta
, tid
, NULL
);
250 ieee80211_agg_splice_finish(sta
->sdata
, tid
);
252 kfree_rcu(tid_tx
, rcu_head
);
255 int ___ieee80211_stop_tx_ba_session(struct sta_info
*sta
, u16 tid
,
256 enum ieee80211_agg_stop_reason reason
)
258 struct ieee80211_local
*local
= sta
->local
;
259 struct tid_ampdu_tx
*tid_tx
;
260 enum ieee80211_ampdu_mlme_action action
;
263 lockdep_assert_held(&sta
->ampdu_mlme
.mtx
);
266 case AGG_STOP_DECLINED
:
267 case AGG_STOP_LOCAL_REQUEST
:
268 case AGG_STOP_PEER_REQUEST
:
269 action
= IEEE80211_AMPDU_TX_STOP_CONT
;
271 case AGG_STOP_DESTROY_STA
:
272 action
= IEEE80211_AMPDU_TX_STOP_FLUSH
;
279 spin_lock_bh(&sta
->lock
);
281 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
283 spin_unlock_bh(&sta
->lock
);
288 * if we're already stopping ignore any new requests to stop
289 * unless we're destroying it in which case notify the driver
291 if (test_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
)) {
292 spin_unlock_bh(&sta
->lock
);
293 if (reason
!= AGG_STOP_DESTROY_STA
)
295 ret
= drv_ampdu_action(local
, sta
->sdata
,
296 IEEE80211_AMPDU_TX_STOP_FLUSH_CONT
,
297 &sta
->sta
, tid
, NULL
, 0);
302 if (test_bit(HT_AGG_STATE_WANT_START
, &tid_tx
->state
)) {
303 /* not even started yet! */
304 ieee80211_assign_tid_tx(sta
, tid
, NULL
);
305 spin_unlock_bh(&sta
->lock
);
306 kfree_rcu(tid_tx
, rcu_head
);
310 set_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
);
312 spin_unlock_bh(&sta
->lock
);
314 ht_dbg(sta
->sdata
, "Tx BA session stop requested for %pM tid %u\n",
317 del_timer_sync(&tid_tx
->addba_resp_timer
);
318 del_timer_sync(&tid_tx
->session_timer
);
321 * After this packets are no longer handed right through
322 * to the driver but are put onto tid_tx->pending instead,
323 * with locking to ensure proper access.
325 clear_bit(HT_AGG_STATE_OPERATIONAL
, &tid_tx
->state
);
328 * There might be a few packets being processed right now (on
329 * another CPU) that have already gotten past the aggregation
330 * check when it was still OPERATIONAL and consequently have
331 * IEEE80211_TX_CTL_AMPDU set. In that case, this code might
332 * call into the driver at the same time or even before the
333 * TX paths calls into it, which could confuse the driver.
335 * Wait for all currently running TX paths to finish before
336 * telling the driver. New packets will not go through since
337 * the aggregation session is no longer OPERATIONAL.
341 tid_tx
->stop_initiator
= reason
== AGG_STOP_PEER_REQUEST
?
342 WLAN_BACK_RECIPIENT
:
344 tid_tx
->tx_stop
= reason
== AGG_STOP_LOCAL_REQUEST
;
346 ret
= drv_ampdu_action(local
, sta
->sdata
, action
,
347 &sta
->sta
, tid
, NULL
, 0);
349 /* HW shall not deny going back to legacy */
352 * We may have pending packets get stuck in this case...
353 * Not bothering with a workaround for now.
357 if (reason
== AGG_STOP_DESTROY_STA
) {
359 spin_lock_bh(&sta
->lock
);
360 ieee80211_remove_tid_tx(sta
, tid
);
361 spin_unlock_bh(&sta
->lock
);
368 * After sending add Block Ack request we activated a timer until
369 * add Block Ack response will arrive from the recipient.
370 * If this timer expires sta_addba_resp_timer_expired will be executed.
372 static void sta_addba_resp_timer_expired(unsigned long data
)
374 /* not an elegant detour, but there is no choice as the timer passes
375 * only one argument, and both sta_info and TID are needed, so init
376 * flow in sta_info_create gives the TID as data, while the timer_to_id
377 * array gives the sta through container_of */
378 u16 tid
= *(u8
*)data
;
379 struct sta_info
*sta
= container_of((void *)data
,
380 struct sta_info
, timer_to_tid
[tid
]);
381 struct tid_ampdu_tx
*tid_tx
;
383 /* check if the TID waits for addBA response */
385 tid_tx
= rcu_dereference(sta
->ampdu_mlme
.tid_tx
[tid
]);
387 test_bit(HT_AGG_STATE_RESPONSE_RECEIVED
, &tid_tx
->state
)) {
390 "timer expired on tid %d but we are not (or no longer) expecting addBA response there\n",
395 ht_dbg(sta
->sdata
, "addBA response timer expired on tid %d\n", tid
);
397 ieee80211_stop_tx_ba_session(&sta
->sta
, tid
);
401 void ieee80211_tx_ba_session_handle_start(struct sta_info
*sta
, int tid
)
403 struct tid_ampdu_tx
*tid_tx
;
404 struct ieee80211_local
*local
= sta
->local
;
405 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
409 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
412 * Start queuing up packets for this aggregation session.
413 * We're going to release them once the driver is OK with
416 clear_bit(HT_AGG_STATE_WANT_START
, &tid_tx
->state
);
419 * Make sure no packets are being processed. This ensures that
420 * we have a valid starting sequence number and that in-flight
421 * packets have been flushed out and no packets for this TID
422 * will go into the driver during the ampdu_action call.
426 start_seq_num
= sta
->tid_seq
[tid
] >> 4;
428 ret
= drv_ampdu_action(local
, sdata
, IEEE80211_AMPDU_TX_START
,
429 &sta
->sta
, tid
, &start_seq_num
, 0);
432 "BA request denied - HW unavailable for tid %d\n", tid
);
433 spin_lock_bh(&sta
->lock
);
434 ieee80211_agg_splice_packets(sdata
, tid_tx
, tid
);
435 ieee80211_assign_tid_tx(sta
, tid
, NULL
);
436 ieee80211_agg_splice_finish(sdata
, tid
);
437 spin_unlock_bh(&sta
->lock
);
439 kfree_rcu(tid_tx
, rcu_head
);
443 /* activate the timer for the recipient's addBA response */
444 mod_timer(&tid_tx
->addba_resp_timer
, jiffies
+ ADDBA_RESP_INTERVAL
);
445 ht_dbg(sdata
, "activated addBA response timer on tid %d\n", tid
);
447 spin_lock_bh(&sta
->lock
);
448 sta
->ampdu_mlme
.last_addba_req_time
[tid
] = jiffies
;
449 sta
->ampdu_mlme
.addba_req_num
[tid
]++;
450 spin_unlock_bh(&sta
->lock
);
452 /* send AddBA request */
453 ieee80211_send_addba_request(sdata
, sta
->sta
.addr
, tid
,
454 tid_tx
->dialog_token
, start_seq_num
,
455 local
->hw
.max_tx_aggregation_subframes
,
460 * After accepting the AddBA Response we activated a timer,
461 * resetting it after each frame that we send.
463 static void sta_tx_agg_session_timer_expired(unsigned long data
)
465 /* not an elegant detour, but there is no choice as the timer passes
466 * only one argument, and various sta_info are needed here, so init
467 * flow in sta_info_create gives the TID as data, while the timer_to_id
468 * array gives the sta through container_of */
469 u8
*ptid
= (u8
*)data
;
470 u8
*timer_to_id
= ptid
- *ptid
;
471 struct sta_info
*sta
= container_of(timer_to_id
, struct sta_info
,
473 struct tid_ampdu_tx
*tid_tx
;
474 unsigned long timeout
;
477 tid_tx
= rcu_dereference(sta
->ampdu_mlme
.tid_tx
[*ptid
]);
478 if (!tid_tx
|| test_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
)) {
483 timeout
= tid_tx
->last_tx
+ TU_TO_JIFFIES(tid_tx
->timeout
);
484 if (time_is_after_jiffies(timeout
)) {
485 mod_timer(&tid_tx
->session_timer
, timeout
);
492 ht_dbg(sta
->sdata
, "tx session timer expired on tid %d\n", (u16
)*ptid
);
494 ieee80211_stop_tx_ba_session(&sta
->sta
, *ptid
);
497 int ieee80211_start_tx_ba_session(struct ieee80211_sta
*pubsta
, u16 tid
,
500 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
501 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
502 struct ieee80211_local
*local
= sdata
->local
;
503 struct tid_ampdu_tx
*tid_tx
;
506 trace_api_start_tx_ba_session(pubsta
, tid
);
508 if (WARN_ON_ONCE(!local
->ops
->ampdu_action
))
511 if ((tid
>= IEEE80211_NUM_TIDS
) ||
512 !(local
->hw
.flags
& IEEE80211_HW_AMPDU_AGGREGATION
) ||
513 (local
->hw
.flags
& IEEE80211_HW_TX_AMPDU_SETUP_IN_HW
))
516 ht_dbg(sdata
, "Open BA session requested for %pM tid %u\n",
519 if (sdata
->vif
.type
!= NL80211_IFTYPE_STATION
&&
520 sdata
->vif
.type
!= NL80211_IFTYPE_MESH_POINT
&&
521 sdata
->vif
.type
!= NL80211_IFTYPE_AP_VLAN
&&
522 sdata
->vif
.type
!= NL80211_IFTYPE_AP
&&
523 sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
526 if (test_sta_flag(sta
, WLAN_STA_BLOCK_BA
)) {
528 "BA sessions blocked - Denying BA session request\n");
533 * 802.11n-2009 11.5.1.1: If the initiating STA is an HT STA, is a
534 * member of an IBSS, and has no other existing Block Ack agreement
535 * with the recipient STA, then the initiating STA shall transmit a
536 * Probe Request frame to the recipient STA and shall not transmit an
537 * ADDBA Request frame unless it receives a Probe Response frame
538 * from the recipient within dot11ADDBAFailureTimeout.
540 * The probe request mechanism for ADDBA is currently not implemented,
541 * but we only build up Block Ack session with HT STAs. This information
542 * is set when we receive a bss info from a probe response or a beacon.
544 if (sta
->sdata
->vif
.type
== NL80211_IFTYPE_ADHOC
&&
545 !sta
->sta
.ht_cap
.ht_supported
) {
547 "BA request denied - IBSS STA %pM does not advertise HT support\n",
552 spin_lock_bh(&sta
->lock
);
554 /* we have tried too many times, receiver does not want A-MPDU */
555 if (sta
->ampdu_mlme
.addba_req_num
[tid
] > HT_AGG_MAX_RETRIES
) {
561 * if we have tried more than HT_AGG_BURST_RETRIES times we
562 * will spread our requests in time to avoid stalling connection
565 if (sta
->ampdu_mlme
.addba_req_num
[tid
] > HT_AGG_BURST_RETRIES
&&
566 time_before(jiffies
, sta
->ampdu_mlme
.last_addba_req_time
[tid
] +
567 HT_AGG_RETRIES_PERIOD
)) {
569 "BA request denied - waiting a grace period after %d failed requests on tid %u\n",
570 sta
->ampdu_mlme
.addba_req_num
[tid
], tid
);
575 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
576 /* check if the TID is not in aggregation flow already */
577 if (tid_tx
|| sta
->ampdu_mlme
.tid_start_tx
[tid
]) {
579 "BA request denied - session is not idle on tid %u\n",
585 /* prepare A-MPDU MLME for Tx aggregation */
586 tid_tx
= kzalloc(sizeof(struct tid_ampdu_tx
), GFP_ATOMIC
);
592 skb_queue_head_init(&tid_tx
->pending
);
593 __set_bit(HT_AGG_STATE_WANT_START
, &tid_tx
->state
);
595 tid_tx
->timeout
= timeout
;
598 tid_tx
->addba_resp_timer
.function
= sta_addba_resp_timer_expired
;
599 tid_tx
->addba_resp_timer
.data
= (unsigned long)&sta
->timer_to_tid
[tid
];
600 init_timer(&tid_tx
->addba_resp_timer
);
603 tid_tx
->session_timer
.function
= sta_tx_agg_session_timer_expired
;
604 tid_tx
->session_timer
.data
= (unsigned long)&sta
->timer_to_tid
[tid
];
605 init_timer_deferrable(&tid_tx
->session_timer
);
607 /* assign a dialog token */
608 sta
->ampdu_mlme
.dialog_token_allocator
++;
609 tid_tx
->dialog_token
= sta
->ampdu_mlme
.dialog_token_allocator
;
612 * Finally, assign it to the start array; the work item will
613 * collect it and move it to the normal array.
615 sta
->ampdu_mlme
.tid_start_tx
[tid
] = tid_tx
;
617 ieee80211_queue_work(&local
->hw
, &sta
->ampdu_mlme
.work
);
619 /* this flow continues off the work */
621 spin_unlock_bh(&sta
->lock
);
624 EXPORT_SYMBOL(ieee80211_start_tx_ba_session
);
626 static void ieee80211_agg_tx_operational(struct ieee80211_local
*local
,
627 struct sta_info
*sta
, u16 tid
)
629 struct tid_ampdu_tx
*tid_tx
;
631 lockdep_assert_held(&sta
->ampdu_mlme
.mtx
);
633 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
635 ht_dbg(sta
->sdata
, "Aggregation is on for tid %d\n", tid
);
637 drv_ampdu_action(local
, sta
->sdata
,
638 IEEE80211_AMPDU_TX_OPERATIONAL
,
639 &sta
->sta
, tid
, NULL
, tid_tx
->buf_size
);
642 * synchronize with TX path, while splicing the TX path
643 * should block so it won't put more packets onto pending.
645 spin_lock_bh(&sta
->lock
);
647 ieee80211_agg_splice_packets(sta
->sdata
, tid_tx
, tid
);
649 * Now mark as operational. This will be visible
650 * in the TX path, and lets it go lock-free in
653 set_bit(HT_AGG_STATE_OPERATIONAL
, &tid_tx
->state
);
654 ieee80211_agg_splice_finish(sta
->sdata
, tid
);
656 spin_unlock_bh(&sta
->lock
);
659 void ieee80211_start_tx_ba_cb(struct ieee80211_vif
*vif
, u8
*ra
, u16 tid
)
661 struct ieee80211_sub_if_data
*sdata
= vif_to_sdata(vif
);
662 struct ieee80211_local
*local
= sdata
->local
;
663 struct sta_info
*sta
;
664 struct tid_ampdu_tx
*tid_tx
;
666 trace_api_start_tx_ba_cb(sdata
, ra
, tid
);
668 if (tid
>= IEEE80211_NUM_TIDS
) {
669 ht_dbg(sdata
, "Bad TID value: tid = %d (>= %d)\n",
670 tid
, IEEE80211_NUM_TIDS
);
674 mutex_lock(&local
->sta_mtx
);
675 sta
= sta_info_get_bss(sdata
, ra
);
677 mutex_unlock(&local
->sta_mtx
);
678 ht_dbg(sdata
, "Could not find station: %pM\n", ra
);
682 mutex_lock(&sta
->ampdu_mlme
.mtx
);
683 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
685 if (WARN_ON(!tid_tx
)) {
686 ht_dbg(sdata
, "addBA was not requested!\n");
690 if (WARN_ON(test_and_set_bit(HT_AGG_STATE_DRV_READY
, &tid_tx
->state
)))
693 if (test_bit(HT_AGG_STATE_RESPONSE_RECEIVED
, &tid_tx
->state
))
694 ieee80211_agg_tx_operational(local
, sta
, tid
);
697 mutex_unlock(&sta
->ampdu_mlme
.mtx
);
698 mutex_unlock(&local
->sta_mtx
);
701 void ieee80211_start_tx_ba_cb_irqsafe(struct ieee80211_vif
*vif
,
702 const u8
*ra
, u16 tid
)
704 struct ieee80211_sub_if_data
*sdata
= vif_to_sdata(vif
);
705 struct ieee80211_local
*local
= sdata
->local
;
706 struct ieee80211_ra_tid
*ra_tid
;
707 struct sk_buff
*skb
= dev_alloc_skb(0);
712 ra_tid
= (struct ieee80211_ra_tid
*) &skb
->cb
;
713 memcpy(&ra_tid
->ra
, ra
, ETH_ALEN
);
716 skb
->pkt_type
= IEEE80211_SDATA_QUEUE_AGG_START
;
717 skb_queue_tail(&sdata
->skb_queue
, skb
);
718 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
720 EXPORT_SYMBOL(ieee80211_start_tx_ba_cb_irqsafe
);
722 int __ieee80211_stop_tx_ba_session(struct sta_info
*sta
, u16 tid
,
723 enum ieee80211_agg_stop_reason reason
)
727 mutex_lock(&sta
->ampdu_mlme
.mtx
);
729 ret
= ___ieee80211_stop_tx_ba_session(sta
, tid
, reason
);
731 mutex_unlock(&sta
->ampdu_mlme
.mtx
);
736 int ieee80211_stop_tx_ba_session(struct ieee80211_sta
*pubsta
, u16 tid
)
738 struct sta_info
*sta
= container_of(pubsta
, struct sta_info
, sta
);
739 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
740 struct ieee80211_local
*local
= sdata
->local
;
741 struct tid_ampdu_tx
*tid_tx
;
744 trace_api_stop_tx_ba_session(pubsta
, tid
);
746 if (!local
->ops
->ampdu_action
)
749 if (tid
>= IEEE80211_NUM_TIDS
)
752 spin_lock_bh(&sta
->lock
);
753 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
760 if (test_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
)) {
761 /* already in progress stopping it */
766 set_bit(HT_AGG_STATE_WANT_STOP
, &tid_tx
->state
);
767 ieee80211_queue_work(&local
->hw
, &sta
->ampdu_mlme
.work
);
770 spin_unlock_bh(&sta
->lock
);
773 EXPORT_SYMBOL(ieee80211_stop_tx_ba_session
);
775 void ieee80211_stop_tx_ba_cb(struct ieee80211_vif
*vif
, u8
*ra
, u8 tid
)
777 struct ieee80211_sub_if_data
*sdata
= vif_to_sdata(vif
);
778 struct ieee80211_local
*local
= sdata
->local
;
779 struct sta_info
*sta
;
780 struct tid_ampdu_tx
*tid_tx
;
782 trace_api_stop_tx_ba_cb(sdata
, ra
, tid
);
784 if (tid
>= IEEE80211_NUM_TIDS
) {
785 ht_dbg(sdata
, "Bad TID value: tid = %d (>= %d)\n",
786 tid
, IEEE80211_NUM_TIDS
);
790 ht_dbg(sdata
, "Stopping Tx BA session for %pM tid %d\n", ra
, tid
);
792 mutex_lock(&local
->sta_mtx
);
794 sta
= sta_info_get_bss(sdata
, ra
);
796 ht_dbg(sdata
, "Could not find station: %pM\n", ra
);
800 mutex_lock(&sta
->ampdu_mlme
.mtx
);
801 spin_lock_bh(&sta
->lock
);
802 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
804 if (!tid_tx
|| !test_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
)) {
805 ht_dbg(sdata
, "unexpected callback to A-MPDU stop\n");
809 if (tid_tx
->stop_initiator
== WLAN_BACK_INITIATOR
&& tid_tx
->tx_stop
)
810 ieee80211_send_delba(sta
->sdata
, ra
, tid
,
811 WLAN_BACK_INITIATOR
, WLAN_REASON_QSTA_NOT_USE
);
813 ieee80211_remove_tid_tx(sta
, tid
);
816 spin_unlock_bh(&sta
->lock
);
817 mutex_unlock(&sta
->ampdu_mlme
.mtx
);
819 mutex_unlock(&local
->sta_mtx
);
822 void ieee80211_stop_tx_ba_cb_irqsafe(struct ieee80211_vif
*vif
,
823 const u8
*ra
, u16 tid
)
825 struct ieee80211_sub_if_data
*sdata
= vif_to_sdata(vif
);
826 struct ieee80211_local
*local
= sdata
->local
;
827 struct ieee80211_ra_tid
*ra_tid
;
828 struct sk_buff
*skb
= dev_alloc_skb(0);
833 ra_tid
= (struct ieee80211_ra_tid
*) &skb
->cb
;
834 memcpy(&ra_tid
->ra
, ra
, ETH_ALEN
);
837 skb
->pkt_type
= IEEE80211_SDATA_QUEUE_AGG_STOP
;
838 skb_queue_tail(&sdata
->skb_queue
, skb
);
839 ieee80211_queue_work(&local
->hw
, &sdata
->work
);
841 EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb_irqsafe
);
844 void ieee80211_process_addba_resp(struct ieee80211_local
*local
,
845 struct sta_info
*sta
,
846 struct ieee80211_mgmt
*mgmt
,
849 struct tid_ampdu_tx
*tid_tx
;
853 capab
= le16_to_cpu(mgmt
->u
.action
.u
.addba_resp
.capab
);
854 tid
= (capab
& IEEE80211_ADDBA_PARAM_TID_MASK
) >> 2;
855 buf_size
= (capab
& IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK
) >> 6;
857 mutex_lock(&sta
->ampdu_mlme
.mtx
);
859 tid_tx
= rcu_dereference_protected_tid_tx(sta
, tid
);
863 if (mgmt
->u
.action
.u
.addba_resp
.dialog_token
!= tid_tx
->dialog_token
) {
864 ht_dbg(sta
->sdata
, "wrong addBA response token, tid %d\n", tid
);
868 del_timer_sync(&tid_tx
->addba_resp_timer
);
870 ht_dbg(sta
->sdata
, "switched off addBA timer for tid %d\n", tid
);
873 * addba_resp_timer may have fired before we got here, and
874 * caused WANT_STOP to be set. If the stop then was already
875 * processed further, STOPPING might be set.
877 if (test_bit(HT_AGG_STATE_WANT_STOP
, &tid_tx
->state
) ||
878 test_bit(HT_AGG_STATE_STOPPING
, &tid_tx
->state
)) {
880 "got addBA resp for tid %d but we already gave up\n",
886 * IEEE 802.11-2007 7.3.1.14:
887 * In an ADDBA Response frame, when the Status Code field
888 * is set to 0, the Buffer Size subfield is set to a value
891 if (le16_to_cpu(mgmt
->u
.action
.u
.addba_resp
.status
)
892 == WLAN_STATUS_SUCCESS
&& buf_size
) {
893 if (test_and_set_bit(HT_AGG_STATE_RESPONSE_RECEIVED
,
895 /* ignore duplicate response */
899 tid_tx
->buf_size
= buf_size
;
901 if (test_bit(HT_AGG_STATE_DRV_READY
, &tid_tx
->state
))
902 ieee80211_agg_tx_operational(local
, sta
, tid
);
904 sta
->ampdu_mlme
.addba_req_num
[tid
] = 0;
906 if (tid_tx
->timeout
) {
907 mod_timer(&tid_tx
->session_timer
,
908 TU_TO_EXP_TIME(tid_tx
->timeout
));
909 tid_tx
->last_tx
= jiffies
;
913 ___ieee80211_stop_tx_ba_session(sta
, tid
, AGG_STOP_DECLINED
);
917 mutex_unlock(&sta
->ampdu_mlme
.mtx
);