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 ******************************************************************************/
19 #include <asm/byteorder.h>
20 #include <asm/unaligned.h>
21 #include <linux/etherdevice.h>
23 #include "rtl819x_BA.h"
25 static void ActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA,
30 mod_timer(&pBA->Timer, jiffies + msecs_to_jiffies(Time));
33 static void DeActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA)
36 del_timer_sync(&pBA->Timer);
39 static u8 TxTsDeleteBA(struct rtllib_device *ieee, struct tx_ts_record *pTxTs)
41 struct ba_record *pAdmittedBa = &pTxTs->TxAdmittedBARecord;
42 struct ba_record *pPendingBa = &pTxTs->TxPendingBARecord;
43 u8 bSendDELBA = false;
45 if (pPendingBa->bValid) {
46 DeActivateBAEntry(ieee, pPendingBa);
50 if (pAdmittedBa->bValid) {
51 DeActivateBAEntry(ieee, pAdmittedBa);
57 static u8 RxTsDeleteBA(struct rtllib_device *ieee, struct rx_ts_record *pRxTs)
59 struct ba_record *pBa = &pRxTs->RxAdmittedBARecord;
60 u8 bSendDELBA = false;
63 DeActivateBAEntry(ieee, pBa);
70 void ResetBaEntry(struct ba_record *pBA)
73 pBA->BaParamSet.shortData = 0;
74 pBA->BaTimeoutValue = 0;
76 pBA->BaStartSeqCtrl.ShortData = 0;
78 static struct sk_buff *rtllib_ADDBA(struct rtllib_device *ieee, u8 *Dst,
79 struct ba_record *pBA,
80 u16 StatusCode, u8 type)
82 struct sk_buff *skb = NULL;
83 struct rtllib_hdr_3addr *BAReq = NULL;
85 u16 len = ieee->tx_headroom + 9;
87 netdev_dbg(ieee->dev, "%s(): frame(%d) sentd to: %pM, ieee->dev:%p\n",
88 __func__, type, Dst, ieee->dev);
91 netdev_warn(ieee->dev, "pBA is NULL\n");
94 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
96 netdev_err(ieee->dev, "Can't alloc skb for ADDBA_REQ\n");
100 memset(skb->data, 0, sizeof(struct rtllib_hdr_3addr));
102 skb_reserve(skb, ieee->tx_headroom);
104 BAReq = (struct rtllib_hdr_3addr *)skb_put(skb,
105 sizeof(struct rtllib_hdr_3addr));
107 ether_addr_copy(BAReq->addr1, Dst);
108 ether_addr_copy(BAReq->addr2, ieee->dev->dev_addr);
110 ether_addr_copy(BAReq->addr3, ieee->current_network.bssid);
111 BAReq->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
113 tag = (u8 *)skb_put(skb, 9);
116 *tag++ = pBA->DialogToken;
118 if (ACT_ADDBARSP == type) {
119 RT_TRACE(COMP_DBG, "====>to send ADDBARSP\n");
121 put_unaligned_le16(StatusCode, tag);
125 put_unaligned_le16(pBA->BaParamSet.shortData, tag);
128 put_unaligned_le16(pBA->BaTimeoutValue, tag);
131 if (ACT_ADDBAREQ == type) {
132 memcpy(tag, (u8 *)&(pBA->BaStartSeqCtrl), 2);
137 print_hex_dump_bytes("rtllib_ADDBA(): ", DUMP_PREFIX_NONE, skb->data,
143 static struct sk_buff *rtllib_DELBA(struct rtllib_device *ieee, u8 *dst,
144 struct ba_record *pBA,
145 enum tr_select TxRxSelect, u16 ReasonCode)
147 union delba_param_set DelbaParamSet;
148 struct sk_buff *skb = NULL;
149 struct rtllib_hdr_3addr *Delba = NULL;
151 u16 len = 6 + ieee->tx_headroom;
154 netdev_dbg(ieee->dev, "%s(): ReasonCode(%d) sentd to: %pM\n",
155 __func__, ReasonCode, dst);
157 memset(&DelbaParamSet, 0, 2);
159 DelbaParamSet.field.Initiator = (TxRxSelect == TX_DIR) ? 1 : 0;
160 DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
162 skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
164 netdev_err(ieee->dev, "Can't alloc skb for DELBA_REQ\n");
168 skb_reserve(skb, ieee->tx_headroom);
170 Delba = (struct rtllib_hdr_3addr *) skb_put(skb,
171 sizeof(struct rtllib_hdr_3addr));
173 ether_addr_copy(Delba->addr1, dst);
174 ether_addr_copy(Delba->addr2, ieee->dev->dev_addr);
175 ether_addr_copy(Delba->addr3, ieee->current_network.bssid);
176 Delba->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
178 tag = (u8 *)skb_put(skb, 6);
184 put_unaligned_le16(DelbaParamSet.shortData, tag);
187 put_unaligned_le16(ReasonCode, tag);
191 print_hex_dump_bytes("rtllib_DELBA(): ", DUMP_PREFIX_NONE, skb->data,
197 static void rtllib_send_ADDBAReq(struct rtllib_device *ieee, u8 *dst,
198 struct ba_record *pBA)
200 struct sk_buff *skb = NULL;
202 skb = rtllib_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ);
205 RT_TRACE(COMP_DBG, "====>to send ADDBAREQ!!!!!\n");
206 softmac_mgmt_xmit(skb, ieee);
208 netdev_dbg(ieee->dev, "Failed to generate ADDBAReq packet.\n");
212 static void rtllib_send_ADDBARsp(struct rtllib_device *ieee, u8 *dst,
213 struct ba_record *pBA, u16 StatusCode)
215 struct sk_buff *skb = NULL;
217 skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP);
219 softmac_mgmt_xmit(skb, ieee);
221 netdev_dbg(ieee->dev, "Failed to generate ADDBARsp packet.\n");
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 netdev_dbg(ieee->dev, "Failed to generate DELBA packet.\n");
237 int rtllib_rx_ADDBAReq(struct rtllib_device *ieee, struct sk_buff *skb)
239 struct rtllib_hdr_3addr *req = NULL;
241 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
242 struct ba_record *pBA = NULL;
243 union ba_param_set *pBaParamSet = NULL;
244 u16 *pBaTimeoutVal = NULL;
245 union sequence_control *pBaStartSeqCtrl = NULL;
246 struct rx_ts_record *pTS = NULL;
248 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 9) {
249 netdev_warn(ieee->dev, "Invalid skb len in BAREQ(%d / %d)\n",
251 (int)(sizeof(struct rtllib_hdr_3addr) + 9));
256 print_hex_dump_bytes("rtllib_rx_ADDBAReq(): ", DUMP_PREFIX_NONE,
257 skb->data, skb->len);
260 req = (struct rtllib_hdr_3addr *) skb->data;
262 dst = (u8 *)(&req->addr2[0]);
263 tag += sizeof(struct rtllib_hdr_3addr);
264 pDialogToken = tag + 2;
265 pBaParamSet = (union ba_param_set *)(tag + 3);
266 pBaTimeoutVal = (u16 *)(tag + 5);
267 pBaStartSeqCtrl = (union sequence_control *)(req + 7);
269 RT_TRACE(COMP_DBG, "====>rx ADDBAREQ from : %pM\n", dst);
270 if (ieee->current_network.qos_data.active == 0 ||
271 (ieee->pHTInfo->bCurrentHTSupport == false) ||
272 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_REJECT_ADDBA_REQ)) {
273 rc = ADDBA_STATUS_REFUSED;
274 netdev_warn(ieee->dev,
275 "Failed to reply on ADDBA_REQ as some capability is not ready(%d, %d)\n",
276 ieee->current_network.qos_data.active,
277 ieee->pHTInfo->bCurrentHTSupport);
278 goto OnADDBAReq_Fail;
280 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
281 (u8)(pBaParamSet->field.TID), RX_DIR, true)) {
282 rc = ADDBA_STATUS_REFUSED;
283 netdev_warn(ieee->dev, "%s(): can't get TS\n", __func__);
284 goto OnADDBAReq_Fail;
286 pBA = &pTS->RxAdmittedBARecord;
288 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
289 rc = ADDBA_STATUS_INVALID_PARAM;
290 netdev_warn(ieee->dev, "%s(): BA Policy is not correct\n",
292 goto OnADDBAReq_Fail;
295 rtllib_FlushRxTsPendingPkts(ieee, pTS);
297 DeActivateBAEntry(ieee, pBA);
298 pBA->DialogToken = *pDialogToken;
299 pBA->BaParamSet = *pBaParamSet;
300 pBA->BaTimeoutValue = *pBaTimeoutVal;
301 pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
303 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev) ||
304 (ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
305 pBA->BaParamSet.field.BufferSize = 1;
307 pBA->BaParamSet.field.BufferSize = 32;
309 ActivateBAEntry(ieee, pBA, 0);
310 rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
318 BA.BaParamSet = *pBaParamSet;
319 BA.BaTimeoutValue = *pBaTimeoutVal;
320 BA.DialogToken = *pDialogToken;
321 BA.BaParamSet.field.BAPolicy = BA_POLICY_IMMEDIATE;
322 rtllib_send_ADDBARsp(ieee, dst, &BA, rc);
327 int rtllib_rx_ADDBARsp(struct rtllib_device *ieee, struct sk_buff *skb)
329 struct rtllib_hdr_3addr *rsp = NULL;
330 struct ba_record *pPendingBA, *pAdmittedBA;
331 struct tx_ts_record *pTS = NULL;
332 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL;
333 u16 *pStatusCode = NULL, *pBaTimeoutVal = NULL;
334 union ba_param_set *pBaParamSet = NULL;
337 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 9) {
338 netdev_warn(ieee->dev, "Invalid skb len in BARSP(%d / %d)\n",
340 (int)(sizeof(struct rtllib_hdr_3addr) + 9));
343 rsp = (struct rtllib_hdr_3addr *)skb->data;
345 dst = (u8 *)(&rsp->addr2[0]);
346 tag += sizeof(struct rtllib_hdr_3addr);
347 pDialogToken = tag + 2;
348 pStatusCode = (u16 *)(tag + 3);
349 pBaParamSet = (union ba_param_set *)(tag + 5);
350 pBaTimeoutVal = (u16 *)(tag + 7);
352 RT_TRACE(COMP_DBG, "====>rx ADDBARSP from : %pM\n", dst);
353 if (ieee->current_network.qos_data.active == 0 ||
354 ieee->pHTInfo->bCurrentHTSupport == false ||
355 ieee->pHTInfo->bCurrentAMPDUEnable == false) {
356 netdev_warn(ieee->dev,
357 "reject to ADDBA_RSP as some capability is not ready(%d, %d, %d)\n",
358 ieee->current_network.qos_data.active,
359 ieee->pHTInfo->bCurrentHTSupport,
360 ieee->pHTInfo->bCurrentAMPDUEnable);
361 ReasonCode = DELBA_REASON_UNKNOWN_BA;
362 goto OnADDBARsp_Reject;
366 if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
367 (u8)(pBaParamSet->field.TID), TX_DIR, false)) {
368 netdev_warn(ieee->dev, "%s(): can't get TS\n", __func__);
369 ReasonCode = DELBA_REASON_UNKNOWN_BA;
370 goto OnADDBARsp_Reject;
373 pTS->bAddBaReqInProgress = false;
374 pPendingBA = &pTS->TxPendingBARecord;
375 pAdmittedBA = &pTS->TxAdmittedBARecord;
378 if (pAdmittedBA->bValid == true) {
379 netdev_dbg(ieee->dev, "%s(): ADDBA response already admitted\n",
382 } else if ((pPendingBA->bValid == false) ||
383 (*pDialogToken != pPendingBA->DialogToken)) {
384 netdev_warn(ieee->dev,
385 "%s(): ADDBA Rsp. BA invalid, DELBA!\n",
387 ReasonCode = DELBA_REASON_UNKNOWN_BA;
388 goto OnADDBARsp_Reject;
390 netdev_dbg(ieee->dev,
391 "%s(): Recv ADDBA Rsp. BA is admitted! Status code:%X\n",
392 __func__, *pStatusCode);
393 DeActivateBAEntry(ieee, pPendingBA);
397 if (*pStatusCode == ADDBA_STATUS_SUCCESS) {
398 if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) {
399 pTS->bAddBaReqDelayed = true;
400 DeActivateBAEntry(ieee, pAdmittedBA);
401 ReasonCode = DELBA_REASON_END_BA;
402 goto OnADDBARsp_Reject;
406 pAdmittedBA->DialogToken = *pDialogToken;
407 pAdmittedBA->BaTimeoutValue = *pBaTimeoutVal;
408 pAdmittedBA->BaStartSeqCtrl = pPendingBA->BaStartSeqCtrl;
409 pAdmittedBA->BaParamSet = *pBaParamSet;
410 DeActivateBAEntry(ieee, pAdmittedBA);
411 ActivateBAEntry(ieee, pAdmittedBA, *pBaTimeoutVal);
413 pTS->bAddBaReqDelayed = true;
414 pTS->bDisable_AddBa = true;
415 ReasonCode = DELBA_REASON_END_BA;
416 goto OnADDBARsp_Reject;
425 BA.BaParamSet = *pBaParamSet;
426 rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
431 int rtllib_rx_DELBA(struct rtllib_device *ieee, struct sk_buff *skb)
433 struct rtllib_hdr_3addr *delba = NULL;
434 union delba_param_set *pDelBaParamSet = NULL;
435 u16 *pReasonCode = NULL;
438 if (skb->len < sizeof(struct rtllib_hdr_3addr) + 6) {
439 netdev_warn(ieee->dev, "Invalid skb len in DELBA(%d / %d)\n",
441 (int)(sizeof(struct rtllib_hdr_3addr) + 6));
445 if (ieee->current_network.qos_data.active == 0 ||
446 ieee->pHTInfo->bCurrentHTSupport == false) {
447 netdev_warn(ieee->dev,
448 "received DELBA while QOS or HT is not supported(%d, %d)\n",
449 ieee->current_network. qos_data.active,
450 ieee->pHTInfo->bCurrentHTSupport);
455 print_hex_dump_bytes("rtllib_rx_DELBA(): ", DUMP_PREFIX_NONE, skb->data,
458 delba = (struct rtllib_hdr_3addr *)skb->data;
459 dst = (u8 *)(&delba->addr2[0]);
460 delba += sizeof(struct rtllib_hdr_3addr);
461 pDelBaParamSet = (union delba_param_set *)(delba+2);
462 pReasonCode = (u16 *)(delba+4);
464 if (pDelBaParamSet->field.Initiator == 1) {
465 struct rx_ts_record *pRxTs;
467 if (!GetTs(ieee, (struct ts_common_info **)&pRxTs, dst,
468 (u8)pDelBaParamSet->field.TID, RX_DIR, false)) {
469 netdev_warn(ieee->dev,
470 "%s(): can't get TS for RXTS. dst:%pM TID:%d\n",
472 (u8)pDelBaParamSet->field.TID);
476 RxTsDeleteBA(ieee, pRxTs);
478 struct tx_ts_record *pTxTs;
480 if (!GetTs(ieee, (struct ts_common_info **)&pTxTs, dst,
481 (u8)pDelBaParamSet->field.TID, TX_DIR, false)) {
482 netdev_warn(ieee->dev, "%s(): can't get TS for TXTS\n",
487 pTxTs->bUsingBa = false;
488 pTxTs->bAddBaReqInProgress = false;
489 pTxTs->bAddBaReqDelayed = false;
490 del_timer_sync(&pTxTs->TsAddBaTimer);
491 TxTsDeleteBA(ieee, pTxTs);
496 void TsInitAddBA(struct rtllib_device *ieee, struct tx_ts_record *pTS,
497 u8 Policy, u8 bOverwritePending)
499 struct ba_record *pBA = &pTS->TxPendingBARecord;
501 if (pBA->bValid == true && bOverwritePending == false)
504 DeActivateBAEntry(ieee, pBA);
507 pBA->BaParamSet.field.AMSDU_Support = 0;
508 pBA->BaParamSet.field.BAPolicy = Policy;
509 pBA->BaParamSet.field.TID =
510 pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID;
511 pBA->BaParamSet.field.BufferSize = 32;
512 pBA->BaTimeoutValue = 0;
513 pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096;
515 ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
517 rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
520 void TsInitDelBA(struct rtllib_device *ieee,
521 struct ts_common_info *pTsCommonInfo,
522 enum tr_select TxRxSelect)
524 if (TxRxSelect == TX_DIR) {
525 struct tx_ts_record *pTxTs =
526 (struct tx_ts_record *)pTsCommonInfo;
528 if (TxTsDeleteBA(ieee, pTxTs))
529 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
530 (pTxTs->TxAdmittedBARecord.bValid) ?
531 (&pTxTs->TxAdmittedBARecord) :
532 (&pTxTs->TxPendingBARecord),
533 TxRxSelect, DELBA_REASON_END_BA);
534 } else if (TxRxSelect == RX_DIR) {
535 struct rx_ts_record *pRxTs =
536 (struct rx_ts_record *)pTsCommonInfo;
537 if (RxTsDeleteBA(ieee, pRxTs))
538 rtllib_send_DELBA(ieee, pTsCommonInfo->Addr,
539 &pRxTs->RxAdmittedBARecord,
540 TxRxSelect, DELBA_REASON_END_BA);
544 void BaSetupTimeOut(unsigned long data)
546 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
548 pTxTs->bAddBaReqInProgress = false;
549 pTxTs->bAddBaReqDelayed = true;
550 pTxTs->TxPendingBARecord.bValid = false;
553 void TxBaInactTimeout(unsigned long data)
555 struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
556 struct rtllib_device *ieee = container_of(pTxTs, struct rtllib_device,
557 TxTsRecord[pTxTs->num]);
558 TxTsDeleteBA(ieee, pTxTs);
559 rtllib_send_DELBA(ieee, pTxTs->TsCommonInfo.Addr,
560 &pTxTs->TxAdmittedBARecord, TX_DIR,
561 DELBA_REASON_TIMEOUT);
564 void RxBaInactTimeout(unsigned long data)
566 struct rx_ts_record *pRxTs = (struct rx_ts_record *)data;
567 struct rtllib_device *ieee = container_of(pRxTs, struct rtllib_device,
568 RxTsRecord[pRxTs->num]);
570 RxTsDeleteBA(ieee, pRxTs);
571 rtllib_send_DELBA(ieee, pRxTs->TsCommonInfo.Addr,
572 &pRxTs->RxAdmittedBARecord, RX_DIR,
573 DELBA_REASON_TIMEOUT);