drivers/staging/rtl8192e/rtl819x_BAProc.c

   1 /******************************************************************************
   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 <asm/byteorder.h>
  20 #include <asm/unaligned.h>
  21 #include "rtllib.h"
  22 #include "rtl819x_BA.h"
  23
  24 static void ActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA,
  25                             u16 Time)
  26 {
  27         pBA->bValid = true;
  28         if (Time != 0)
  29                 mod_timer(&pBA->Timer, jiffies + MSECS(Time));
  30 }
  31
  32 static void DeActivateBAEntry(struct rtllib_device *ieee, struct ba_record *pBA)
  33 {
  34         pBA->bValid = false;
  35         del_timer_sync(&pBA->Timer);
  36 }
  37
  38 static u8 TxTsDeleteBA(struct rtllib_device *ieee, struct tx_ts_record *pTxTs)
  39 {
  40         struct ba_record *pAdmittedBa = &pTxTs->TxAdmittedBARecord;
  41         struct ba_record *pPendingBa = &pTxTs->TxPendingBARecord;
  42         u8 bSendDELBA = false;
  43
  44         if (pPendingBa->bValid) {
  45                 DeActivateBAEntry(ieee, pPendingBa);
  46                 bSendDELBA = true;
  47         }
  48
  49         if (pAdmittedBa->bValid) {
  50                 DeActivateBAEntry(ieee, pAdmittedBa);
  51                 bSendDELBA = true;
  52         }
  53         return bSendDELBA;
  54 }
  55
  56 static u8 RxTsDeleteBA(struct rtllib_device *ieee, struct rx_ts_record *pRxTs)
  57 {
  58         struct ba_record *pBa = &pRxTs->RxAdmittedBARecord;
  59         u8                      bSendDELBA = false;
  60
  61         if (pBa->bValid) {
  62                 DeActivateBAEntry(ieee, pBa);
  63                 bSendDELBA = true;
  64         }
  65
  66         return bSendDELBA;
  67 }
  68
  69 void ResetBaEntry(struct ba_record *pBA)
  70 {
  71         pBA->bValid                     = false;
  72         pBA->BaParamSet.shortData       = 0;
  73         pBA->BaTimeoutValue             = 0;
  74         pBA->DialogToken                = 0;
  75         pBA->BaStartSeqCtrl.ShortData   = 0;
  76 }
  77 static struct sk_buff *rtllib_ADDBA(struct rtllib_device *ieee, u8 *Dst,
  78                                     struct ba_record *pBA,
  79                                     u16 StatusCode, u8 type)
  80 {
  81         struct sk_buff *skb = NULL;
  82          struct rtllib_hdr_3addr *BAReq = NULL;
  83         u8 *tag = NULL;
  84         u16 len = ieee->tx_headroom + 9;
  85
  86         RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), frame(%d)"
  87                      " sentd to: %pM, ieee->dev:%p\n", __func__,
  88                      type, Dst, ieee->dev);
  89         if (pBA == NULL) {
  90                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "pBA is NULL\n");
  91                 return NULL;
  92         }
  93         skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
  94         if (skb == NULL) {
  95                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
  96                 return NULL;
  97         }
  98
  99         memset(skb->data, 0, sizeof(struct rtllib_hdr_3addr));
 100
 101         skb_reserve(skb, ieee->tx_headroom);
 102
 103         BAReq = (struct rtllib_hdr_3addr *)skb_put(skb,
 104                  sizeof(struct rtllib_hdr_3addr));
 105
 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
 112         tag = (u8 *)skb_put(skb, 9);
 113         *tag++ = ACT_CAT_BA;
 114         *tag++ = type;
 115         *tag++ = pBA->DialogToken;
 116
 117         if (ACT_ADDBARSP == type) {
 118                 RT_TRACE(COMP_DBG, "====>to send ADDBARSP\n");
 119
 120                 put_unaligned_le16(StatusCode, tag);
 121                 tag += 2;
 122         }
 123
 124         put_unaligned_le16(pBA->BaParamSet.shortData, tag);
 125         tag += 2;
 126
 127         put_unaligned_le16(pBA->BaTimeoutValue, tag);
 128         tag += 2;
 129
 130         if (ACT_ADDBAREQ == type) {
 131                 memcpy(tag, (u8 *)&(pBA->BaStartSeqCtrl), 2);
 132                 tag += 2;
 133         }
 134
 135         RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 136         return skb;
 137 }
 138
 139 static struct sk_buff *rtllib_DELBA(struct rtllib_device *ieee, u8 *dst,
 140                                     struct ba_record *pBA,
 141                                     enum tr_select TxRxSelect, u16 ReasonCode)
 142 {
 143         union delba_param_set DelbaParamSet;
 144         struct sk_buff *skb = NULL;
 145          struct rtllib_hdr_3addr *Delba = NULL;
 146         u8 *tag = NULL;
 147         u16 len = 6 + ieee->tx_headroom;
 148
 149         if (net_ratelimit())
 150                 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA,
 151                              "========>%s(), Reason"
 152                              "Code(%d) sentd to: %pM\n", __func__,
 153                              ReasonCode, dst);
 154
 155         memset(&DelbaParamSet, 0, 2);
 156
 157         DelbaParamSet.field.Initiator = (TxRxSelect == TX_DIR) ? 1 : 0;
 158         DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
 159
 160         skb = dev_alloc_skb(len + sizeof(struct rtllib_hdr_3addr));
 161         if (skb == NULL) {
 162                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
 163                 return NULL;
 164         }
 165
 166         skb_reserve(skb, ieee->tx_headroom);
 167
 168         Delba = (struct rtllib_hdr_3addr *) skb_put(skb,
 169                  sizeof(struct rtllib_hdr_3addr));
 170
 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);
 175
 176         tag = (u8 *)skb_put(skb, 6);
 177
 178         *tag++ = ACT_CAT_BA;
 179         *tag++ = ACT_DELBA;
 180
 181
 182         put_unaligned_le16(DelbaParamSet.shortData, tag);
 183         tag += 2;
 184
 185         put_unaligned_le16(ReasonCode, tag);
 186         tag += 2;
 187
 188         RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 189         if (net_ratelimit())
 190                 RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "<=====%s()\n",
 191                              __func__);
 192         return skb;
 193 }
 194
 195 static void rtllib_send_ADDBAReq(struct rtllib_device *ieee, u8 *dst,
 196                                  struct ba_record *pBA)
 197 {
 198         struct sk_buff *skb = NULL;
 199
 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 {
 206                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
 207                              " %s()\n", __func__);
 208         }
 209 }
 210
 211 static void rtllib_send_ADDBARsp(struct rtllib_device *ieee, u8 *dst,
 212                                  struct ba_record *pBA, u16 StatusCode)
 213 {
 214         struct sk_buff *skb = NULL;
 215
 216         skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP);
 217         if (skb)
 218                 softmac_mgmt_xmit(skb, ieee);
 219         else
 220                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
 221                              " %s()\n", __func__);
 222 }
 223
 224 static void rtllib_send_DELBA(struct rtllib_device *ieee, u8 *dst,
 225                               struct ba_record *pBA, enum tr_select TxRxSelect,
 226                               u16 ReasonCode)
 227 {
 228         struct sk_buff *skb = NULL;
 229
 230         skb = rtllib_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode);
 231         if (skb)
 232                 softmac_mgmt_xmit(skb, ieee);
 233         else
 234                 RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function"
 235                              " %s()\n", __func__);
 236 }
 237
 238 int rtllib_rx_ADDBAReq(struct rtllib_device *ieee, struct sk_buff *skb)
 239 {
 240         struct rtllib_hdr_3addr *req = NULL;
 241         u16 rc = 0;
 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;
 248
 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));
 253                 return -1;
 254         }
 255
 256         RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 257
 258         req = (struct rtllib_hdr_3addr *) skb->data;
 259         tag = (u8 *)req;
 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);
 266
 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;
 277         }
 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;
 283         }
 284         pBA = &pTS->RxAdmittedBARecord;
 285
 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 "
 289                              "%s()\n", __func__);
 290                 goto OnADDBAReq_Fail;
 291         }
 292
 293         rtllib_FlushRxTsPendingPkts(ieee, pTS);
 294
 295         DeActivateBAEntry(ieee, pBA);
 296         pBA->DialogToken = *pDialogToken;
 297         pBA->BaParamSet = *pBaParamSet;
 298         pBA->BaTimeoutValue = *pBaTimeoutVal;
 299         pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
 300
 301         if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev) ||
 302            (ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
 303                 pBA->BaParamSet.field.BufferSize = 1;
 304         else
 305                 pBA->BaParamSet.field.BufferSize = 32;
 306
 307         ActivateBAEntry(ieee, pBA, 0);
 308         rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
 309
 310         return 0;
 311
 312 OnADDBAReq_Fail:
 313         {
 314                 struct ba_record BA;
 315
 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);
 321                 return 0;
 322         }
 323 }
 324
 325 int rtllib_rx_ADDBARsp(struct rtllib_device *ieee, struct sk_buff *skb)
 326 {
 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;
 333         u16                     ReasonCode;
 334
 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));
 339                 return -1;
 340         }
 341         rsp = (struct rtllib_hdr_3addr *)skb->data;
 342         tag = (u8 *)rsp;
 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);
 349
 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;
 361         }
 362
 363
 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;
 369         }
 370
 371         pTS->bAddBaReqInProgress = false;
 372         pPendingBA = &pTS->TxPendingBARecord;
 373         pAdmittedBA = &pTS->TxAdmittedBARecord;
 374
 375
 376         if (pAdmittedBA->bValid == true) {
 377                 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp."
 378                              " Drop because already admit it!\n");
 379                 return -1;
 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;
 386         } else {
 387                 RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA "
 388                              "is admitted! Status code:%X\n", *pStatusCode);
 389                 DeActivateBAEntry(ieee, pPendingBA);
 390         }
 391
 392
 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;
 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
 417 OnADDBARsp_Reject:
 418         {
 419                 struct ba_record BA;
 420
 421                 BA.BaParamSet = *pBaParamSet;
 422                 rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
 423                 return 0;
 424         }
 425 }
 426
 427 int rtllib_rx_DELBA(struct rtllib_device *ieee, struct sk_buff *skb)
 428 {
 429          struct rtllib_hdr_3addr *delba = NULL;
 430         union delba_param_set *pDelBaParamSet = NULL;
 431         u16 *pReasonCode = NULL;
 432         u8 *dst = NULL;
 433
 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));
 438                 return -1;
 439         }
 440
 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);
 447                 return -1;
 448         }
 449
 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);
 456
 457         if (pDelBaParamSet->field.Initiator == 1) {
 458                 struct rx_ts_record *pRxTs;
 459
 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);
 465                         return -1;
 466                 }
 467
 468                 RxTsDeleteBA(ieee, pRxTs);
 469         } else {
 470                 struct tx_ts_record *pTxTs;
 471
 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 "
 475                                      "%s()\n", __func__);
 476                         return -1;
 477                 }
 478
 479                 pTxTs->bUsingBa = false;
 480                 pTxTs->bAddBaReqInProgress = false;
 481                 pTxTs->bAddBaReqDelayed = false;
 482                 del_timer_sync(&pTxTs->TsAddBaTimer);
 483                 TxTsDeleteBA(ieee, pTxTs);
 484         }
 485         return 0;
 486 }
 487
 488 void TsInitAddBA(struct rtllib_device *ieee, struct tx_ts_record *pTS,
 489                  u8 Policy, u8  bOverwritePending)
 490 {
 491         struct ba_record *pBA = &pTS->TxPendingBARecord;
 492
 493         if (pBA->bValid == true && bOverwritePending == false)
 494                 return;
 495
 496         DeActivateBAEntry(ieee, pBA);
 497
 498         pBA->DialogToken++;
 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;
 506
 507         ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
 508
 509         rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
 510 }
 511
 512 void TsInitDelBA(struct rtllib_device *ieee,
 513                  struct ts_common_info *pTsCommonInfo,
 514                  enum tr_select TxRxSelect)
 515 {
 516         if (TxRxSelect == TX_DIR) {
 517                 struct tx_ts_record *pTxTs =
 518                          (struct tx_ts_record *)pTsCommonInfo;
 519
 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);
 533         }
 534 }
 535
 536 void BaSetupTimeOut(unsigned long data)
 537 {
 538         struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
 539
 540         pTxTs->bAddBaReqInProgress = false;
 541         pTxTs->bAddBaReqDelayed = true;
 542         pTxTs->TxPendingBARecord.bValid = false;
 543 }
 544
 545 void TxBaInactTimeout(unsigned long data)
 546 {
 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);
 554 }
 555
 556 void RxBaInactTimeout(unsigned long data)
 557 {
 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]);
 561
 562         RxTsDeleteBA(ieee, pRxTs);
 563         rtllib_send_DELBA(ieee, pRxTs->TsCommonInfo.Addr,
 564                           &pRxTs->RxAdmittedBARecord, RX_DIR,
 565                           DELBA_REASON_TIMEOUT);
 566 }