blob: bb4ac70fc97acd8864de833e8006f31762a967c9 [file] [log] [blame]
Johannes Bergb8695a82009-02-10 21:25:46 +01001/*
2 * HT handling
3 *
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-2009, Intel Corporation
10 *
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.
14 */
15
16#include <linux/ieee80211.h>
17#include <net/mac80211.h>
18#include "ieee80211_i.h"
Johannes Berg24487982009-04-23 18:52:52 +020019#include "driver-ops.h"
Johannes Bergb8695a82009-02-10 21:25:46 +010020#include "wme.h"
21
Johannes Berg86ab6c52009-02-10 21:25:49 +010022/**
23 * DOC: TX aggregation
24 *
25 * Aggregation on the TX side requires setting the hardware flag
26 * %IEEE80211_HW_AMPDU_AGGREGATION as well as, if present, the @ampdu_queues
27 * hardware parameter to the number of hardware AMPDU queues. If there are no
28 * hardware queues then the driver will (currently) have to do all frame
29 * buffering.
30 *
31 * When TX aggregation is started by some subsystem (usually the rate control
32 * algorithm would be appropriate) by calling the
33 * ieee80211_start_tx_ba_session() function, the driver will be notified via
34 * its @ampdu_action function, with the %IEEE80211_AMPDU_TX_START action.
35 *
36 * In response to that, the driver is later required to call the
37 * ieee80211_start_tx_ba_cb() (or ieee80211_start_tx_ba_cb_irqsafe())
38 * function, which will start the aggregation session.
39 *
40 * Similarly, when the aggregation session is stopped by
41 * ieee80211_stop_tx_ba_session(), the driver's @ampdu_action function will
42 * be called with the action %IEEE80211_AMPDU_TX_STOP. In this case, the
43 * call must not fail, and the driver must later call ieee80211_stop_tx_ba_cb()
44 * (or ieee80211_stop_tx_ba_cb_irqsafe()).
45 */
46
Johannes Bergb8695a82009-02-10 21:25:46 +010047static void ieee80211_send_addba_request(struct ieee80211_sub_if_data *sdata,
48 const u8 *da, u16 tid,
49 u8 dialog_token, u16 start_seq_num,
50 u16 agg_size, u16 timeout)
51{
52 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +010053 struct sk_buff *skb;
54 struct ieee80211_mgmt *mgmt;
55 u16 capab;
56
57 skb = dev_alloc_skb(sizeof(*mgmt) + local->hw.extra_tx_headroom);
58
59 if (!skb) {
60 printk(KERN_ERR "%s: failed to allocate buffer "
Johannes Berg47846c92009-11-25 17:46:19 +010061 "for addba request frame\n", sdata->name);
Johannes Bergb8695a82009-02-10 21:25:46 +010062 return;
63 }
64 skb_reserve(skb, local->hw.extra_tx_headroom);
65 mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
66 memset(mgmt, 0, 24);
67 memcpy(mgmt->da, da, ETH_ALEN);
Johannes Berg47846c92009-11-25 17:46:19 +010068 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
Johannes Berg8abd3f92009-02-10 21:25:47 +010069 if (sdata->vif.type == NL80211_IFTYPE_AP ||
70 sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
Johannes Berg47846c92009-11-25 17:46:19 +010071 memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
Johannes Berg46900292009-02-15 12:44:28 +010072 else if (sdata->vif.type == NL80211_IFTYPE_STATION)
73 memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
Johannes Bergb8695a82009-02-10 21:25:46 +010074
75 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
76 IEEE80211_STYPE_ACTION);
77
78 skb_put(skb, 1 + sizeof(mgmt->u.action.u.addba_req));
79
80 mgmt->u.action.category = WLAN_CATEGORY_BACK;
81 mgmt->u.action.u.addba_req.action_code = WLAN_ACTION_ADDBA_REQ;
82
83 mgmt->u.action.u.addba_req.dialog_token = dialog_token;
84 capab = (u16)(1 << 1); /* bit 1 aggregation policy */
85 capab |= (u16)(tid << 2); /* bit 5:2 TID number */
86 capab |= (u16)(agg_size << 6); /* bit 15:6 max size of aggergation */
87
88 mgmt->u.action.u.addba_req.capab = cpu_to_le16(capab);
89
90 mgmt->u.action.u.addba_req.timeout = cpu_to_le16(timeout);
91 mgmt->u.action.u.addba_req.start_seq_num =
92 cpu_to_le16(start_seq_num << 4);
93
Johannes Berg62ae67b2009-11-18 18:42:05 +010094 ieee80211_tx_skb(sdata, skb);
Johannes Bergb8695a82009-02-10 21:25:46 +010095}
96
97void ieee80211_send_bar(struct ieee80211_sub_if_data *sdata, u8 *ra, u16 tid, u16 ssn)
98{
99 struct ieee80211_local *local = sdata->local;
100 struct sk_buff *skb;
101 struct ieee80211_bar *bar;
102 u16 bar_control = 0;
103
104 skb = dev_alloc_skb(sizeof(*bar) + local->hw.extra_tx_headroom);
105 if (!skb) {
106 printk(KERN_ERR "%s: failed to allocate buffer for "
Johannes Berg47846c92009-11-25 17:46:19 +0100107 "bar frame\n", sdata->name);
Johannes Bergb8695a82009-02-10 21:25:46 +0100108 return;
109 }
110 skb_reserve(skb, local->hw.extra_tx_headroom);
111 bar = (struct ieee80211_bar *)skb_put(skb, sizeof(*bar));
112 memset(bar, 0, sizeof(*bar));
113 bar->frame_control = cpu_to_le16(IEEE80211_FTYPE_CTL |
114 IEEE80211_STYPE_BACK_REQ);
115 memcpy(bar->ra, ra, ETH_ALEN);
Johannes Berg47846c92009-11-25 17:46:19 +0100116 memcpy(bar->ta, sdata->vif.addr, ETH_ALEN);
Johannes Bergb8695a82009-02-10 21:25:46 +0100117 bar_control |= (u16)IEEE80211_BAR_CTRL_ACK_POLICY_NORMAL;
118 bar_control |= (u16)IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA;
119 bar_control |= (u16)(tid << 12);
120 bar->control = cpu_to_le16(bar_control);
121 bar->start_seq_num = cpu_to_le16(ssn);
122
Johannes Berg62ae67b2009-11-18 18:42:05 +0100123 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
124 ieee80211_tx_skb(sdata, skb);
Johannes Bergb8695a82009-02-10 21:25:46 +0100125}
126
Johannes Berg827d42c2009-11-22 12:28:41 +0100127int ___ieee80211_stop_tx_ba_session(struct sta_info *sta, u16 tid,
128 enum ieee80211_back_parties initiator)
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100129{
Johannes Berg849b7962009-02-10 21:25:54 +0100130 struct ieee80211_local *local = sta->local;
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100131 int ret;
132 u8 *state;
133
Johannes Berg827d42c2009-11-22 12:28:41 +0100134#ifdef CONFIG_MAC80211_HT_DEBUG
135 printk(KERN_DEBUG "Tx BA session stop requested for %pM tid %u\n",
136 sta->sta.addr, tid);
137#endif /* CONFIG_MAC80211_HT_DEBUG */
138
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100139 state = &sta->ampdu_mlme.tid_state_tx[tid];
140
Vasanthakumar Thiagarajan736708b2009-06-09 14:11:46 +0530141 if (*state == HT_AGG_STATE_OPERATIONAL)
142 sta->ampdu_mlme.addba_req_num[tid] = 0;
143
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100144 *state = HT_AGG_STATE_REQ_STOP_BA_MSK |
145 (initiator << HT_AGG_STATE_INITIATOR_SHIFT);
146
Johannes Berg12375ef2009-11-25 20:30:31 +0100147 ret = drv_ampdu_action(local, sta->sdata,
Johannes Bergc951ad32009-11-16 12:00:38 +0100148 IEEE80211_AMPDU_TX_STOP,
Johannes Berg24487982009-04-23 18:52:52 +0200149 &sta->sta, tid, NULL);
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100150
151 /* HW shall not deny going back to legacy */
152 if (WARN_ON(ret)) {
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100153 /*
154 * We may have pending packets get stuck in this case...
155 * Not bothering with a workaround for now.
156 */
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100157 }
158
159 return ret;
160}
161
Johannes Bergb8695a82009-02-10 21:25:46 +0100162/*
163 * After sending add Block Ack request we activated a timer until
164 * add Block Ack response will arrive from the recipient.
165 * If this timer expires sta_addba_resp_timer_expired will be executed.
166 */
167static void sta_addba_resp_timer_expired(unsigned long data)
168{
169 /* not an elegant detour, but there is no choice as the timer passes
170 * only one argument, and both sta_info and TID are needed, so init
171 * flow in sta_info_create gives the TID as data, while the timer_to_id
172 * array gives the sta through container_of */
173 u16 tid = *(u8 *)data;
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100174 struct sta_info *sta = container_of((void *)data,
Johannes Bergb8695a82009-02-10 21:25:46 +0100175 struct sta_info, timer_to_tid[tid]);
Johannes Bergb8695a82009-02-10 21:25:46 +0100176 u8 *state;
177
Johannes Bergb8695a82009-02-10 21:25:46 +0100178 state = &sta->ampdu_mlme.tid_state_tx[tid];
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100179
Johannes Bergb8695a82009-02-10 21:25:46 +0100180 /* check if the TID waits for addBA response */
181 spin_lock_bh(&sta->lock);
Zhu Yi3dc1de02009-12-28 16:57:15 +0800182 if ((*state & (HT_ADDBA_REQUESTED_MSK | HT_ADDBA_RECEIVED_MSK |
183 HT_AGG_STATE_REQ_STOP_BA_MSK)) !=
Johannes Berg8ade0082009-11-18 17:15:06 +0100184 HT_ADDBA_REQUESTED_MSK) {
Johannes Bergb8695a82009-02-10 21:25:46 +0100185 spin_unlock_bh(&sta->lock);
186 *state = HT_AGG_STATE_IDLE;
187#ifdef CONFIG_MAC80211_HT_DEBUG
188 printk(KERN_DEBUG "timer expired on tid %d but we are not "
Johannes Berg8ade0082009-11-18 17:15:06 +0100189 "(or no longer) expecting addBA response there",
190 tid);
Johannes Bergb8695a82009-02-10 21:25:46 +0100191#endif
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100192 return;
Johannes Bergb8695a82009-02-10 21:25:46 +0100193 }
194
195#ifdef CONFIG_MAC80211_HT_DEBUG
196 printk(KERN_DEBUG "addBA response timer expired on tid %d\n", tid);
197#endif
198
Johannes Berg849b7962009-02-10 21:25:54 +0100199 ___ieee80211_stop_tx_ba_session(sta, tid, WLAN_BACK_INITIATOR);
Johannes Bergb8695a82009-02-10 21:25:46 +0100200 spin_unlock_bh(&sta->lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100201}
202
Johannes Berg96f5e662009-02-12 00:51:53 +0100203static inline int ieee80211_ac_from_tid(int tid)
204{
205 return ieee802_1d_to_ac[tid & 7];
206}
207
Johannes Bergc951ad32009-11-16 12:00:38 +0100208int ieee80211_start_tx_ba_session(struct ieee80211_sta *pubsta, u16 tid)
Johannes Bergb8695a82009-02-10 21:25:46 +0100209{
Johannes Bergc951ad32009-11-16 12:00:38 +0100210 struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
211 struct ieee80211_sub_if_data *sdata = sta->sdata;
212 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +0100213 u8 *state;
Johannes Berge4e72fb2009-03-23 17:28:42 +0100214 int ret = 0;
Johannes Berg96f5e662009-02-12 00:51:53 +0100215 u16 start_seq_num;
Johannes Bergb8695a82009-02-10 21:25:46 +0100216
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100217 if (WARN_ON(!local->ops->ampdu_action))
218 return -EINVAL;
219
Johannes Bergc951ad32009-11-16 12:00:38 +0100220 if ((tid >= STA_TID_NUM) ||
221 !(local->hw.flags & IEEE80211_HW_AMPDU_AGGREGATION))
Johannes Bergb8695a82009-02-10 21:25:46 +0100222 return -EINVAL;
223
224#ifdef CONFIG_MAC80211_HT_DEBUG
225 printk(KERN_DEBUG "Open BA session requested for %pM tid %u\n",
Johannes Bergc951ad32009-11-16 12:00:38 +0100226 pubsta->addr, tid);
Johannes Bergb8695a82009-02-10 21:25:46 +0100227#endif /* CONFIG_MAC80211_HT_DEBUG */
228
Johannes Berg8abd3f92009-02-10 21:25:47 +0100229 /*
230 * The aggregation code is not prepared to handle
231 * anything but STA/AP due to the BSSID handling.
232 * IBSS could work in the code but isn't supported
233 * by drivers or the standard.
234 */
Johannes Bergc951ad32009-11-16 12:00:38 +0100235 if (sdata->vif.type != NL80211_IFTYPE_STATION &&
236 sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
237 sdata->vif.type != NL80211_IFTYPE_AP)
238 return -EINVAL;
Johannes Berg8abd3f92009-02-10 21:25:47 +0100239
Sujith4cad6c72010-02-10 14:52:21 +0530240 if (test_sta_flags(sta, WLAN_STA_DISASSOC)) {
241#ifdef CONFIG_MAC80211_HT_DEBUG
242 printk(KERN_DEBUG "Disassociation is in progress. "
243 "Denying BA session request\n");
244#endif
245 return -EINVAL;
246 }
247
Sujith722f0692009-03-17 08:50:06 +0530248 if (test_sta_flags(sta, WLAN_STA_SUSPEND)) {
249#ifdef CONFIG_MAC80211_HT_DEBUG
250 printk(KERN_DEBUG "Suspend in progress. "
251 "Denying BA session request\n");
252#endif
Johannes Bergc951ad32009-11-16 12:00:38 +0100253 return -EINVAL;
Sujith722f0692009-03-17 08:50:06 +0530254 }
255
Johannes Bergb8695a82009-02-10 21:25:46 +0100256 spin_lock_bh(&sta->lock);
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100257 spin_lock(&local->ampdu_lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100258
259 /* we have tried too many times, receiver does not want A-MPDU */
260 if (sta->ampdu_mlme.addba_req_num[tid] > HT_AGG_MAX_RETRIES) {
261 ret = -EBUSY;
262 goto err_unlock_sta;
263 }
264
265 state = &sta->ampdu_mlme.tid_state_tx[tid];
266 /* check if the TID is not in aggregation flow already */
267 if (*state != HT_AGG_STATE_IDLE) {
268#ifdef CONFIG_MAC80211_HT_DEBUG
269 printk(KERN_DEBUG "BA request denied - session is not "
270 "idle on tid %u\n", tid);
271#endif /* CONFIG_MAC80211_HT_DEBUG */
272 ret = -EAGAIN;
273 goto err_unlock_sta;
274 }
275
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100276 /*
277 * While we're asking the driver about the aggregation,
278 * stop the AC queue so that we don't have to worry
279 * about frames that came in while we were doing that,
280 * which would require us to put them to the AC pending
281 * afterwards which just makes the code more complex.
282 */
283 ieee80211_stop_queue_by_reason(
284 &local->hw, ieee80211_ac_from_tid(tid),
285 IEEE80211_QUEUE_STOP_REASON_AGGREGATION);
286
Johannes Bergb8695a82009-02-10 21:25:46 +0100287 /* prepare A-MPDU MLME for Tx aggregation */
288 sta->ampdu_mlme.tid_tx[tid] =
289 kmalloc(sizeof(struct tid_ampdu_tx), GFP_ATOMIC);
290 if (!sta->ampdu_mlme.tid_tx[tid]) {
291#ifdef CONFIG_MAC80211_HT_DEBUG
292 if (net_ratelimit())
293 printk(KERN_ERR "allocate tx mlme to tid %d failed\n",
294 tid);
295#endif
296 ret = -ENOMEM;
Johannes Berge4e72fb2009-03-23 17:28:42 +0100297 goto err_wake_queue;
Johannes Bergb8695a82009-02-10 21:25:46 +0100298 }
Johannes Berg96f5e662009-02-12 00:51:53 +0100299
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100300 skb_queue_head_init(&sta->ampdu_mlme.tid_tx[tid]->pending);
301
Johannes Bergb8695a82009-02-10 21:25:46 +0100302 /* Tx timer */
303 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.function =
304 sta_addba_resp_timer_expired;
305 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.data =
306 (unsigned long)&sta->timer_to_tid[tid];
307 init_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer);
308
Johannes Bergb8695a82009-02-10 21:25:46 +0100309 /* Ok, the Addba frame hasn't been sent yet, but if the driver calls the
310 * call back right away, it must see that the flow has begun */
311 *state |= HT_ADDBA_REQUESTED_MSK;
312
Christian Lamparterf3f66b62010-01-04 00:52:56 +0100313 start_seq_num = sta->tid_seq[tid] >> 4;
Johannes Bergb8695a82009-02-10 21:25:46 +0100314
Johannes Berg12375ef2009-11-25 20:30:31 +0100315 ret = drv_ampdu_action(local, sdata, IEEE80211_AMPDU_TX_START,
Johannes Bergc951ad32009-11-16 12:00:38 +0100316 pubsta, tid, &start_seq_num);
Johannes Bergb8695a82009-02-10 21:25:46 +0100317
318 if (ret) {
Johannes Bergb8695a82009-02-10 21:25:46 +0100319#ifdef CONFIG_MAC80211_HT_DEBUG
320 printk(KERN_DEBUG "BA request denied - HW unavailable for"
321 " tid %d\n", tid);
322#endif /* CONFIG_MAC80211_HT_DEBUG */
323 *state = HT_AGG_STATE_IDLE;
Johannes Berg96f5e662009-02-12 00:51:53 +0100324 goto err_free;
Johannes Bergb8695a82009-02-10 21:25:46 +0100325 }
326
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100327 /* Driver vetoed or OKed, but we can take packets again now */
328 ieee80211_wake_queue_by_reason(
329 &local->hw, ieee80211_ac_from_tid(tid),
330 IEEE80211_QUEUE_STOP_REASON_AGGREGATION);
331
332 spin_unlock(&local->ampdu_lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100333 spin_unlock_bh(&sta->lock);
334
335 /* send an addBA request */
336 sta->ampdu_mlme.dialog_token_allocator++;
337 sta->ampdu_mlme.tid_tx[tid]->dialog_token =
338 sta->ampdu_mlme.dialog_token_allocator;
339 sta->ampdu_mlme.tid_tx[tid]->ssn = start_seq_num;
340
Johannes Bergc951ad32009-11-16 12:00:38 +0100341 ieee80211_send_addba_request(sdata, pubsta->addr, tid,
Johannes Bergb8695a82009-02-10 21:25:46 +0100342 sta->ampdu_mlme.tid_tx[tid]->dialog_token,
343 sta->ampdu_mlme.tid_tx[tid]->ssn,
344 0x40, 5000);
Vasanthakumar Thiagarajan736708b2009-06-09 14:11:46 +0530345 sta->ampdu_mlme.addba_req_num[tid]++;
Johannes Bergb8695a82009-02-10 21:25:46 +0100346 /* activate the timer for the recipient's addBA response */
347 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.expires =
348 jiffies + ADDBA_RESP_INTERVAL;
349 add_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer);
350#ifdef CONFIG_MAC80211_HT_DEBUG
351 printk(KERN_DEBUG "activated addBA response timer on tid %d\n", tid);
352#endif
Johannes Bergc951ad32009-11-16 12:00:38 +0100353 return 0;
Johannes Bergb8695a82009-02-10 21:25:46 +0100354
Johannes Berg96f5e662009-02-12 00:51:53 +0100355 err_free:
Johannes Bergb8695a82009-02-10 21:25:46 +0100356 kfree(sta->ampdu_mlme.tid_tx[tid]);
357 sta->ampdu_mlme.tid_tx[tid] = NULL;
Johannes Berge4e72fb2009-03-23 17:28:42 +0100358 err_wake_queue:
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100359 ieee80211_wake_queue_by_reason(
360 &local->hw, ieee80211_ac_from_tid(tid),
361 IEEE80211_QUEUE_STOP_REASON_AGGREGATION);
Johannes Berg96f5e662009-02-12 00:51:53 +0100362 err_unlock_sta:
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100363 spin_unlock(&local->ampdu_lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100364 spin_unlock_bh(&sta->lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100365 return ret;
366}
367EXPORT_SYMBOL(ieee80211_start_tx_ba_session);
368
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100369/*
370 * splice packets from the STA's pending to the local pending,
371 * requires a call to ieee80211_agg_splice_finish and holding
372 * local->ampdu_lock across both calls.
373 */
374static void ieee80211_agg_splice_packets(struct ieee80211_local *local,
375 struct sta_info *sta, u16 tid)
376{
377 unsigned long flags;
378 u16 queue = ieee80211_ac_from_tid(tid);
379
380 ieee80211_stop_queue_by_reason(
381 &local->hw, queue,
382 IEEE80211_QUEUE_STOP_REASON_AGGREGATION);
383
Luis R. Rodriguez416fbdf2009-08-11 13:10:33 -0700384 if (!(sta->ampdu_mlme.tid_state_tx[tid] & HT_ADDBA_REQUESTED_MSK))
385 return;
386
387 if (WARN(!sta->ampdu_mlme.tid_tx[tid],
388 "TID %d gone but expected when splicing aggregates from"
389 "the pending queue\n", tid))
390 return;
391
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100392 if (!skb_queue_empty(&sta->ampdu_mlme.tid_tx[tid]->pending)) {
393 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100394 /* copy over remaining packets */
395 skb_queue_splice_tail_init(
396 &sta->ampdu_mlme.tid_tx[tid]->pending,
397 &local->pending[queue]);
398 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
399 }
400}
401
402static void ieee80211_agg_splice_finish(struct ieee80211_local *local,
403 struct sta_info *sta, u16 tid)
404{
405 u16 queue = ieee80211_ac_from_tid(tid);
406
407 ieee80211_wake_queue_by_reason(
408 &local->hw, queue,
409 IEEE80211_QUEUE_STOP_REASON_AGGREGATION);
410}
411
412/* caller must hold sta->lock */
Johannes Bergb1720232009-03-23 17:28:39 +0100413static void ieee80211_agg_tx_operational(struct ieee80211_local *local,
414 struct sta_info *sta, u16 tid)
415{
416#ifdef CONFIG_MAC80211_HT_DEBUG
Frans Pop55f98932010-03-24 19:46:29 +0100417 printk(KERN_DEBUG "Aggregation is on for tid %d\n", tid);
Johannes Bergb1720232009-03-23 17:28:39 +0100418#endif
419
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100420 spin_lock(&local->ampdu_lock);
421 ieee80211_agg_splice_packets(local, sta, tid);
422 /*
423 * NB: we rely on sta->lock being taken in the TX
424 * processing here when adding to the pending queue,
425 * otherwise we could only change the state of the
426 * session to OPERATIONAL _here_.
427 */
428 ieee80211_agg_splice_finish(local, sta, tid);
429 spin_unlock(&local->ampdu_lock);
Johannes Bergb1720232009-03-23 17:28:39 +0100430
Johannes Berg12375ef2009-11-25 20:30:31 +0100431 drv_ampdu_action(local, sta->sdata,
Johannes Bergc951ad32009-11-16 12:00:38 +0100432 IEEE80211_AMPDU_TX_OPERATIONAL,
Johannes Berg24487982009-04-23 18:52:52 +0200433 &sta->sta, tid, NULL);
Johannes Bergb1720232009-03-23 17:28:39 +0100434}
435
Johannes Bergc951ad32009-11-16 12:00:38 +0100436void ieee80211_start_tx_ba_cb(struct ieee80211_vif *vif, u8 *ra, u16 tid)
Johannes Bergb8695a82009-02-10 21:25:46 +0100437{
Johannes Bergc951ad32009-11-16 12:00:38 +0100438 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
439 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +0100440 struct sta_info *sta;
441 u8 *state;
442
443 if (tid >= STA_TID_NUM) {
444#ifdef CONFIG_MAC80211_HT_DEBUG
445 printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n",
446 tid, STA_TID_NUM);
447#endif
448 return;
449 }
450
451 rcu_read_lock();
Johannes Bergabe60632009-11-25 17:46:18 +0100452 sta = sta_info_get(sdata, ra);
Johannes Bergb8695a82009-02-10 21:25:46 +0100453 if (!sta) {
454 rcu_read_unlock();
455#ifdef CONFIG_MAC80211_HT_DEBUG
456 printk(KERN_DEBUG "Could not find station: %pM\n", ra);
457#endif
458 return;
459 }
460
461 state = &sta->ampdu_mlme.tid_state_tx[tid];
462 spin_lock_bh(&sta->lock);
463
Johannes Berg96f5e662009-02-12 00:51:53 +0100464 if (WARN_ON(!(*state & HT_ADDBA_REQUESTED_MSK))) {
Johannes Bergb8695a82009-02-10 21:25:46 +0100465#ifdef CONFIG_MAC80211_HT_DEBUG
466 printk(KERN_DEBUG "addBA was not requested yet, state is %d\n",
467 *state);
468#endif
469 spin_unlock_bh(&sta->lock);
470 rcu_read_unlock();
471 return;
472 }
473
Johannes Berg96f5e662009-02-12 00:51:53 +0100474 if (WARN_ON(*state & HT_ADDBA_DRV_READY_MSK))
475 goto out;
Johannes Bergb8695a82009-02-10 21:25:46 +0100476
477 *state |= HT_ADDBA_DRV_READY_MSK;
478
Johannes Bergb1720232009-03-23 17:28:39 +0100479 if (*state == HT_AGG_STATE_OPERATIONAL)
480 ieee80211_agg_tx_operational(local, sta, tid);
Johannes Berg96f5e662009-02-12 00:51:53 +0100481
482 out:
Johannes Bergb8695a82009-02-10 21:25:46 +0100483 spin_unlock_bh(&sta->lock);
484 rcu_read_unlock();
485}
486EXPORT_SYMBOL(ieee80211_start_tx_ba_cb);
487
Johannes Bergc951ad32009-11-16 12:00:38 +0100488void ieee80211_start_tx_ba_cb_irqsafe(struct ieee80211_vif *vif,
Johannes Berg86ab6c52009-02-10 21:25:49 +0100489 const u8 *ra, u16 tid)
490{
Johannes Bergc951ad32009-11-16 12:00:38 +0100491 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
492 struct ieee80211_local *local = sdata->local;
Johannes Berg86ab6c52009-02-10 21:25:49 +0100493 struct ieee80211_ra_tid *ra_tid;
494 struct sk_buff *skb = dev_alloc_skb(0);
495
496 if (unlikely(!skb)) {
497#ifdef CONFIG_MAC80211_HT_DEBUG
498 if (net_ratelimit())
499 printk(KERN_WARNING "%s: Not enough memory, "
Johannes Berg47846c92009-11-25 17:46:19 +0100500 "dropping start BA session", sdata->name);
Johannes Berg86ab6c52009-02-10 21:25:49 +0100501#endif
502 return;
503 }
504 ra_tid = (struct ieee80211_ra_tid *) &skb->cb;
505 memcpy(&ra_tid->ra, ra, ETH_ALEN);
506 ra_tid->tid = tid;
Sujith0bc6b182009-11-18 11:42:14 +0530507 ra_tid->vif = vif;
Johannes Berg86ab6c52009-02-10 21:25:49 +0100508
509 skb->pkt_type = IEEE80211_ADDBA_MSG;
510 skb_queue_tail(&local->skb_queue, skb);
511 tasklet_schedule(&local->tasklet);
512}
513EXPORT_SYMBOL(ieee80211_start_tx_ba_cb_irqsafe);
514
Johannes Berg849b7962009-02-10 21:25:54 +0100515int __ieee80211_stop_tx_ba_session(struct sta_info *sta, u16 tid,
516 enum ieee80211_back_parties initiator)
517{
518 u8 *state;
519 int ret;
520
521 /* check if the TID is in aggregation */
522 state = &sta->ampdu_mlme.tid_state_tx[tid];
523 spin_lock_bh(&sta->lock);
524
525 if (*state != HT_AGG_STATE_OPERATIONAL) {
526 ret = -ENOENT;
527 goto unlock;
528 }
529
Johannes Berg849b7962009-02-10 21:25:54 +0100530 ret = ___ieee80211_stop_tx_ba_session(sta, tid, initiator);
531
532 unlock:
533 spin_unlock_bh(&sta->lock);
534 return ret;
535}
Johannes Bergb8695a82009-02-10 21:25:46 +0100536
Johannes Bergc951ad32009-11-16 12:00:38 +0100537int ieee80211_stop_tx_ba_session(struct ieee80211_sta *pubsta, u16 tid,
Johannes Bergb8695a82009-02-10 21:25:46 +0100538 enum ieee80211_back_parties initiator)
539{
Johannes Bergc951ad32009-11-16 12:00:38 +0100540 struct sta_info *sta = container_of(pubsta, struct sta_info, sta);
541 struct ieee80211_sub_if_data *sdata = sta->sdata;
542 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +0100543
Johannes Berg42531192009-11-20 09:15:51 +0100544 if (!local->ops->ampdu_action)
Johannes Berg23e6a7e2009-02-10 21:25:50 +0100545 return -EINVAL;
546
Johannes Bergb8695a82009-02-10 21:25:46 +0100547 if (tid >= STA_TID_NUM)
548 return -EINVAL;
549
Johannes Bergc951ad32009-11-16 12:00:38 +0100550 return __ieee80211_stop_tx_ba_session(sta, tid, initiator);
Johannes Bergb8695a82009-02-10 21:25:46 +0100551}
552EXPORT_SYMBOL(ieee80211_stop_tx_ba_session);
553
Johannes Bergc951ad32009-11-16 12:00:38 +0100554void ieee80211_stop_tx_ba_cb(struct ieee80211_vif *vif, u8 *ra, u8 tid)
Johannes Bergb8695a82009-02-10 21:25:46 +0100555{
Johannes Bergc951ad32009-11-16 12:00:38 +0100556 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
557 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +0100558 struct sta_info *sta;
559 u8 *state;
Johannes Bergb8695a82009-02-10 21:25:46 +0100560
561 if (tid >= STA_TID_NUM) {
562#ifdef CONFIG_MAC80211_HT_DEBUG
563 printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n",
564 tid, STA_TID_NUM);
565#endif
566 return;
567 }
568
569#ifdef CONFIG_MAC80211_HT_DEBUG
570 printk(KERN_DEBUG "Stopping Tx BA session for %pM tid %d\n",
571 ra, tid);
572#endif /* CONFIG_MAC80211_HT_DEBUG */
573
574 rcu_read_lock();
Johannes Bergabe60632009-11-25 17:46:18 +0100575 sta = sta_info_get(sdata, ra);
Johannes Bergb8695a82009-02-10 21:25:46 +0100576 if (!sta) {
577#ifdef CONFIG_MAC80211_HT_DEBUG
578 printk(KERN_DEBUG "Could not find station: %pM\n", ra);
579#endif
580 rcu_read_unlock();
581 return;
582 }
583 state = &sta->ampdu_mlme.tid_state_tx[tid];
584
585 /* NOTE: no need to use sta->lock in this state check, as
586 * ieee80211_stop_tx_ba_session will let only one stop call to
587 * pass through per sta/tid
588 */
589 if ((*state & HT_AGG_STATE_REQ_STOP_BA_MSK) == 0) {
590#ifdef CONFIG_MAC80211_HT_DEBUG
591 printk(KERN_DEBUG "unexpected callback to A-MPDU stop\n");
592#endif
593 rcu_read_unlock();
594 return;
595 }
596
597 if (*state & HT_AGG_STATE_INITIATOR_MSK)
598 ieee80211_send_delba(sta->sdata, ra, tid,
599 WLAN_BACK_INITIATOR, WLAN_REASON_QSTA_NOT_USE);
600
Johannes Bergb8695a82009-02-10 21:25:46 +0100601 spin_lock_bh(&sta->lock);
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100602 spin_lock(&local->ampdu_lock);
Johannes Berg96f5e662009-02-12 00:51:53 +0100603
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100604 ieee80211_agg_splice_packets(local, sta, tid);
Johannes Berg96f5e662009-02-12 00:51:53 +0100605
Johannes Bergb8695a82009-02-10 21:25:46 +0100606 *state = HT_AGG_STATE_IDLE;
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100607 /* from now on packets are no longer put onto sta->pending */
Johannes Bergb8695a82009-02-10 21:25:46 +0100608 kfree(sta->ampdu_mlme.tid_tx[tid]);
609 sta->ampdu_mlme.tid_tx[tid] = NULL;
Johannes Bergcd8ffc82009-03-23 17:28:41 +0100610
611 ieee80211_agg_splice_finish(local, sta, tid);
612
613 spin_unlock(&local->ampdu_lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100614 spin_unlock_bh(&sta->lock);
615
616 rcu_read_unlock();
617}
618EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb);
619
Johannes Bergc951ad32009-11-16 12:00:38 +0100620void ieee80211_stop_tx_ba_cb_irqsafe(struct ieee80211_vif *vif,
Johannes Bergb8695a82009-02-10 21:25:46 +0100621 const u8 *ra, u16 tid)
622{
Johannes Bergc951ad32009-11-16 12:00:38 +0100623 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
624 struct ieee80211_local *local = sdata->local;
Johannes Bergb8695a82009-02-10 21:25:46 +0100625 struct ieee80211_ra_tid *ra_tid;
626 struct sk_buff *skb = dev_alloc_skb(0);
627
628 if (unlikely(!skb)) {
629#ifdef CONFIG_MAC80211_HT_DEBUG
630 if (net_ratelimit())
631 printk(KERN_WARNING "%s: Not enough memory, "
Johannes Berg47846c92009-11-25 17:46:19 +0100632 "dropping stop BA session", sdata->name);
Johannes Bergb8695a82009-02-10 21:25:46 +0100633#endif
634 return;
635 }
636 ra_tid = (struct ieee80211_ra_tid *) &skb->cb;
637 memcpy(&ra_tid->ra, ra, ETH_ALEN);
638 ra_tid->tid = tid;
Sujith0bc6b182009-11-18 11:42:14 +0530639 ra_tid->vif = vif;
Johannes Bergb8695a82009-02-10 21:25:46 +0100640
641 skb->pkt_type = IEEE80211_DELBA_MSG;
642 skb_queue_tail(&local->skb_queue, skb);
643 tasklet_schedule(&local->tasklet);
644}
645EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb_irqsafe);
646
Johannes Berg86ab6c52009-02-10 21:25:49 +0100647
Johannes Bergb8695a82009-02-10 21:25:46 +0100648void ieee80211_process_addba_resp(struct ieee80211_local *local,
649 struct sta_info *sta,
650 struct ieee80211_mgmt *mgmt,
651 size_t len)
652{
Johannes Bergb1720232009-03-23 17:28:39 +0100653 u16 capab, tid;
Johannes Bergb8695a82009-02-10 21:25:46 +0100654 u8 *state;
655
656 capab = le16_to_cpu(mgmt->u.action.u.addba_resp.capab);
657 tid = (capab & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2;
658
659 state = &sta->ampdu_mlme.tid_state_tx[tid];
660
661 spin_lock_bh(&sta->lock);
662
Johannes Berg2171abc2009-10-29 08:34:00 +0100663 if (!(*state & HT_ADDBA_REQUESTED_MSK))
Johannes Berg8ade0082009-11-18 17:15:06 +0100664 goto out;
Johannes Bergb8695a82009-02-10 21:25:46 +0100665
666 if (mgmt->u.action.u.addba_resp.dialog_token !=
667 sta->ampdu_mlme.tid_tx[tid]->dialog_token) {
Johannes Bergb8695a82009-02-10 21:25:46 +0100668#ifdef CONFIG_MAC80211_HT_DEBUG
669 printk(KERN_DEBUG "wrong addBA response token, tid %d\n", tid);
670#endif /* CONFIG_MAC80211_HT_DEBUG */
Johannes Berg8ade0082009-11-18 17:15:06 +0100671 goto out;
Johannes Bergb8695a82009-02-10 21:25:46 +0100672 }
673
Johannes Berg8ade0082009-11-18 17:15:06 +0100674 del_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer);
675
Johannes Bergb8695a82009-02-10 21:25:46 +0100676#ifdef CONFIG_MAC80211_HT_DEBUG
Frans Pop55f98932010-03-24 19:46:29 +0100677 printk(KERN_DEBUG "switched off addBA timer for tid %d\n", tid);
Johannes Bergb8695a82009-02-10 21:25:46 +0100678#endif /* CONFIG_MAC80211_HT_DEBUG */
Johannes Berg2171abc2009-10-29 08:34:00 +0100679
Johannes Bergb8695a82009-02-10 21:25:46 +0100680 if (le16_to_cpu(mgmt->u.action.u.addba_resp.status)
681 == WLAN_STATUS_SUCCESS) {
Johannes Berg96f5e662009-02-12 00:51:53 +0100682 u8 curstate = *state;
Johannes Bergb8695a82009-02-10 21:25:46 +0100683
Johannes Berg96f5e662009-02-12 00:51:53 +0100684 *state |= HT_ADDBA_RECEIVED_MSK;
685
Johannes Bergb1720232009-03-23 17:28:39 +0100686 if (*state != curstate && *state == HT_AGG_STATE_OPERATIONAL)
687 ieee80211_agg_tx_operational(local, sta, tid);
Johannes Bergb8695a82009-02-10 21:25:46 +0100688
Johannes Bergb1720232009-03-23 17:28:39 +0100689 sta->ampdu_mlme.addba_req_num[tid] = 0;
Johannes Bergb8695a82009-02-10 21:25:46 +0100690 } else {
Johannes Berg849b7962009-02-10 21:25:54 +0100691 ___ieee80211_stop_tx_ba_session(sta, tid, WLAN_BACK_INITIATOR);
Johannes Bergb8695a82009-02-10 21:25:46 +0100692 }
Johannes Berg2171abc2009-10-29 08:34:00 +0100693
Johannes Berg2171abc2009-10-29 08:34:00 +0100694 out:
Johannes Berg849b7962009-02-10 21:25:54 +0100695 spin_unlock_bh(&sta->lock);
Johannes Bergb8695a82009-02-10 21:25:46 +0100696}