blob: 330a3a96babb93a7f78b6a7fcce00a080c369210 [file] [log] [blame]
Larry Finger94a79942011-08-23 19:00:42 -05001/******************************************************************************
2 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
3 *
4 * This program is distributed in the hope that it will be useful, but WITHOUT
5 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
6 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
7 * more details.
8 *
9 * You should have received a copy of the GNU General Public License along with
10 * this program; if not, write to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
12 *
13 * The full GNU General Public License is included in this distribution in the
14 * file called LICENSE.
15 *
16 * Contact Information:
17 * wlanfae <wlanfae@realtek.com>
18******************************************************************************/
19#include "rtllib.h"
20#include "rtl819x_BA.h"
21#include "rtl_core.h"
Larry Finger94a79942011-08-23 19:00:42 -050022
Larry Fingerec0dc6be2011-08-25 14:07:04 -050023static void ActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA,
24 u16 Time)
Larry Finger94a79942011-08-23 19:00:42 -050025{
26 pBA->bValid = true;
27 if (Time != 0)
28 mod_timer(&pBA->Timer, jiffies + MSECS(Time));
29}
30
Larry Fingerec0dc6be2011-08-25 14:07:04 -050031static void DeActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA)
Larry Finger94a79942011-08-23 19:00:42 -050032{
33 pBA->bValid = false;
34 del_timer_sync(&pBA->Timer);
35}
Larry Finger831cb9d2011-08-25 11:48:17 -050036
Larry Fingerec0dc6be2011-08-25 14:07:04 -050037static u8 TxTsDeleteBA(struct rtllib_device *ieee, struct tx_ts_record *pTxTs)
Larry Finger94a79942011-08-23 19:00:42 -050038{
Larry Finger8cf33312011-07-18 21:03:22 -050039 struct ba_record *pAdmittedBa = &pTxTs->TxAdmittedBARecord;
40 struct ba_record *pPendingBa = &pTxTs->TxPendingBARecord;
Larry Finger831cb9d2011-08-25 11:48:17 -050041 u8 bSendDELBA = false;
Larry Finger94a79942011-08-23 19:00:42 -050042
Larry Finger831cb9d2011-08-25 11:48:17 -050043 if (pPendingBa->bValid) {
Larry Finger94a79942011-08-23 19:00:42 -050044 DeActivateBAEntry(ieee, pPendingBa);
45 bSendDELBA = true;
46 }
47
Larry Finger831cb9d2011-08-25 11:48:17 -050048 if (pAdmittedBa->bValid) {
Larry Finger94a79942011-08-23 19:00:42 -050049 DeActivateBAEntry(ieee, pAdmittedBa);
50 bSendDELBA = true;
51 }
Larry Finger94a79942011-08-23 19:00:42 -050052 return bSendDELBA;
53}
54
Larry Fingerec0dc6be2011-08-25 14:07:04 -050055static u8 RxTsDeleteBA(struct rtllib_device *ieee, struct rx_ts_record *pRxTs)
Larry Finger94a79942011-08-23 19:00:42 -050056{
Larry Finger8cf33312011-07-18 21:03:22 -050057 struct ba_record *pBa = &pRxTs->RxAdmittedBARecord;
Larry Finger94a79942011-08-23 19:00:42 -050058 u8 bSendDELBA = false;
59
Larry Finger831cb9d2011-08-25 11:48:17 -050060 if (pBa->bValid) {
Larry Finger94a79942011-08-23 19:00:42 -050061 DeActivateBAEntry(ieee, pBa);
62 bSendDELBA = true;
63 }
64
65 return bSendDELBA;
66}
67
Larry Finger831cb9d2011-08-25 11:48:17 -050068void ResetBaEntry(struct ba_record *pBA)
Larry Finger94a79942011-08-23 19:00:42 -050069{
70 pBA->bValid = false;
71 pBA->BaParamSet.shortData = 0;
72 pBA->BaTimeoutValue = 0;
73 pBA->DialogToken = 0;
74 pBA->BaStartSeqCtrl.ShortData = 0;
75}
Larry Finger831cb9d2011-08-25 11:48:17 -050076static struct sk_buff *rtllib_ADDBA(struct rtllib_device *ieee, u8 *Dst,
77 struct ba_record *pBA,
78 u16 StatusCode, u8 type)
Larry Finger94a79942011-08-23 19:00:42 -050079{
80 struct sk_buff *skb = NULL;
Larry Finger831cb9d2011-08-25 11:48:17 -050081 struct rtllib_hdr_3addr *BAReq = NULL;
82 u8 *tag = NULL;
Larry Finger94a79942011-08-23 19:00:42 -050083 u16 tmp = 0;
84 u16 len = ieee->tx_headroom + 9;
Larry Fingerce7b3932011-09-01 12:23:18 -050085
Larry Finger831cb9d2011-08-25 11:48:17 -050086 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), frame(%d)"
Larry Fingerac50dda2011-08-25 14:07:03 -050087 " sentd to: %pM, ieee->dev:%p\n", __func__,
88 type, Dst, ieee->dev);
Larry Fingerce7b3932011-09-01 12:23:18 -050089 if (pBA == NULL) {
90 RTLLIB_DEBUG(RTLLIB_DL_ERR, "pBA(%p) is NULL\n");
Larry Finger94a79942011-08-23 19:00:42 -050091 return NULL;
92 }
Larry Finger831cb9d2011-08-25 11:48:17 -050093 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
94 if (skb == NULL) {
Larry Finger94a79942011-08-23 19:00:42 -050095 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
96 return NULL;
97 }
98
Larry Finger831cb9d2011-08-25 11:48:17 -050099 memset(skb->data, 0, sizeof(struct rtllib_hdr_3addr));
Larry Finger94a79942011-08-23 19:00:42 -0500100
Larry Finger94a79942011-08-23 19:00:42 -0500101 skb_reserve(skb, ieee->tx_headroom);
102
Larry Finger831cb9d2011-08-25 11:48:17 -0500103 BAReq = (struct rtllib_hdr_3addr *)skb_put(skb,
104 sizeof(struct rtllib_hdr_3addr));
Larry Finger94a79942011-08-23 19:00:42 -0500105
106 memcpy(BAReq->addr1, Dst, ETH_ALEN);
107 memcpy(BAReq->addr2, ieee->dev->dev_addr, ETH_ALEN);
108
109 memcpy(BAReq->addr3, ieee->current_network.bssid, ETH_ALEN);
110 BAReq->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
111
Larry Finger831cb9d2011-08-25 11:48:17 -0500112 tag = (u8 *)skb_put(skb, 9);
Larry Finger94a79942011-08-23 19:00:42 -0500113 *tag ++= ACT_CAT_BA;
114 *tag ++= type;
115 *tag ++= pBA->DialogToken;
116
Larry Finger831cb9d2011-08-25 11:48:17 -0500117 if (ACT_ADDBARSP == type) {
Larry Finger94a79942011-08-23 19:00:42 -0500118 RT_TRACE(COMP_DBG, "====>to send ADDBARSP\n");
119 tmp = cpu_to_le16(StatusCode);
Larry Finger831cb9d2011-08-25 11:48:17 -0500120 memcpy(tag, (u8 *)&tmp, 2);
Larry Finger94a79942011-08-23 19:00:42 -0500121 tag += 2;
122 }
123 tmp = cpu_to_le16(pBA->BaParamSet.shortData);
Larry Finger831cb9d2011-08-25 11:48:17 -0500124 memcpy(tag, (u8 *)&tmp, 2);
Larry Finger94a79942011-08-23 19:00:42 -0500125 tag += 2;
126 tmp = cpu_to_le16(pBA->BaTimeoutValue);
Larry Finger831cb9d2011-08-25 11:48:17 -0500127 memcpy(tag, (u8 *)&tmp, 2);
Larry Finger94a79942011-08-23 19:00:42 -0500128 tag += 2;
129
Larry Finger831cb9d2011-08-25 11:48:17 -0500130 if (ACT_ADDBAREQ == type) {
131 memcpy(tag, (u8 *)&(pBA->BaStartSeqCtrl), 2);
Larry Finger94a79942011-08-23 19:00:42 -0500132 tag += 2;
133 }
134
135 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
136 return skb;
137}
138
Larry Finger831cb9d2011-08-25 11:48:17 -0500139static struct sk_buff *rtllib_DELBA(struct rtllib_device *ieee, u8 *dst,
140 struct ba_record *pBA,
141 enum tr_select TxRxSelect, u16 ReasonCode)
Larry Finger94a79942011-08-23 19:00:42 -0500142{
Larry Fingerf198db02011-07-19 10:17:01 -0500143 union delba_param_set DelbaParamSet;
Larry Finger94a79942011-08-23 19:00:42 -0500144 struct sk_buff *skb = NULL;
Larry Finger831cb9d2011-08-25 11:48:17 -0500145 struct rtllib_hdr_3addr *Delba = NULL;
146 u8 *tag = NULL;
Larry Finger94a79942011-08-23 19:00:42 -0500147 u16 tmp = 0;
148 u16 len = 6 + ieee->tx_headroom;
149
150 if (net_ratelimit())
Larry Finger831cb9d2011-08-25 11:48:17 -0500151 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA,
152 "========>%s(), Reason"
Larry Fingerac50dda2011-08-25 14:07:03 -0500153 "Code(%d) sentd to: %pM\n", __func__,
154 ReasonCode, dst);
Larry Finger94a79942011-08-23 19:00:42 -0500155
156 memset(&DelbaParamSet, 0, 2);
157
Larry Finger831cb9d2011-08-25 11:48:17 -0500158 DelbaParamSet.field.Initiator = (TxRxSelect == TX_DIR) ? 1 : 0;
Larry Finger94a79942011-08-23 19:00:42 -0500159 DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
160
Larry Finger831cb9d2011-08-25 11:48:17 -0500161 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
162 if (skb == NULL) {
Larry Finger94a79942011-08-23 19:00:42 -0500163 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
164 return NULL;
165 }
166
Larry Finger94a79942011-08-23 19:00:42 -0500167 skb_reserve(skb, ieee->tx_headroom);
168
Larry Finger831cb9d2011-08-25 11:48:17 -0500169 Delba = (struct rtllib_hdr_3addr *) skb_put(skb,
170 sizeof(struct rtllib_hdr_3addr));
Larry Finger94a79942011-08-23 19:00:42 -0500171
172 memcpy(Delba->addr1, dst, ETH_ALEN);
173 memcpy(Delba->addr2, ieee->dev->dev_addr, ETH_ALEN);
174 memcpy(Delba->addr3, ieee->current_network.bssid, ETH_ALEN);
175 Delba->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
176
Larry Finger831cb9d2011-08-25 11:48:17 -0500177 tag = (u8 *)skb_put(skb, 6);
Larry Finger94a79942011-08-23 19:00:42 -0500178
179 *tag ++= ACT_CAT_BA;
180 *tag ++= ACT_DELBA;
181
182 tmp = cpu_to_le16(DelbaParamSet.shortData);
Larry Finger831cb9d2011-08-25 11:48:17 -0500183 memcpy(tag, (u8 *)&tmp, 2);
Larry Finger94a79942011-08-23 19:00:42 -0500184 tag += 2;
185 tmp = cpu_to_le16(ReasonCode);
Larry Finger831cb9d2011-08-25 11:48:17 -0500186 memcpy(tag, (u8 *)&tmp, 2);
Larry Finger94a79942011-08-23 19:00:42 -0500187 tag += 2;
188
189 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
190 if (net_ratelimit())
Larry Finger831cb9d2011-08-25 11:48:17 -0500191 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "<=====%s()\n",
192 __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500193 return skb;
194}
195
Larry Fingerec0dc6be2011-08-25 14:07:04 -0500196static void rtllib_send_ADDBAReq(struct rtllib_device *ieee, u8 *dst,
197 struct ba_record *pBA)
Larry Finger94a79942011-08-23 19:00:42 -0500198{
199 struct sk_buff *skb = NULL;
200 skb = rtllib_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ);
201
202 if (skb) {
203 RT_TRACE(COMP_DBG, "====>to send ADDBAREQ!!!!!\n");
204 softmac_mgmt_xmit(skb, ieee);
205 } else {
Larry Finger831cb9d2011-08-25 11:48:17 -0500206 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
207 " %s()\n", __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500208 }
209 return;
210}
211
Larry Fingerec0dc6be2011-08-25 14:07:04 -0500212static void rtllib_send_ADDBARsp(struct rtllib_device *ieee, u8 *dst,
213 struct ba_record *pBA, u16 StatusCode)
Larry Finger94a79942011-08-23 19:00:42 -0500214{
215 struct sk_buff *skb = NULL;
216 skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP);
217 if (skb)
218 softmac_mgmt_xmit(skb, ieee);
219 else
Larry Finger831cb9d2011-08-25 11:48:17 -0500220 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
221 " %s()\n", __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500222 return;
Larry Finger94a79942011-08-23 19:00:42 -0500223}
224
Larry Fingerec0dc6be2011-08-25 14:07:04 -0500225static void rtllib_send_DELBA(struct rtllib_device *ieee, u8 *dst,
226 struct ba_record *pBA, enum tr_select TxRxSelect,
227 u16 ReasonCode)
Larry Finger94a79942011-08-23 19:00:42 -0500228{
229 struct sk_buff *skb = NULL;
230 skb = rtllib_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode);
231 if (skb)
Larry Finger94a79942011-08-23 19:00:42 -0500232 softmac_mgmt_xmit(skb, ieee);
Larry Finger94a79942011-08-23 19:00:42 -0500233 else
Larry Finger831cb9d2011-08-25 11:48:17 -0500234 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in func"
235 "tion %s()\n", __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500236 return ;
237}
238
Larry Finger831cb9d2011-08-25 11:48:17 -0500239int rtllib_rx_ADDBAReq(struct rtllib_device *ieee, struct sk_buff *skb)
Larry Finger94a79942011-08-23 19:00:42 -0500240{
Larry Finger831cb9d2011-08-25 11:48:17 -0500241 struct rtllib_hdr_3addr *req = NULL;
Larry Finger94a79942011-08-23 19:00:42 -0500242 u16 rc = 0;
Larry Finger831cb9d2011-08-25 11:48:17 -0500243 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
Larry Finger8cf33312011-07-18 21:03:22 -0500244 struct ba_record *pBA = NULL;
Larry Finger6857f362011-07-19 10:14:55 -0500245 union ba_param_set *pBaParamSet = NULL;
Larry Finger831cb9d2011-08-25 11:48:17 -0500246 u16 *pBaTimeoutVal = NULL;
Larry Finger7baf9542011-07-19 10:11:23 -0500247 union sequence_control *pBaStartSeqCtrl = NULL;
Larry Finger2c47ae22011-07-18 20:11:56 -0500248 struct rx_ts_record *pTS = NULL;
Larry Finger94a79942011-08-23 19:00:42 -0500249
Larry Finger831cb9d2011-08-25 11:48:17 -0500250 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 9) {
251 RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BAREQ(%d / "
252 "%d)\n", (int)skb->len,
253 (int)(sizeof(struct rtllib_hdr_3addr) + 9));
Larry Finger94a79942011-08-23 19:00:42 -0500254 return -1;
255 }
256
257 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
258
Larry Finger831cb9d2011-08-25 11:48:17 -0500259 req = (struct rtllib_hdr_3addr *) skb->data;
260 tag = (u8 *)req;
261 dst = (u8 *)(&req->addr2[0]);
262 tag += sizeof(struct rtllib_hdr_3addr);
Larry Finger94a79942011-08-23 19:00:42 -0500263 pDialogToken = tag + 2;
Larry Finger6857f362011-07-19 10:14:55 -0500264 pBaParamSet = (union ba_param_set *)(tag + 3);
Larry Finger831cb9d2011-08-25 11:48:17 -0500265 pBaTimeoutVal = (u16 *)(tag + 5);
Larry Finger7baf9542011-07-19 10:11:23 -0500266 pBaStartSeqCtrl = (union sequence_control *)(req + 7);
Larry Finger94a79942011-08-23 19:00:42 -0500267
Larry Fingerac50dda2011-08-25 14:07:03 -0500268 RT_TRACE(COMP_DBG, "====>rx ADDBAREQ from : %pM\n", dst);
Larry Finger94a79942011-08-23 19:00:42 -0500269 if (ieee->current_network.qos_data.active == 0 ||
270 (ieee->pHTInfo->bCurrentHTSupport == false) ||
271 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_REJECT_ADDBA_REQ)) {
272 rc = ADDBA_STATUS_REFUSED;
Larry Finger831cb9d2011-08-25 11:48:17 -0500273 RTLLIB_DEBUG(RTLLIB_DL_ERR, "Failed to reply on ADDBA_REQ as "
274 "some capability is not ready(%d, %d)\n",
275 ieee->current_network.qos_data.active,
276 ieee->pHTInfo->bCurrentHTSupport);
Larry Finger94a79942011-08-23 19:00:42 -0500277 goto OnADDBAReq_Fail;
278 }
Larry Finger831cb9d2011-08-25 11:48:17 -0500279 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
280 (u8)(pBaParamSet->field.TID), RX_DIR, true)) {
Larry Finger94a79942011-08-23 19:00:42 -0500281 rc = ADDBA_STATUS_REFUSED;
282 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __func__);
283 goto OnADDBAReq_Fail;
284 }
285 pBA = &pTS->RxAdmittedBARecord;
286
Larry Finger831cb9d2011-08-25 11:48:17 -0500287 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
Larry Finger94a79942011-08-23 19:00:42 -0500288 rc = ADDBA_STATUS_INVALID_PARAM;
Larry Finger831cb9d2011-08-25 11:48:17 -0500289 RTLLIB_DEBUG(RTLLIB_DL_ERR, "BA Policy is not correct in "
290 "%s()\n", __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500291 goto OnADDBAReq_Fail;
292 }
293
Larry Finger94a79942011-08-23 19:00:42 -0500294 rtllib_FlushRxTsPendingPkts(ieee, pTS);
295
296 DeActivateBAEntry(ieee, pBA);
297 pBA->DialogToken = *pDialogToken;
298 pBA->BaParamSet = *pBaParamSet;
299 pBA->BaTimeoutValue = *pBaTimeoutVal;
300 pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
301
Larry Finger831cb9d2011-08-25 11:48:17 -0500302 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev) ||
303 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
304 pBA->BaParamSet.field.BufferSize = 1;
Larry Finger94a79942011-08-23 19:00:42 -0500305 else
Larry Finger831cb9d2011-08-25 11:48:17 -0500306 pBA->BaParamSet.field.BufferSize = 32;
Larry Finger94a79942011-08-23 19:00:42 -0500307
308 ActivateBAEntry(ieee, pBA, 0);
309 rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
310
311 return 0;
312
313OnADDBAReq_Fail:
314 {
Larry Finger8cf33312011-07-18 21:03:22 -0500315 struct ba_record BA;
Larry Finger94a79942011-08-23 19:00:42 -0500316 BA.BaParamSet = *pBaParamSet;
317 BA.BaTimeoutValue = *pBaTimeoutVal;
318 BA.DialogToken = *pDialogToken;
319 BA.BaParamSet.field.BAPolicy = BA_POLICY_IMMEDIATE;
320 rtllib_send_ADDBARsp(ieee, dst, &BA, rc);
321 return 0;
322 }
Larry Finger94a79942011-08-23 19:00:42 -0500323}
324
Larry Finger831cb9d2011-08-25 11:48:17 -0500325int rtllib_rx_ADDBARsp(struct rtllib_device *ieee, struct sk_buff *skb)
Larry Finger94a79942011-08-23 19:00:42 -0500326{
Larry Finger831cb9d2011-08-25 11:48:17 -0500327 struct rtllib_hdr_3addr *rsp = NULL;
Larry Finger8cf33312011-07-18 21:03:22 -0500328 struct ba_record *pPendingBA, *pAdmittedBA;
Larry Finger60554f22011-07-18 20:10:03 -0500329 struct tx_ts_record *pTS = NULL;
Larry Finger831cb9d2011-08-25 11:48:17 -0500330 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
331 u16 *pStatusCode = NULL, *pBaTimeoutVal = NULL;
Larry Finger6857f362011-07-19 10:14:55 -0500332 union ba_param_set *pBaParamSet = NULL;
Larry Finger94a79942011-08-23 19:00:42 -0500333 u16 ReasonCode;
334
Larry Finger831cb9d2011-08-25 11:48:17 -0500335 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 9) {
336 RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BARSP(%d / "
337 "%d)\n", (int)skb->len,
338 (int)(sizeof(struct rtllib_hdr_3addr) + 9));
Larry Finger94a79942011-08-23 19:00:42 -0500339 return -1;
340 }
Larry Finger831cb9d2011-08-25 11:48:17 -0500341 rsp = (struct rtllib_hdr_3addr *)skb->data;
342 tag = (u8 *)rsp;
343 dst = (u8 *)(&rsp->addr2[0]);
344 tag += sizeof(struct rtllib_hdr_3addr);
Larry Finger94a79942011-08-23 19:00:42 -0500345 pDialogToken = tag + 2;
Larry Finger831cb9d2011-08-25 11:48:17 -0500346 pStatusCode = (u16 *)(tag + 3);
Larry Finger6857f362011-07-19 10:14:55 -0500347 pBaParamSet = (union ba_param_set *)(tag + 5);
Larry Finger831cb9d2011-08-25 11:48:17 -0500348 pBaTimeoutVal = (u16 *)(tag + 7);
Larry Finger94a79942011-08-23 19:00:42 -0500349
Larry Fingerac50dda2011-08-25 14:07:03 -0500350 RT_TRACE(COMP_DBG, "====>rx ADDBARSP from : %pM\n", dst);
Larry Finger831cb9d2011-08-25 11:48:17 -0500351 if (ieee->current_network.qos_data.active == 0 ||
352 ieee->pHTInfo->bCurrentHTSupport == false ||
353 ieee->pHTInfo->bCurrentAMPDUEnable == false) {
354 RTLLIB_DEBUG(RTLLIB_DL_ERR, "reject to ADDBA_RSP as some capab"
355 "ility is not ready(%d, %d, %d)\n",
356 ieee->current_network.qos_data.active,
357 ieee->pHTInfo->bCurrentHTSupport,
358 ieee->pHTInfo->bCurrentAMPDUEnable);
Larry Finger94a79942011-08-23 19:00:42 -0500359 ReasonCode = DELBA_REASON_UNKNOWN_BA;
360 goto OnADDBARsp_Reject;
361 }
362
363
Larry Finger74724de2011-07-18 20:19:19 -0500364 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
Larry Finger94a79942011-08-23 19:00:42 -0500365 (u8)(pBaParamSet->field.TID), TX_DIR, false)) {
366 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __func__);
367 ReasonCode = DELBA_REASON_UNKNOWN_BA;
368 goto OnADDBARsp_Reject;
369 }
370
371 pTS->bAddBaReqInProgress = false;
372 pPendingBA = &pTS->TxPendingBARecord;
373 pAdmittedBA = &pTS->TxAdmittedBARecord;
374
375
Larry Finger831cb9d2011-08-25 11:48:17 -0500376 if ((pAdmittedBA->bValid == true)) {
377 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp."
378 " Drop because already admit it!\n");
Larry Finger94a79942011-08-23 19:00:42 -0500379 return -1;
Larry Finger831cb9d2011-08-25 11:48:17 -0500380 } else if ((pPendingBA->bValid == false) ||
381 (*pDialogToken != pPendingBA->DialogToken)) {
382 RTLLIB_DEBUG(RTLLIB_DL_ERR, "OnADDBARsp(): Recv ADDBA Rsp. "
383 "BA invalid, DELBA!\n");
Larry Finger94a79942011-08-23 19:00:42 -0500384 ReasonCode = DELBA_REASON_UNKNOWN_BA;
385 goto OnADDBARsp_Reject;
Larry Finger831cb9d2011-08-25 11:48:17 -0500386 } else {
387 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA "
388 "is admitted! Status code:%X\n", *pStatusCode);
Larry Finger94a79942011-08-23 19:00:42 -0500389 DeActivateBAEntry(ieee, pPendingBA);
390 }
391
392
Larry Finger831cb9d2011-08-25 11:48:17 -0500393 if (*pStatusCode == ADDBA_STATUS_SUCCESS) {
394 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
Larry Finger94a79942011-08-23 19:00:42 -0500395 pTS->bAddBaReqDelayed = true;
396 DeActivateBAEntry(ieee, pAdmittedBA);
397 ReasonCode = DELBA_REASON_END_BA;
398 goto OnADDBARsp_Reject;
399 }
400
401
402 pAdmittedBA->DialogToken = *pDialogToken;
403 pAdmittedBA->BaTimeoutValue = *pBaTimeoutVal;
404 pAdmittedBA->BaStartSeqCtrl = pPendingBA->BaStartSeqCtrl;
405 pAdmittedBA->BaParamSet = *pBaParamSet;
406 DeActivateBAEntry(ieee, pAdmittedBA);
407 ActivateBAEntry(ieee, pAdmittedBA, *pBaTimeoutVal);
408 } else {
409 pTS->bAddBaReqDelayed = true;
410 pTS->bDisable_AddBa = true;
411 ReasonCode = DELBA_REASON_END_BA;
412 goto OnADDBARsp_Reject;
413 }
414
415 return 0;
416
417OnADDBARsp_Reject:
418 {
Larry Finger8cf33312011-07-18 21:03:22 -0500419 struct ba_record BA;
Larry Finger94a79942011-08-23 19:00:42 -0500420 BA.BaParamSet = *pBaParamSet;
421 rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
422 return 0;
423 }
Larry Finger94a79942011-08-23 19:00:42 -0500424}
425
Larry Finger831cb9d2011-08-25 11:48:17 -0500426int rtllib_rx_DELBA(struct rtllib_device *ieee, struct sk_buff *skb)
Larry Finger94a79942011-08-23 19:00:42 -0500427{
Larry Finger831cb9d2011-08-25 11:48:17 -0500428 struct rtllib_hdr_3addr *delba = NULL;
Larry Fingerf198db02011-07-19 10:17:01 -0500429 union delba_param_set *pDelBaParamSet = NULL;
Larry Finger831cb9d2011-08-25 11:48:17 -0500430 u16 *pReasonCode = NULL;
431 u8 *dst = NULL;
Larry Finger94a79942011-08-23 19:00:42 -0500432
Larry Finger831cb9d2011-08-25 11:48:17 -0500433 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 6) {
434 RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in DELBA(%d /"
435 " %d)\n", (int)skb->len,
436 (int)(sizeof(struct rtllib_hdr_3addr) + 6));
Larry Finger94a79942011-08-23 19:00:42 -0500437 return -1;
438 }
439
Larry Finger831cb9d2011-08-25 11:48:17 -0500440 if (ieee->current_network.qos_data.active == 0 ||
441 ieee->pHTInfo->bCurrentHTSupport == false) {
442 RTLLIB_DEBUG(RTLLIB_DL_ERR, "received DELBA while QOS or HT "
443 "is not supported(%d, %d)\n",
444 ieee->current_network. qos_data.active,
445 ieee->pHTInfo->bCurrentHTSupport);
Larry Finger94a79942011-08-23 19:00:42 -0500446 return -1;
447 }
448
449 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
Larry Finger831cb9d2011-08-25 11:48:17 -0500450 delba = (struct rtllib_hdr_3addr *)skb->data;
451 dst = (u8 *)(&delba->addr2[0]);
452 delba += sizeof(struct rtllib_hdr_3addr);
Larry Fingerf198db02011-07-19 10:17:01 -0500453 pDelBaParamSet = (union delba_param_set *)(delba+2);
Larry Finger831cb9d2011-08-25 11:48:17 -0500454 pReasonCode = (u16 *)(delba+4);
Larry Finger94a79942011-08-23 19:00:42 -0500455
Larry Finger831cb9d2011-08-25 11:48:17 -0500456 if (pDelBaParamSet->field.Initiator == 1) {
Larry Finger2c47ae22011-07-18 20:11:56 -0500457 struct rx_ts_record *pRxTs;
Larry Finger94a79942011-08-23 19:00:42 -0500458
Larry Finger831cb9d2011-08-25 11:48:17 -0500459 if (!GetTs(ieee, (struct ts_common_info **)&pRxTs, dst,
460 (u8)pDelBaParamSet->field.TID, RX_DIR, false)) {
461 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for RXTS in "
Larry Fingerac50dda2011-08-25 14:07:03 -0500462 "%s().dst: %pM TID:%d\n", __func__, dst,
Larry Finger831cb9d2011-08-25 11:48:17 -0500463 (u8)pDelBaParamSet->field.TID);
Larry Finger94a79942011-08-23 19:00:42 -0500464 return -1;
465 }
466
467 RxTsDeleteBA(ieee, pRxTs);
Larry Finger831cb9d2011-08-25 11:48:17 -0500468 } else {
Larry Finger60554f22011-07-18 20:10:03 -0500469 struct tx_ts_record *pTxTs;
Larry Finger94a79942011-08-23 19:00:42 -0500470
Larry Finger831cb9d2011-08-25 11:48:17 -0500471 if (!GetTs(ieee, (struct ts_common_info **)&pTxTs, dst,
472 (u8)pDelBaParamSet->field.TID, TX_DIR, false)) {
473 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for TXTS in "
474 "%s()\n", __func__);
Larry Finger94a79942011-08-23 19:00:42 -0500475 return -1;
476 }
477
478 pTxTs->bUsingBa = false;
479 pTxTs->bAddBaReqInProgress = false;
480 pTxTs->bAddBaReqDelayed = false;
481 del_timer_sync(&pTxTs->TsAddBaTimer);
482 TxTsDeleteBA(ieee, pTxTs);
483 }
484 return 0;
485}
486
Larry Finger831cb9d2011-08-25 11:48:17 -0500487void TsInitAddBA(struct rtllib_device *ieee, struct tx_ts_record *pTS,
488 u8 Policy, u8 bOverwritePending)
Larry Finger94a79942011-08-23 19:00:42 -0500489{
Larry Finger8cf33312011-07-18 21:03:22 -0500490 struct ba_record *pBA = &pTS->TxPendingBARecord;
Larry Finger94a79942011-08-23 19:00:42 -0500491
Larry Finger831cb9d2011-08-25 11:48:17 -0500492 if (pBA->bValid == true && bOverwritePending == false)
Larry Finger94a79942011-08-23 19:00:42 -0500493 return;
494
495 DeActivateBAEntry(ieee, pBA);
496
497 pBA->DialogToken++;
498 pBA->BaParamSet.field.AMSDU_Support = 0;
499 pBA->BaParamSet.field.BAPolicy = Policy;
Larry Finger831cb9d2011-08-25 11:48:17 -0500500 pBA->BaParamSet.field.TID =
501 pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID;
Larry Finger94a79942011-08-23 19:00:42 -0500502 pBA->BaParamSet.field.BufferSize = 32;
503 pBA->BaTimeoutValue = 0;
504 pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096;
505
506 ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
507
508 rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
509}
510
Larry Finger831cb9d2011-08-25 11:48:17 -0500511void TsInitDelBA(struct rtllib_device *ieee,
512 struct ts_common_info *pTsCommonInfo,
513 enum tr_select TxRxSelect)
Larry Finger94a79942011-08-23 19:00:42 -0500514{
Larry Finger831cb9d2011-08-25 11:48:17 -0500515 if (TxRxSelect == TX_DIR) {
516 struct tx_ts_record *pTxTs =
517 (struct tx_ts_record *)pTsCommonInfo;
Larry Finger94a79942011-08-23 19:00:42 -0500518
519 if (TxTsDeleteBA(ieee, pTxTs))
Larry Finger831cb9d2011-08-25 11:48:17 -0500520 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
521 (pTxTs->TxAdmittedBARecord.bValid) ?
522 (&pTxTs->TxAdmittedBARecord) :
523 (&pTxTs->TxPendingBARecord),
524 TxRxSelect, DELBA_REASON_END_BA);
525 } else if (TxRxSelect == RX_DIR) {
526 struct rx_ts_record *pRxTs =
527 (struct rx_ts_record *)pTsCommonInfo;
Larry Finger94a79942011-08-23 19:00:42 -0500528 if (RxTsDeleteBA(ieee, pRxTs))
Larry Finger831cb9d2011-08-25 11:48:17 -0500529 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
530 &pRxTs->RxAdmittedBARecord,
531 TxRxSelect, DELBA_REASON_END_BA);
Larry Finger94a79942011-08-23 19:00:42 -0500532 }
533}
Larry Finger831cb9d2011-08-25 11:48:17 -0500534
Larry Finger94a79942011-08-23 19:00:42 -0500535void BaSetupTimeOut(unsigned long data)
536{
Larry Finger60554f22011-07-18 20:10:03 -0500537 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
Larry Finger94a79942011-08-23 19:00:42 -0500538
539 pTxTs->bAddBaReqInProgress = false;
540 pTxTs->bAddBaReqDelayed = true;
541 pTxTs->TxPendingBARecord.bValid = false;
542}
543
544void TxBaInactTimeout(unsigned long data)
545{
Larry Finger60554f22011-07-18 20:10:03 -0500546 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
Larry Finger831cb9d2011-08-25 11:48:17 -0500547 struct rtllib_device *ieee = container_of(pTxTs, struct rtllib_device,
548 TxTsRecord[pTxTs->num]);
Larry Finger94a79942011-08-23 19:00:42 -0500549 TxTsDeleteBA(ieee, pTxTs);
Larry Finger831cb9d2011-08-25 11:48:17 -0500550 rtllib_send_DELBA(ieee, pTxTs->TsCommonInfo.Addr,
551 &pTxTs->TxAdmittedBARecord, TX_DIR,
552 DELBA_REASON_TIMEOUT);
Larry Finger94a79942011-08-23 19:00:42 -0500553}
554
555void RxBaInactTimeout(unsigned long data)
556{
Larry Finger2c47ae22011-07-18 20:11:56 -0500557 struct rx_ts_record *pRxTs = (struct rx_ts_record *)data;
Larry Finger831cb9d2011-08-25 11:48:17 -0500558 struct rtllib_device *ieee = container_of(pRxTs, struct rtllib_device,
559 RxTsRecord[pRxTs->num]);
Larry Finger94a79942011-08-23 19:00:42 -0500560
561 RxTsDeleteBA(ieee, pRxTs);
Larry Finger831cb9d2011-08-25 11:48:17 -0500562 rtllib_send_DELBA(ieee, pRxTs->TsCommonInfo.Addr,
563 &pRxTs->RxAdmittedBARecord, RX_DIR,
564 DELBA_REASON_TIMEOUT);
Larry Finger94a79942011-08-23 19:00:42 -0500565 return ;
566}