1 /******************************************************************************
2 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
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
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
13 * The full GNU General Public License is included in this distribution in the
14 * file called LICENSE.
16 * Contact Information:
17 * wlanfae <wlanfae@realtek.com>
18 ******************************************************************************/
20 #include "rtl819x_BA.h"
22 static void ActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA,
27 mod_timer(&pBA->Timer, jiffies + MSECS(Time));
30 static void DeActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA)
33 del_timer_sync(&pBA->Timer);
36 static u8 TxTsDeleteBA(struct rtllib_device *ieee, struct tx_ts_record *pTxTs)
38 struct ba_record *pAdmittedBa = &pTxTs->TxAdmittedBARecord;
39 struct ba_record *pPendingBa = &pTxTs->TxPendingBARecord;
40 u8 bSendDELBA = false;
42 if (pPendingBa->bValid) {
43 DeActivateBAEntry(ieee, pPendingBa);
47 if (pAdmittedBa->bValid) {
48 DeActivateBAEntry(ieee, pAdmittedBa);
54 static u8 RxTsDeleteBA(struct rtllib_device *ieee, struct rx_ts_record *pRxTs)
56 struct ba_record *pBa = &pRxTs->RxAdmittedBARecord;
57 u8 bSendDELBA = false;
60 DeActivateBAEntry(ieee, pBa);
67 void ResetBaEntry(struct ba_record *pBA)
70 pBA->BaParamSet.shortData = 0;
71 pBA->BaTimeoutValue = 0;
73 pBA->BaStartSeqCtrl.ShortData = 0;
75 static struct sk_buff *rtllib_ADDBA(struct rtllib_device *ieee, u8 *Dst,
76 struct ba_record *pBA,
77 u16 StatusCode, u8 type)
79 struct sk_buff *skb = NULL;
80 struct rtllib_hdr_3addr *BAReq = NULL;
83 u16 len = ieee->tx_headroom + 9;
85 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), frame(%d)"
86 " sentd to: %pM, ieee->dev:%p\n", __func__,
87 type, Dst, ieee->dev);
89 RTLLIB_DEBUG(RTLLIB_DL_ERR, "pBA is NULL\n");
92 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
94 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
98 memset(skb->data, 0, sizeof(struct rtllib_hdr_3addr));
100 skb_reserve(skb, ieee->tx_headroom);
102 BAReq = (struct rtllib_hdr_3addr *)skb_put(skb,
103 sizeof(struct rtllib_hdr_3addr));
105 memcpy(BAReq->addr1, Dst, ETH_ALEN);
106 memcpy(BAReq->addr2, ieee->dev->dev_addr, ETH_ALEN);
108 memcpy(BAReq->addr3, ieee->current_network.bssid, ETH_ALEN);
109 BAReq->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
111 tag = (u8 *)skb_put(skb, 9);
114 *tag++ = pBA->DialogToken;
116 if (ACT_ADDBARSP == type) {
117 RT_TRACE(COMP_DBG, "====>to send ADDBARSP\n");
119 memcpy(tag, (u8 *)&tmp, 2);
122 tmp = pBA->BaParamSet.shortData;
123 memcpy(tag, (u8 *)&tmp, 2);
125 tmp = pBA->BaTimeoutValue;
126 memcpy(tag, (u8 *)&tmp, 2);
129 if (ACT_ADDBAREQ == type) {
130 memcpy(tag, (u8 *)&(pBA->BaStartSeqCtrl), 2);
134 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
138 static struct sk_buff *rtllib_DELBA(struct rtllib_device *ieee, u8 *dst,
139 struct ba_record *pBA,
140 enum tr_select TxRxSelect, u16 ReasonCode)
142 union delba_param_set DelbaParamSet;
143 struct sk_buff *skb = NULL;
144 struct rtllib_hdr_3addr *Delba = NULL;
147 u16 len = 6 + ieee->tx_headroom;
150 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA,
151 "========>%s(), Reason"
152 "Code(%d) sentd to: %pM\n", __func__,
155 memset(&DelbaParamSet, 0, 2);
157 DelbaParamSet.field.Initiator = (TxRxSelect == TX_DIR) ? 1 : 0;
158 DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
160 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
162 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
166 skb_reserve(skb, ieee->tx_headroom);
168 Delba = (struct rtllib_hdr_3addr *) skb_put(skb,
169 sizeof(struct rtllib_hdr_3addr));
171 memcpy(Delba->addr1, dst, ETH_ALEN);
172 memcpy(Delba->addr2, ieee->dev->dev_addr, ETH_ALEN);
173 memcpy(Delba->addr3, ieee->current_network.bssid, ETH_ALEN);
174 Delba->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
176 tag = (u8 *)skb_put(skb, 6);
181 tmp = DelbaParamSet.shortData;
182 memcpy(tag, (u8 *)&tmp, 2);
185 memcpy(tag, (u8 *)&tmp, 2);
188 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
190 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "<=====%s()\n",
195 static void rtllib_send_ADDBAReq(struct rtllib_device *ieee, u8 *dst,
196 struct ba_record *pBA)
198 struct sk_buff *skb = NULL;
200 skb = rtllib_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ);
203 RT_TRACE(COMP_DBG, "====>to send ADDBAREQ!!!!!\n");
204 softmac_mgmt_xmit(skb, ieee);
206 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
207 " %s()\n", __func__);
211 static void rtllib_send_ADDBARsp(struct rtllib_device *ieee, u8 *dst,
212 struct ba_record *pBA, u16 StatusCode)
214 struct sk_buff *skb = NULL;
216 skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP);
218 softmac_mgmt_xmit(skb, ieee);
220 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
221 " %s()\n", __func__);
224 static void rtllib_send_DELBA(struct rtllib_device *ieee, u8 *dst,
225 struct ba_record *pBA, enum tr_select TxRxSelect,
228 struct sk_buff *skb = NULL;
230 skb = rtllib_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode);
232 softmac_mgmt_xmit(skb, ieee);
234 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
235 " %s()\n", __func__);
238 int rtllib_rx_ADDBAReq(struct rtllib_device *ieee, struct sk_buff *skb)
240 struct rtllib_hdr_3addr *req = NULL;
242 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
243 struct ba_record *pBA = NULL;
244 union ba_param_set *pBaParamSet = NULL;
245 u16 *pBaTimeoutVal = NULL;
246 union sequence_control *pBaStartSeqCtrl = NULL;
247 struct rx_ts_record *pTS = NULL;
249 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 9) {
250 RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BAREQ(%d / "
251 "%d)\n", (int)skb->len,
252 (int)(sizeof(struct rtllib_hdr_3addr) + 9));
256 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
258 req = (struct rtllib_hdr_3addr *) skb->data;
260 dst = (u8 *)(&req->addr2[0]);
261 tag += sizeof(struct rtllib_hdr_3addr);
262 pDialogToken = tag + 2;
263 pBaParamSet = (union ba_param_set *)(tag + 3);
264 pBaTimeoutVal = (u16 *)(tag + 5);
265 pBaStartSeqCtrl = (union sequence_control *)(req + 7);
267 RT_TRACE(COMP_DBG, "====>rx ADDBAREQ from : %pM\n", dst);
268 if (ieee->current_network.qos_data.active == 0 ||
269 (ieee->pHTInfo->bCurrentHTSupport == false) ||
270 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_REJECT_ADDBA_REQ)) {
271 rc = ADDBA_STATUS_REFUSED;
272 RTLLIB_DEBUG(RTLLIB_DL_ERR, "Failed to reply on ADDBA_REQ as "
273 "some capability is not ready(%d, %d)\n",
274 ieee->current_network.qos_data.active,
275 ieee->pHTInfo->bCurrentHTSupport);
276 goto OnADDBAReq_Fail;
278 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
279 (u8)(pBaParamSet->field.TID), RX_DIR, true)) {
280 rc = ADDBA_STATUS_REFUSED;
281 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __func__);
282 goto OnADDBAReq_Fail;
284 pBA = &pTS->RxAdmittedBARecord;
286 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
287 rc = ADDBA_STATUS_INVALID_PARAM;
288 RTLLIB_DEBUG(RTLLIB_DL_ERR, "BA Policy is not correct in "
290 goto OnADDBAReq_Fail;
293 rtllib_FlushRxTsPendingPkts(ieee, pTS);
295 DeActivateBAEntry(ieee, pBA);
296 pBA->DialogToken = *pDialogToken;
297 pBA->BaParamSet = *pBaParamSet;
298 pBA->BaTimeoutValue = *pBaTimeoutVal;
299 pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
301 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev) ||
302 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
303 pBA->BaParamSet.field.BufferSize = 1;
305 pBA->BaParamSet.field.BufferSize = 32;
307 ActivateBAEntry(ieee, pBA, 0);
308 rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
316 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);
325 int rtllib_rx_ADDBARsp(struct rtllib_device *ieee, struct sk_buff *skb)
327 struct rtllib_hdr_3addr *rsp = NULL;
328 struct ba_record *pPendingBA, *pAdmittedBA;
329 struct tx_ts_record *pTS = NULL;
330 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
331 u16 *pStatusCode = NULL, *pBaTimeoutVal = NULL;
332 union ba_param_set *pBaParamSet = NULL;
335 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));
341 rsp = (struct rtllib_hdr_3addr *)skb->data;
343 dst = (u8 *)(&rsp->addr2[0]);
344 tag += sizeof(struct rtllib_hdr_3addr);
345 pDialogToken = tag + 2;
346 pStatusCode = (u16 *)(tag + 3);
347 pBaParamSet = (union ba_param_set *)(tag + 5);
348 pBaTimeoutVal = (u16 *)(tag + 7);
350 RT_TRACE(COMP_DBG, "====>rx ADDBARSP from : %pM\n", dst);
351 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);
359 ReasonCode = DELBA_REASON_UNKNOWN_BA;
360 goto OnADDBARsp_Reject;
364 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
365 (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;
371 pTS->bAddBaReqInProgress = false;
372 pPendingBA = &pTS->TxPendingBARecord;
373 pAdmittedBA = &pTS->TxAdmittedBARecord;
376 if (pAdmittedBA->bValid == true) {
377 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp."
378 " Drop because already admit it!\n");
380 } else if ((pPendingBA->bValid == false) ||
381 (*pDialogToken != pPendingBA->DialogToken)) {
382 RTLLIB_DEBUG(RTLLIB_DL_ERR, "OnADDBARsp(): Recv ADDBA Rsp. "
383 "BA invalid, DELBA!\n");
384 ReasonCode = DELBA_REASON_UNKNOWN_BA;
385 goto OnADDBARsp_Reject;
387 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA "
388 "is admitted! Status code:%X\n", *pStatusCode);
389 DeActivateBAEntry(ieee, pPendingBA);
393 if (*pStatusCode == ADDBA_STATUS_SUCCESS) {
394 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
395 pTS->bAddBaReqDelayed = true;
396 DeActivateBAEntry(ieee, pAdmittedBA);
397 ReasonCode = DELBA_REASON_END_BA;
398 goto OnADDBARsp_Reject;
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);
409 pTS->bAddBaReqDelayed = true;
410 pTS->bDisable_AddBa = true;
411 ReasonCode = DELBA_REASON_END_BA;
412 goto OnADDBARsp_Reject;
421 BA.BaParamSet = *pBaParamSet;
422 rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
427 int rtllib_rx_DELBA(struct rtllib_device *ieee, struct sk_buff *skb)
429 struct rtllib_hdr_3addr *delba = NULL;
430 union delba_param_set *pDelBaParamSet = NULL;
431 u16 *pReasonCode = NULL;
434 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 6) {
435 RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in DELBA(%d /"
436 " %d)\n", (int)skb->len,
437 (int)(sizeof(struct rtllib_hdr_3addr) + 6));
441 if (ieee->current_network.qos_data.active == 0 ||
442 ieee->pHTInfo->bCurrentHTSupport == false) {
443 RTLLIB_DEBUG(RTLLIB_DL_ERR, "received DELBA while QOS or HT "
444 "is not supported(%d, %d)\n",
445 ieee->current_network. qos_data.active,
446 ieee->pHTInfo->bCurrentHTSupport);
450 RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
451 delba = (struct rtllib_hdr_3addr *)skb->data;
452 dst = (u8 *)(&delba->addr2[0]);
453 delba += sizeof(struct rtllib_hdr_3addr);
454 pDelBaParamSet = (union delba_param_set *)(delba+2);
455 pReasonCode = (u16 *)(delba+4);
457 if (pDelBaParamSet->field.Initiator == 1) {
458 struct rx_ts_record *pRxTs;
460 if (!GetTs(ieee, (struct ts_common_info **)&pRxTs, dst,
461 (u8)pDelBaParamSet->field.TID, RX_DIR, false)) {
462 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for RXTS in "
463 "%s().dst: %pM TID:%d\n", __func__, dst,
464 (u8)pDelBaParamSet->field.TID);
468 RxTsDeleteBA(ieee, pRxTs);
470 struct tx_ts_record *pTxTs;
472 if (!GetTs(ieee, (struct ts_common_info **)&pTxTs, dst,
473 (u8)pDelBaParamSet->field.TID, TX_DIR, false)) {
474 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for TXTS in "
479 pTxTs->bUsingBa = false;
480 pTxTs->bAddBaReqInProgress = false;
481 pTxTs->bAddBaReqDelayed = false;
482 del_timer_sync(&pTxTs->TsAddBaTimer);
483 TxTsDeleteBA(ieee, pTxTs);
488 void TsInitAddBA(struct rtllib_device *ieee, struct tx_ts_record *pTS,
489 u8 Policy, u8 bOverwritePending)
491 struct ba_record *pBA = &pTS->TxPendingBARecord;
493 if (pBA->bValid == true && bOverwritePending == false)
496 DeActivateBAEntry(ieee, pBA);
499 pBA->BaParamSet.field.AMSDU_Support = 0;
500 pBA->BaParamSet.field.BAPolicy = Policy;
501 pBA->BaParamSet.field.TID =
502 pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID;
503 pBA->BaParamSet.field.BufferSize = 32;
504 pBA->BaTimeoutValue = 0;
505 pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096;
507 ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
509 rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
512 void TsInitDelBA(struct rtllib_device *ieee,
513 struct ts_common_info *pTsCommonInfo,
514 enum tr_select TxRxSelect)
516 if (TxRxSelect == TX_DIR) {
517 struct tx_ts_record *pTxTs =
518 (struct tx_ts_record *)pTsCommonInfo;
520 if (TxTsDeleteBA(ieee, pTxTs))
521 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
522 (pTxTs->TxAdmittedBARecord.bValid) ?
523 (&pTxTs->TxAdmittedBARecord) :
524 (&pTxTs->TxPendingBARecord),
525 TxRxSelect, DELBA_REASON_END_BA);
526 } else if (TxRxSelect == RX_DIR) {
527 struct rx_ts_record *pRxTs =
528 (struct rx_ts_record *)pTsCommonInfo;
529 if (RxTsDeleteBA(ieee, pRxTs))
530 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
531 &pRxTs->RxAdmittedBARecord,
532 TxRxSelect, DELBA_REASON_END_BA);
536 void BaSetupTimeOut(unsigned long data)
538 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
540 pTxTs->bAddBaReqInProgress = false;
541 pTxTs->bAddBaReqDelayed = true;
542 pTxTs->TxPendingBARecord.bValid = false;
545 void TxBaInactTimeout(unsigned long data)
547 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
548 struct rtllib_device *ieee = container_of(pTxTs, struct rtllib_device,
549 TxTsRecord[pTxTs->num]);
550 TxTsDeleteBA(ieee, pTxTs);
551 rtllib_send_DELBA(ieee, pTxTs->TsCommonInfo.Addr,
552 &pTxTs->TxAdmittedBARecord, TX_DIR,
553 DELBA_REASON_TIMEOUT);
556 void RxBaInactTimeout(unsigned long data)
558 struct rx_ts_record *pRxTs = (struct rx_ts_record *)data;
559 struct rtllib_device *ieee = container_of(pRxTs, struct rtllib_device,
560 RxTsRecord[pRxTs->num]);
562 RxTsDeleteBA(ieee, pRxTs);
563 rtllib_send_DELBA(ieee, pRxTs->TsCommonInfo.Addr,
564 &pRxTs->RxAdmittedBARecord, RX_DIR,
565 DELBA_REASON_TIMEOUT);