rtl819x_BAProc.c revision 51296cdf9d32b9c1067f890dcc0eea02eab63b45
1/******************************************************************************************************************************** 2 * This file is created to process BA Action Frame. According to 802.11 spec, there are 3 BA action types at all. And as BA is 3 * related to TS, this part need some structure defined in QOS side code. Also TX RX is going to be resturctured, so how to send 4 * ADDBAREQ ADDBARSP and DELBA packet is still on consideration. Temporarily use MANAGE QUEUE instead of Normal Queue. 5 * WB 2008-05-27 6 * *****************************************************************************************************************************/ 7#include "ieee80211.h" 8#include "rtl819x_BA.h" 9 10/******************************************************************************************************************** 11 *function: Activate BA entry. And if Time is nozero, start timer. 12 * input: PBA_RECORD pBA //BA entry to be enabled 13 * u16 Time //indicate time delay. 14 * output: none 15********************************************************************************************************************/ 16static void ActivateBAEntry(struct ieee80211_device *ieee, PBA_RECORD pBA, u16 Time) 17{ 18 pBA->bValid = true; 19 if(Time != 0) 20 mod_timer(&pBA->Timer, jiffies + MSECS(Time)); 21} 22 23/******************************************************************************************************************** 24 *function: deactivate BA entry, including its timer. 25 * input: PBA_RECORD pBA //BA entry to be disabled 26 * output: none 27********************************************************************************************************************/ 28static void DeActivateBAEntry(struct ieee80211_device *ieee, PBA_RECORD pBA) 29{ 30 pBA->bValid = false; 31 del_timer_sync(&pBA->Timer); 32} 33/******************************************************************************************************************** 34 *function: deactivete BA entry in Tx Ts, and send DELBA. 35 * input: 36 * PTX_TS_RECORD pTxTs //Tx Ts which is to deactivate BA entry. 37 * output: none 38 * notice: As PTX_TS_RECORD structure will be defined in QOS, so wait to be merged. //FIXME 39********************************************************************************************************************/ 40static u8 TxTsDeleteBA(struct ieee80211_device *ieee, PTX_TS_RECORD pTxTs) 41{ 42 PBA_RECORD pAdmittedBa = &pTxTs->TxAdmittedBARecord; //These two BA entries must exist in TS structure 43 PBA_RECORD pPendingBa = &pTxTs->TxPendingBARecord; 44 u8 bSendDELBA = false; 45 46 // Delete pending BA 47 if(pPendingBa->bValid) 48 { 49 DeActivateBAEntry(ieee, pPendingBa); 50 bSendDELBA = true; 51 } 52 53 // Delete admitted BA 54 if(pAdmittedBa->bValid) 55 { 56 DeActivateBAEntry(ieee, pAdmittedBa); 57 bSendDELBA = true; 58 } 59 60 return bSendDELBA; 61} 62 63/******************************************************************************************************************** 64 *function: deactivete BA entry in Tx Ts, and send DELBA. 65 * input: 66 * PRX_TS_RECORD pRxTs //Rx Ts which is to deactivate BA entry. 67 * output: none 68 * notice: As PRX_TS_RECORD structure will be defined in QOS, so wait to be merged. //FIXME, same with above 69********************************************************************************************************************/ 70static u8 RxTsDeleteBA(struct ieee80211_device *ieee, PRX_TS_RECORD pRxTs) 71{ 72 PBA_RECORD pBa = &pRxTs->RxAdmittedBARecord; 73 u8 bSendDELBA = false; 74 75 if(pBa->bValid) 76 { 77 DeActivateBAEntry(ieee, pBa); 78 bSendDELBA = true; 79 } 80 81 return bSendDELBA; 82} 83 84/******************************************************************************************************************** 85 *function: reset BA entry 86 * input: 87 * PBA_RECORD pBA //entry to be reset 88 * output: none 89********************************************************************************************************************/ 90void ResetBaEntry( PBA_RECORD pBA) 91{ 92 pBA->bValid = false; 93 pBA->BaParamSet.shortData = 0; 94 pBA->BaTimeoutValue = 0; 95 pBA->DialogToken = 0; 96 pBA->BaStartSeqCtrl.ShortData = 0; 97} 98//These functions need porting here or not? 99/******************************************************************************************************************************* 100 *function: construct ADDBAREQ and ADDBARSP frame here together. 101 * input: u8* Dst //ADDBA frame's destination 102 * PBA_RECORD pBA //BA_RECORD entry which stores the necessary information for BA. 103 * u16 StatusCode //status code in RSP and I will use it to indicate whether it's RSP or REQ(will I?) 104 * u8 type //indicate whether it's RSP(ACT_ADDBARSP) ow REQ(ACT_ADDBAREQ) 105 * output: none 106 * return: sk_buff* skb //return constructed skb to xmit 107*******************************************************************************************************************************/ 108static struct sk_buff *ieee80211_ADDBA(struct ieee80211_device *ieee, u8 *Dst, PBA_RECORD pBA, u16 StatusCode, u8 type) 109{ 110 struct sk_buff *skb = NULL; 111 struct ieee80211_hdr_3addr *BAReq = NULL; 112 u8 *tag = NULL; 113 u16 tmp = 0; 114 u16 len = ieee->tx_headroom + 9; 115 //category(1) + action field(1) + Dialog Token(1) + BA Parameter Set(2) + BA Timeout Value(2) + BA Start SeqCtrl(2)(or StatusCode(2)) 116 IEEE80211_DEBUG(IEEE80211_DL_TRACE | IEEE80211_DL_BA, "========>%s(), frame(%d) sentd to:%pM, ieee->dev:%p\n", __FUNCTION__, type, Dst, ieee->dev); 117 if (pBA == NULL||ieee == NULL) 118 { 119 IEEE80211_DEBUG(IEEE80211_DL_ERR, "pBA(%p) is NULL or ieee(%p) is NULL\n", pBA, ieee); 120 return NULL; 121 } 122 skb = dev_alloc_skb(len + sizeof( struct ieee80211_hdr_3addr)); //need to add something others? FIXME 123 if (skb == NULL) 124 { 125 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't alloc skb for ADDBA_REQ\n"); 126 return NULL; 127 } 128 129 memset(skb->data, 0, sizeof( struct ieee80211_hdr_3addr)); //I wonder whether it's necessary. Apparently kernel will not do it when alloc a skb. 130 skb_reserve(skb, ieee->tx_headroom); 131 132 BAReq = ( struct ieee80211_hdr_3addr *) skb_put(skb,sizeof( struct ieee80211_hdr_3addr)); 133 134 memcpy(BAReq->addr1, Dst, ETH_ALEN); 135 memcpy(BAReq->addr2, ieee->dev->dev_addr, ETH_ALEN); 136 137 memcpy(BAReq->addr3, ieee->current_network.bssid, ETH_ALEN); 138 139 BAReq->frame_ctl = cpu_to_le16(IEEE80211_STYPE_MANAGE_ACT); //action frame 140 141 //tag += sizeof( struct ieee80211_hdr_3addr); //move to action field 142 tag = (u8 *)skb_put(skb, 9); 143 *tag ++= ACT_CAT_BA; 144 *tag ++= type; 145 // Dialog Token 146 *tag ++= pBA->DialogToken; 147 148 if (ACT_ADDBARSP == type) 149 { 150 // Status Code 151 printk("=====>to send ADDBARSP\n"); 152 tmp = cpu_to_le16(StatusCode); 153 memcpy(tag, (u8 *)&tmp, 2); 154 tag += 2; 155 } 156 // BA Parameter Set 157 tmp = cpu_to_le16(pBA->BaParamSet.shortData); 158 memcpy(tag, (u8 *)&tmp, 2); 159 tag += 2; 160 // BA Timeout Value 161 tmp = cpu_to_le16(pBA->BaTimeoutValue); 162 memcpy(tag, (u8 *)&tmp, 2); 163 tag += 2; 164 165 if (ACT_ADDBAREQ == type) 166 { 167 // BA Start SeqCtrl 168 memcpy(tag,(u8 *)&(pBA->BaStartSeqCtrl), 2); 169 tag += 2; 170 } 171 172 IEEE80211_DEBUG_DATA(IEEE80211_DL_DATA|IEEE80211_DL_BA, skb->data, skb->len); 173 return skb; 174 //return NULL; 175} 176 177 178/******************************************************************************************************************** 179 *function: construct DELBA frame 180 * input: u8* dst //DELBA frame's destination 181 * PBA_RECORD pBA //BA_RECORD entry which stores the necessary information for BA 182 * TR_SELECT TxRxSelect //TX RX direction 183 * u16 ReasonCode //status code. 184 * output: none 185 * return: sk_buff* skb //return constructed skb to xmit 186********************************************************************************************************************/ 187static struct sk_buff *ieee80211_DELBA( 188 struct ieee80211_device *ieee, 189 u8 *dst, 190 PBA_RECORD pBA, 191 TR_SELECT TxRxSelect, 192 u16 ReasonCode 193 ) 194{ 195 DELBA_PARAM_SET DelbaParamSet; 196 struct sk_buff *skb = NULL; 197 struct ieee80211_hdr_3addr *Delba = NULL; 198 u8 *tag = NULL; 199 u16 tmp = 0; 200 //len = head len + DELBA Parameter Set(2) + Reason Code(2) 201 u16 len = 6 + ieee->tx_headroom; 202 203 if (net_ratelimit()) 204 IEEE80211_DEBUG(IEEE80211_DL_TRACE | IEEE80211_DL_BA, "========>%s(), ReasonCode(%d) sentd to:%pM\n", __FUNCTION__, ReasonCode, dst); 205 206 memset(&DelbaParamSet, 0, 2); 207 208 DelbaParamSet.field.Initiator = (TxRxSelect==TX_DIR)?1:0; 209 DelbaParamSet.field.TID = pBA->BaParamSet.field.TID; 210 211 skb = dev_alloc_skb(len + sizeof( struct ieee80211_hdr_3addr)); //need to add something others? FIXME 212 if (skb == NULL) 213 { 214 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't alloc skb for ADDBA_REQ\n"); 215 return NULL; 216 } 217// memset(skb->data, 0, len+sizeof( struct ieee80211_hdr_3addr)); 218 skb_reserve(skb, ieee->tx_headroom); 219 220 Delba = ( struct ieee80211_hdr_3addr *) skb_put(skb,sizeof( struct ieee80211_hdr_3addr)); 221 222 memcpy(Delba->addr1, dst, ETH_ALEN); 223 memcpy(Delba->addr2, ieee->dev->dev_addr, ETH_ALEN); 224 memcpy(Delba->addr3, ieee->current_network.bssid, ETH_ALEN); 225 Delba->frame_ctl = cpu_to_le16(IEEE80211_STYPE_MANAGE_ACT); //action frame 226 227 tag = (u8 *)skb_put(skb, 6); 228 229 *tag ++= ACT_CAT_BA; 230 *tag ++= ACT_DELBA; 231 232 // DELBA Parameter Set 233 tmp = cpu_to_le16(DelbaParamSet.shortData); 234 memcpy(tag, (u8 *)&tmp, 2); 235 tag += 2; 236 // Reason Code 237 tmp = cpu_to_le16(ReasonCode); 238 memcpy(tag, (u8 *)&tmp, 2); 239 tag += 2; 240 241 IEEE80211_DEBUG_DATA(IEEE80211_DL_DATA|IEEE80211_DL_BA, skb->data, skb->len); 242 if (net_ratelimit()) 243 IEEE80211_DEBUG(IEEE80211_DL_TRACE | IEEE80211_DL_BA, "<=====%s()\n", __FUNCTION__); 244 return skb; 245} 246 247/******************************************************************************************************************** 248 *function: send ADDBAReq frame out 249 * input: u8* dst //ADDBAReq frame's destination 250 * PBA_RECORD pBA //BA_RECORD entry which stores the necessary information for BA 251 * output: none 252 * notice: If any possible, please hide pBA in ieee. And temporarily use Manage Queue as softmac_mgmt_xmit() usually does 253********************************************************************************************************************/ 254static void ieee80211_send_ADDBAReq(struct ieee80211_device *ieee, 255 u8 *dst, PBA_RECORD pBA) 256{ 257 struct sk_buff *skb = NULL; 258 skb = ieee80211_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ); //construct ACT_ADDBAREQ frames so set statuscode zero. 259 260 if (skb) 261 { 262 softmac_mgmt_xmit(skb, ieee); 263 //add statistic needed here. 264 //and skb will be freed in softmac_mgmt_xmit(), so omit all dev_kfree_skb_any() outside softmac_mgmt_xmit() 265 //WB 266 } 267 else 268 { 269 IEEE80211_DEBUG(IEEE80211_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__); 270 } 271 return; 272} 273 274/******************************************************************************************************************** 275 *function: send ADDBARSP frame out 276 * input: u8* dst //DELBA frame's destination 277 * PBA_RECORD pBA //BA_RECORD entry which stores the necessary information for BA 278 * u16 StatusCode //RSP StatusCode 279 * output: none 280 * notice: If any possible, please hide pBA in ieee. And temporarily use Manage Queue as softmac_mgmt_xmit() usually does 281********************************************************************************************************************/ 282static void ieee80211_send_ADDBARsp(struct ieee80211_device *ieee, u8 *dst, 283 PBA_RECORD pBA, u16 StatusCode) 284{ 285 struct sk_buff *skb = NULL; 286 skb = ieee80211_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP); //construct ACT_ADDBARSP frames 287 if (skb) 288 { 289 softmac_mgmt_xmit(skb, ieee); 290 //same above 291 } 292 else 293 { 294 IEEE80211_DEBUG(IEEE80211_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__); 295 } 296 297 return; 298 299} 300/******************************************************************************************************************** 301 *function: send ADDBARSP frame out 302 * input: u8* dst //DELBA frame's destination 303 * PBA_RECORD pBA //BA_RECORD entry which stores the necessary information for BA 304 * TR_SELECT TxRxSelect //TX or RX 305 * u16 ReasonCode //DEL ReasonCode 306 * output: none 307 * notice: If any possible, please hide pBA in ieee. And temporarily use Manage Queue as softmac_mgmt_xmit() usually does 308********************************************************************************************************************/ 309 310static void ieee80211_send_DELBA(struct ieee80211_device *ieee, u8 *dst, 311 PBA_RECORD pBA, TR_SELECT TxRxSelect, 312 u16 ReasonCode) 313{ 314 struct sk_buff *skb = NULL; 315 skb = ieee80211_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode); //construct ACT_ADDBARSP frames 316 if (skb) 317 { 318 softmac_mgmt_xmit(skb, ieee); 319 //same above 320 } 321 else 322 { 323 IEEE80211_DEBUG(IEEE80211_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__); 324 } 325 return ; 326} 327 328/******************************************************************************************************************** 329 *function: RX ADDBAReq 330 * input: struct sk_buff * skb //incoming ADDBAReq skb. 331 * return: 0(pass), other(fail) 332 * notice: As this function need support of QOS, I comment some code out. And when qos is ready, this code need to be support. 333********************************************************************************************************************/ 334int ieee80211_rx_ADDBAReq( struct ieee80211_device *ieee, struct sk_buff *skb) 335{ 336 struct ieee80211_hdr_3addr *req = NULL; 337 u16 rc = 0; 338 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL; 339 PBA_RECORD pBA = NULL; 340 PBA_PARAM_SET pBaParamSet = NULL; 341 u16 *pBaTimeoutVal = NULL; 342 PSEQUENCE_CONTROL pBaStartSeqCtrl = NULL; 343 PRX_TS_RECORD pTS = NULL; 344 345 if (skb->len < sizeof( struct ieee80211_hdr_3addr) + 9) 346 { 347 IEEE80211_DEBUG(IEEE80211_DL_ERR, " Invalid skb len in BAREQ(%d / %zu)\n", skb->len, (sizeof( struct ieee80211_hdr_3addr) + 9)); 348 return -1; 349 } 350 351 IEEE80211_DEBUG_DATA(IEEE80211_DL_DATA|IEEE80211_DL_BA, skb->data, skb->len); 352 353 req = ( struct ieee80211_hdr_3addr *) skb->data; 354 tag = (u8 *)req; 355 dst = (u8 *)(&req->addr2[0]); 356 tag += sizeof( struct ieee80211_hdr_3addr); 357 pDialogToken = tag + 2; //category+action 358 pBaParamSet = (PBA_PARAM_SET)(tag + 3); //+DialogToken 359 pBaTimeoutVal = (u16 *)(tag + 5); 360 pBaStartSeqCtrl = (PSEQUENCE_CONTROL)(req + 7); 361 362 printk("====================>rx ADDBAREQ from :%pM\n", dst); 363//some other capability is not ready now. 364 if( (ieee->current_network.qos_data.active == 0) || 365 (ieee->pHTInfo->bCurrentHTSupport == false)) //|| 366 // (ieee->pStaQos->bEnableRxImmBA == false) ) 367 { 368 rc = ADDBA_STATUS_REFUSED; 369 IEEE80211_DEBUG(IEEE80211_DL_ERR, "Failed to reply on ADDBA_REQ as some capability is not ready(%d, %d)\n", ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport); 370 goto OnADDBAReq_Fail; 371 } 372 // Search for related traffic stream. 373 // If there is no matched TS, reject the ADDBA request. 374 if( !GetTs( 375 ieee, 376 (PTS_COMMON_INFO *)(&pTS), 377 dst, 378 (u8)(pBaParamSet->field.TID), 379 RX_DIR, 380 true) ) 381 { 382 rc = ADDBA_STATUS_REFUSED; 383 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't get TS in %s()\n", __FUNCTION__); 384 goto OnADDBAReq_Fail; 385 } 386 pBA = &pTS->RxAdmittedBARecord; 387 // To Determine the ADDBA Req content 388 // We can do much more check here, including BufferSize, AMSDU_Support, Policy, StartSeqCtrl... 389 // I want to check StartSeqCtrl to make sure when we start aggregation!!! 390 // 391 if(pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) 392 { 393 rc = ADDBA_STATUS_INVALID_PARAM; 394 IEEE80211_DEBUG(IEEE80211_DL_ERR, "BA Policy is not correct in %s()\n", __FUNCTION__); 395 goto OnADDBAReq_Fail; 396 } 397 // Admit the ADDBA Request 398 // 399 DeActivateBAEntry(ieee, pBA); 400 pBA->DialogToken = *pDialogToken; 401 pBA->BaParamSet = *pBaParamSet; 402 pBA->BaTimeoutValue = *pBaTimeoutVal; 403 pBA->BaStartSeqCtrl = *pBaStartSeqCtrl; 404 //for half N mode we only aggregate 1 frame 405 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev)) 406 pBA->BaParamSet.field.BufferSize = 1; 407 else 408 pBA->BaParamSet.field.BufferSize = 32; 409 ActivateBAEntry(ieee, pBA, pBA->BaTimeoutValue); 410 ieee80211_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS); 411 412 // End of procedure. 413 return 0; 414 415OnADDBAReq_Fail: 416 { 417 BA_RECORD BA; 418 BA.BaParamSet = *pBaParamSet; 419 BA.BaTimeoutValue = *pBaTimeoutVal; 420 BA.DialogToken = *pDialogToken; 421 BA.BaParamSet.field.BAPolicy = BA_POLICY_IMMEDIATE; 422 ieee80211_send_ADDBARsp(ieee, dst, &BA, rc); 423 return 0; //we send RSP out. 424 } 425 426} 427 428/******************************************************************************************************************** 429 *function: RX ADDBARSP 430 * input: struct sk_buff * skb //incoming ADDBAReq skb. 431 * return: 0(pass), other(fail) 432 * notice: As this function need support of QOS, I comment some code out. And when qos is ready, this code need to be support. 433********************************************************************************************************************/ 434int ieee80211_rx_ADDBARsp( struct ieee80211_device *ieee, struct sk_buff *skb) 435{ 436 struct ieee80211_hdr_3addr *rsp = NULL; 437 PBA_RECORD pPendingBA, pAdmittedBA; 438 PTX_TS_RECORD pTS = NULL; 439 u8 *dst = NULL, *pDialogToken = NULL, *tag = NULL; 440 u16 *pStatusCode = NULL, *pBaTimeoutVal = NULL; 441 PBA_PARAM_SET pBaParamSet = NULL; 442 u16 ReasonCode; 443 444 if (skb->len < sizeof( struct ieee80211_hdr_3addr) + 9) 445 { 446 IEEE80211_DEBUG(IEEE80211_DL_ERR, " Invalid skb len in BARSP(%d / %zu)\n", skb->len, (sizeof( struct ieee80211_hdr_3addr) + 9)); 447 return -1; 448 } 449 rsp = ( struct ieee80211_hdr_3addr *)skb->data; 450 tag = (u8 *)rsp; 451 dst = (u8 *)(&rsp->addr2[0]); 452 tag += sizeof( struct ieee80211_hdr_3addr); 453 pDialogToken = tag + 2; 454 pStatusCode = (u16 *)(tag + 3); 455 pBaParamSet = (PBA_PARAM_SET)(tag + 5); 456 pBaTimeoutVal = (u16 *)(tag + 7); 457 458 // Check the capability 459 // Since we can always receive A-MPDU, we just check if it is under HT mode. 460 if( ieee->current_network.qos_data.active == 0 || 461 ieee->pHTInfo->bCurrentHTSupport == false || 462 ieee->pHTInfo->bCurrentAMPDUEnable == false ) 463 { 464 IEEE80211_DEBUG(IEEE80211_DL_ERR, "reject to ADDBA_RSP as some capability is not ready(%d, %d, %d)\n",ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport, ieee->pHTInfo->bCurrentAMPDUEnable); 465 ReasonCode = DELBA_REASON_UNKNOWN_BA; 466 goto OnADDBARsp_Reject; 467 } 468 469 470 // 471 // Search for related TS. 472 // If there is no TS found, we wil reject ADDBA Rsp by sending DELBA frame. 473 // 474 if (!GetTs( 475 ieee, 476 (PTS_COMMON_INFO *)(&pTS), 477 dst, 478 (u8)(pBaParamSet->field.TID), 479 TX_DIR, 480 false) ) 481 { 482 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't get TS in %s()\n", __FUNCTION__); 483 ReasonCode = DELBA_REASON_UNKNOWN_BA; 484 goto OnADDBARsp_Reject; 485 } 486 487 pTS->bAddBaReqInProgress = false; 488 pPendingBA = &pTS->TxPendingBARecord; 489 pAdmittedBA = &pTS->TxAdmittedBARecord; 490 491 492 // 493 // Check if related BA is waiting for setup. 494 // If not, reject by sending DELBA frame. 495 // 496 if((pAdmittedBA->bValid==true)) 497 { 498 // Since BA is already setup, we ignore all other ADDBA Response. 499 IEEE80211_DEBUG(IEEE80211_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. Drop because already admit it! \n"); 500 return -1; 501 } 502 else if((pPendingBA->bValid == false) ||(*pDialogToken != pPendingBA->DialogToken)) 503 { 504 IEEE80211_DEBUG(IEEE80211_DL_ERR, "OnADDBARsp(): Recv ADDBA Rsp. BA invalid, DELBA! \n"); 505 ReasonCode = DELBA_REASON_UNKNOWN_BA; 506 goto OnADDBARsp_Reject; 507 } 508 else 509 { 510 IEEE80211_DEBUG(IEEE80211_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA is admitted! Status code:%X\n", *pStatusCode); 511 DeActivateBAEntry(ieee, pPendingBA); 512 } 513 514 515 if(*pStatusCode == ADDBA_STATUS_SUCCESS) 516 { 517 // 518 // Determine ADDBA Rsp content here. 519 // We can compare the value of BA parameter set that Peer returned and Self sent. 520 // If it is OK, then admitted. Or we can send DELBA to cancel BA mechanism. 521 // 522 if(pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED) 523 { 524 // Since this is a kind of ADDBA failed, we delay next ADDBA process. 525 pTS->bAddBaReqDelayed = true; 526 DeActivateBAEntry(ieee, pAdmittedBA); 527 ReasonCode = DELBA_REASON_END_BA; 528 goto OnADDBARsp_Reject; 529 } 530 531 532 // 533 // Admitted condition 534 // 535 pAdmittedBA->DialogToken = *pDialogToken; 536 pAdmittedBA->BaTimeoutValue = *pBaTimeoutVal; 537 pAdmittedBA->BaStartSeqCtrl = pPendingBA->BaStartSeqCtrl; 538 pAdmittedBA->BaParamSet = *pBaParamSet; 539 DeActivateBAEntry(ieee, pAdmittedBA); 540 ActivateBAEntry(ieee, pAdmittedBA, *pBaTimeoutVal); 541 } 542 else 543 { 544 // Delay next ADDBA process. 545 pTS->bAddBaReqDelayed = true; 546 } 547 548 // End of procedure 549 return 0; 550 551OnADDBARsp_Reject: 552 { 553 BA_RECORD BA; 554 BA.BaParamSet = *pBaParamSet; 555 ieee80211_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode); 556 return 0; 557 } 558 559} 560 561/******************************************************************************************************************** 562 *function: RX DELBA 563 * input: struct sk_buff * skb //incoming ADDBAReq skb. 564 * return: 0(pass), other(fail) 565 * notice: As this function need support of QOS, I comment some code out. And when qos is ready, this code need to be support. 566********************************************************************************************************************/ 567int ieee80211_rx_DELBA(struct ieee80211_device *ieee,struct sk_buff *skb) 568{ 569 struct ieee80211_hdr_3addr *delba = NULL; 570 PDELBA_PARAM_SET pDelBaParamSet = NULL; 571 u16 *pReasonCode = NULL; 572 u8 *dst = NULL; 573 574 if (skb->len < sizeof( struct ieee80211_hdr_3addr) + 6) 575 { 576 IEEE80211_DEBUG(IEEE80211_DL_ERR, " Invalid skb len in DELBA(%d / %zu)\n", skb->len, (sizeof( struct ieee80211_hdr_3addr) + 6)); 577 return -1; 578 } 579 580 if(ieee->current_network.qos_data.active == 0 || 581 ieee->pHTInfo->bCurrentHTSupport == false ) 582 { 583 IEEE80211_DEBUG(IEEE80211_DL_ERR, "received DELBA while QOS or HT is not supported(%d, %d)\n",ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport); 584 return -1; 585 } 586 587 IEEE80211_DEBUG_DATA(IEEE80211_DL_DATA|IEEE80211_DL_BA, skb->data, skb->len); 588 delba = ( struct ieee80211_hdr_3addr *)skb->data; 589 dst = (u8 *)(&delba->addr2[0]); 590 delba += sizeof( struct ieee80211_hdr_3addr); 591 pDelBaParamSet = (PDELBA_PARAM_SET)(delba+2); 592 pReasonCode = (u16 *)(delba+4); 593 594 if(pDelBaParamSet->field.Initiator == 1) 595 { 596 PRX_TS_RECORD pRxTs; 597 598 if( !GetTs( 599 ieee, 600 (PTS_COMMON_INFO *)&pRxTs, 601 dst, 602 (u8)pDelBaParamSet->field.TID, 603 RX_DIR, 604 false) ) 605 { 606 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't get TS for RXTS in %s()\n", __FUNCTION__); 607 return -1; 608 } 609 610 RxTsDeleteBA(ieee, pRxTs); 611 } 612 else 613 { 614 PTX_TS_RECORD pTxTs; 615 616 if(!GetTs( 617 ieee, 618 (PTS_COMMON_INFO *)&pTxTs, 619 dst, 620 (u8)pDelBaParamSet->field.TID, 621 TX_DIR, 622 false) ) 623 { 624 IEEE80211_DEBUG(IEEE80211_DL_ERR, "can't get TS for TXTS in %s()\n", __FUNCTION__); 625 return -1; 626 } 627 628 pTxTs->bUsingBa = false; 629 pTxTs->bAddBaReqInProgress = false; 630 pTxTs->bAddBaReqDelayed = false; 631 del_timer_sync(&pTxTs->TsAddBaTimer); 632 //PlatformCancelTimer(Adapter, &pTxTs->TsAddBaTimer); 633 TxTsDeleteBA(ieee, pTxTs); 634 } 635 return 0; 636} 637 638// 639// ADDBA initiate. This can only be called by TX side. 640// 641void 642TsInitAddBA( 643 struct ieee80211_device *ieee, 644 PTX_TS_RECORD pTS, 645 u8 Policy, 646 u8 bOverwritePending 647 ) 648{ 649 PBA_RECORD pBA = &pTS->TxPendingBARecord; 650 651 if(pBA->bValid==true && bOverwritePending==false) 652 return; 653 654 // Set parameters to "Pending" variable set 655 DeActivateBAEntry(ieee, pBA); 656 657 pBA->DialogToken++; // DialogToken: Only keep the latest dialog token 658 pBA->BaParamSet.field.AMSDU_Support = 0; // Do not support A-MSDU with A-MPDU now!! 659 pBA->BaParamSet.field.BAPolicy = Policy; // Policy: Delayed or Immediate 660 pBA->BaParamSet.field.TID = pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID; // TID 661 // BufferSize: This need to be set according to A-MPDU vector 662 pBA->BaParamSet.field.BufferSize = 32; // BufferSize: This need to be set according to A-MPDU vector 663 pBA->BaTimeoutValue = 0; // Timeout value: Set 0 to disable Timer 664 pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096; // Block Ack will start after 3 packets later. 665 666 ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT); 667 668 ieee80211_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA); 669} 670 671void 672TsInitDelBA( struct ieee80211_device *ieee, PTS_COMMON_INFO pTsCommonInfo, TR_SELECT TxRxSelect) 673{ 674 675 if(TxRxSelect == TX_DIR) 676 { 677 PTX_TS_RECORD pTxTs = (PTX_TS_RECORD)pTsCommonInfo; 678 679 if(TxTsDeleteBA(ieee, pTxTs)) 680 ieee80211_send_DELBA( 681 ieee, 682 pTsCommonInfo->Addr, 683 (pTxTs->TxAdmittedBARecord.bValid)?(&pTxTs->TxAdmittedBARecord):(&pTxTs->TxPendingBARecord), 684 TxRxSelect, 685 DELBA_REASON_END_BA); 686 } 687 else if(TxRxSelect == RX_DIR) 688 { 689 PRX_TS_RECORD pRxTs = (PRX_TS_RECORD)pTsCommonInfo; 690 if(RxTsDeleteBA(ieee, pRxTs)) 691 ieee80211_send_DELBA( 692 ieee, 693 pTsCommonInfo->Addr, 694 &pRxTs->RxAdmittedBARecord, 695 TxRxSelect, 696 DELBA_REASON_END_BA ); 697 } 698} 699/******************************************************************************************************************** 700 *function: BA setup timer 701 * input: unsigned long data //acturally we send TX_TS_RECORD or RX_TS_RECORD to these timer 702 * return: NULL 703 * notice: 704********************************************************************************************************************/ 705void BaSetupTimeOut(unsigned long data) 706{ 707 PTX_TS_RECORD pTxTs = (PTX_TS_RECORD)data; 708 709 pTxTs->bAddBaReqInProgress = false; 710 pTxTs->bAddBaReqDelayed = true; 711 pTxTs->TxPendingBARecord.bValid = false; 712} 713 714void TxBaInactTimeout(unsigned long data) 715{ 716 PTX_TS_RECORD pTxTs = (PTX_TS_RECORD)data; 717 struct ieee80211_device *ieee = container_of(pTxTs, struct ieee80211_device, TxTsRecord[pTxTs->num]); 718 TxTsDeleteBA(ieee, pTxTs); 719 ieee80211_send_DELBA( 720 ieee, 721 pTxTs->TsCommonInfo.Addr, 722 &pTxTs->TxAdmittedBARecord, 723 TX_DIR, 724 DELBA_REASON_TIMEOUT); 725} 726 727void RxBaInactTimeout(unsigned long data) 728{ 729 PRX_TS_RECORD pRxTs = (PRX_TS_RECORD)data; 730 struct ieee80211_device *ieee = container_of(pRxTs, struct ieee80211_device, RxTsRecord[pRxTs->num]); 731 732 RxTsDeleteBA(ieee, pRxTs); 733 ieee80211_send_DELBA( 734 ieee, 735 pRxTs->TsCommonInfo.Addr, 736 &pRxTs->RxAdmittedBARecord, 737 RX_DIR, 738 DELBA_REASON_TIMEOUT); 739 return ; 740} 741