593 lines
16 KiB
C
593 lines
16 KiB
C
/******************************************************************************
|
|
* Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
*
|
|
* The full GNU General Public License is included in this distribution in the
|
|
* file called LICENSE.
|
|
*
|
|
* Contact Information:
|
|
* wlanfae <wlanfae@realtek.com>
|
|
******************************************************************************/
|
|
#include "rtllib.h"
|
|
#include "rtl819x_BA.h"
|
|
#include "rtl_core.h"
|
|
|
|
void ActivateBAEntry(struct rtllib_device* ieee, struct ba_record *pBA, u16 Time)
|
|
{
|
|
pBA->bValid = true;
|
|
if (Time != 0)
|
|
mod_timer(&pBA->Timer, jiffies + MSECS(Time));
|
|
}
|
|
|
|
void DeActivateBAEntry( struct rtllib_device* ieee, struct ba_record *pBA)
|
|
{
|
|
pBA->bValid = false;
|
|
del_timer_sync(&pBA->Timer);
|
|
}
|
|
u8 TxTsDeleteBA( struct rtllib_device* ieee, struct tx_ts_record *pTxTs)
|
|
{
|
|
struct ba_record *pAdmittedBa = &pTxTs->TxAdmittedBARecord;
|
|
struct ba_record *pPendingBa = &pTxTs->TxPendingBARecord;
|
|
u8 bSendDELBA = false;
|
|
|
|
if (pPendingBa->bValid)
|
|
{
|
|
DeActivateBAEntry(ieee, pPendingBa);
|
|
bSendDELBA = true;
|
|
}
|
|
|
|
if (pAdmittedBa->bValid)
|
|
{
|
|
DeActivateBAEntry(ieee, pAdmittedBa);
|
|
bSendDELBA = true;
|
|
}
|
|
|
|
return bSendDELBA;
|
|
}
|
|
|
|
u8 RxTsDeleteBA( struct rtllib_device* ieee, struct rx_ts_record *pRxTs)
|
|
{
|
|
struct ba_record *pBa = &pRxTs->RxAdmittedBARecord;
|
|
u8 bSendDELBA = false;
|
|
|
|
if (pBa->bValid)
|
|
{
|
|
DeActivateBAEntry(ieee, pBa);
|
|
bSendDELBA = true;
|
|
}
|
|
|
|
return bSendDELBA;
|
|
}
|
|
|
|
void ResetBaEntry( struct ba_record *pBA)
|
|
{
|
|
pBA->bValid = false;
|
|
pBA->BaParamSet.shortData = 0;
|
|
pBA->BaTimeoutValue = 0;
|
|
pBA->DialogToken = 0;
|
|
pBA->BaStartSeqCtrl.ShortData = 0;
|
|
}
|
|
static struct sk_buff* rtllib_ADDBA(struct rtllib_device* ieee, u8* Dst, struct ba_record *pBA, u16 StatusCode, u8 type)
|
|
{
|
|
struct sk_buff *skb = NULL;
|
|
struct rtllib_hdr_3addr* BAReq = NULL;
|
|
u8* tag = NULL;
|
|
u16 tmp = 0;
|
|
u16 len = ieee->tx_headroom + 9;
|
|
RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), frame(%d) sentd to:"MAC_FMT", ieee->dev:%p\n", __func__, type, MAC_ARG(Dst), ieee->dev);
|
|
if (pBA == NULL||ieee == NULL)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "pBA(%p) is NULL or ieee(%p) is NULL\n", pBA, ieee);
|
|
return NULL;
|
|
}
|
|
skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr));
|
|
if (skb == NULL)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
|
|
return NULL;
|
|
}
|
|
|
|
memset(skb->data, 0, sizeof( struct rtllib_hdr_3addr));
|
|
|
|
skb_reserve(skb, ieee->tx_headroom);
|
|
|
|
BAReq = ( struct rtllib_hdr_3addr *) skb_put(skb,sizeof( struct rtllib_hdr_3addr));
|
|
|
|
memcpy(BAReq->addr1, Dst, ETH_ALEN);
|
|
memcpy(BAReq->addr2, ieee->dev->dev_addr, ETH_ALEN);
|
|
|
|
memcpy(BAReq->addr3, ieee->current_network.bssid, ETH_ALEN);
|
|
BAReq->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
|
|
|
|
tag = (u8*)skb_put(skb, 9);
|
|
*tag ++= ACT_CAT_BA;
|
|
*tag ++= type;
|
|
*tag ++= pBA->DialogToken;
|
|
|
|
if (ACT_ADDBARSP == type)
|
|
{
|
|
RT_TRACE(COMP_DBG, "====>to send ADDBARSP\n");
|
|
tmp = cpu_to_le16(StatusCode);
|
|
memcpy(tag, (u8*)&tmp, 2);
|
|
tag += 2;
|
|
}
|
|
tmp = cpu_to_le16(pBA->BaParamSet.shortData);
|
|
memcpy(tag, (u8*)&tmp, 2);
|
|
tag += 2;
|
|
tmp = cpu_to_le16(pBA->BaTimeoutValue);
|
|
memcpy(tag, (u8*)&tmp, 2);
|
|
tag += 2;
|
|
|
|
if (ACT_ADDBAREQ == type)
|
|
{
|
|
memcpy(tag,(u8*)&(pBA->BaStartSeqCtrl), 2);
|
|
tag += 2;
|
|
}
|
|
|
|
RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
|
|
return skb;
|
|
}
|
|
|
|
static struct sk_buff* rtllib_DELBA(
|
|
struct rtllib_device* ieee,
|
|
u8* dst,
|
|
struct ba_record *pBA,
|
|
enum tr_select TxRxSelect,
|
|
u16 ReasonCode
|
|
)
|
|
{
|
|
union delba_param_set DelbaParamSet;
|
|
struct sk_buff *skb = NULL;
|
|
struct rtllib_hdr_3addr* Delba = NULL;
|
|
u8* tag = NULL;
|
|
u16 tmp = 0;
|
|
u16 len = 6 + ieee->tx_headroom;
|
|
|
|
if (net_ratelimit())
|
|
RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), ReasonCode(%d) sentd to:"MAC_FMT"\n", __func__, ReasonCode, MAC_ARG(dst));
|
|
|
|
memset(&DelbaParamSet, 0, 2);
|
|
|
|
DelbaParamSet.field.Initiator = (TxRxSelect==TX_DIR)?1:0;
|
|
DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
|
|
|
|
skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr));
|
|
if (skb == NULL)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
|
|
return NULL;
|
|
}
|
|
|
|
skb_reserve(skb, ieee->tx_headroom);
|
|
|
|
Delba = ( struct rtllib_hdr_3addr *) skb_put(skb,sizeof( struct rtllib_hdr_3addr));
|
|
|
|
memcpy(Delba->addr1, dst, ETH_ALEN);
|
|
memcpy(Delba->addr2, ieee->dev->dev_addr, ETH_ALEN);
|
|
memcpy(Delba->addr3, ieee->current_network.bssid, ETH_ALEN);
|
|
Delba->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT);
|
|
|
|
tag = (u8*)skb_put(skb, 6);
|
|
|
|
*tag ++= ACT_CAT_BA;
|
|
*tag ++= ACT_DELBA;
|
|
|
|
tmp = cpu_to_le16(DelbaParamSet.shortData);
|
|
memcpy(tag, (u8*)&tmp, 2);
|
|
tag += 2;
|
|
tmp = cpu_to_le16(ReasonCode);
|
|
memcpy(tag, (u8*)&tmp, 2);
|
|
tag += 2;
|
|
|
|
RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
|
|
if (net_ratelimit())
|
|
RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "<=====%s()\n", __func__);
|
|
return skb;
|
|
}
|
|
|
|
void rtllib_send_ADDBAReq(struct rtllib_device* ieee, u8* dst, struct ba_record *pBA)
|
|
{
|
|
struct sk_buff *skb = NULL;
|
|
skb = rtllib_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ);
|
|
|
|
if (skb) {
|
|
RT_TRACE(COMP_DBG, "====>to send ADDBAREQ!!!!!\n");
|
|
softmac_mgmt_xmit(skb, ieee);
|
|
} else {
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __func__);
|
|
}
|
|
return;
|
|
}
|
|
|
|
void rtllib_send_ADDBARsp(struct rtllib_device* ieee, u8* dst, struct ba_record *pBA, u16 StatusCode)
|
|
{
|
|
struct sk_buff *skb = NULL;
|
|
skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP);
|
|
if (skb)
|
|
softmac_mgmt_xmit(skb, ieee);
|
|
else
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __func__);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
void rtllib_send_DELBA(struct rtllib_device* ieee, u8* dst, struct ba_record *pBA, enum tr_select TxRxSelect, u16 ReasonCode)
|
|
{
|
|
struct sk_buff *skb = NULL;
|
|
skb = rtllib_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode);
|
|
if (skb)
|
|
{
|
|
softmac_mgmt_xmit(skb, ieee);
|
|
}
|
|
else
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __func__);
|
|
}
|
|
return ;
|
|
}
|
|
|
|
int rtllib_rx_ADDBAReq( struct rtllib_device* ieee, struct sk_buff *skb)
|
|
{
|
|
struct rtllib_hdr_3addr* req = NULL;
|
|
u16 rc = 0;
|
|
u8 * dst = NULL, *pDialogToken = NULL, *tag = NULL;
|
|
struct ba_record *pBA = NULL;
|
|
union ba_param_set *pBaParamSet = NULL;
|
|
u16* pBaTimeoutVal = NULL;
|
|
union sequence_control *pBaStartSeqCtrl = NULL;
|
|
struct rx_ts_record *pTS = NULL;
|
|
|
|
if (skb->len < sizeof( struct rtllib_hdr_3addr) + 9)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BAREQ(%d / %d)\n",(int)skb->len, (int)(sizeof( struct rtllib_hdr_3addr) + 9));
|
|
return -1;
|
|
}
|
|
|
|
RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
|
|
|
|
req = ( struct rtllib_hdr_3addr*) skb->data;
|
|
tag = (u8*)req;
|
|
dst = (u8*)(&req->addr2[0]);
|
|
tag += sizeof( struct rtllib_hdr_3addr);
|
|
pDialogToken = tag + 2;
|
|
pBaParamSet = (union ba_param_set *)(tag + 3);
|
|
pBaTimeoutVal = (u16*)(tag + 5);
|
|
pBaStartSeqCtrl = (union sequence_control *)(req + 7);
|
|
|
|
RT_TRACE(COMP_DBG, "====>rx ADDBAREQ from :"MAC_FMT"\n", MAC_ARG(dst));
|
|
if (ieee->current_network.qos_data.active == 0 ||
|
|
(ieee->pHTInfo->bCurrentHTSupport == false) ||
|
|
(ieee->pHTInfo->IOTAction & HT_IOT_ACT_REJECT_ADDBA_REQ)) {
|
|
rc = ADDBA_STATUS_REFUSED;
|
|
RTLLIB_DEBUG(RTLLIB_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);
|
|
goto OnADDBAReq_Fail;
|
|
}
|
|
if (!GetTs(
|
|
ieee,
|
|
(struct ts_common_info **)(&pTS),
|
|
dst,
|
|
(u8)(pBaParamSet->field.TID),
|
|
RX_DIR,
|
|
true) )
|
|
{
|
|
rc = ADDBA_STATUS_REFUSED;
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __func__);
|
|
goto OnADDBAReq_Fail;
|
|
}
|
|
pBA = &pTS->RxAdmittedBARecord;
|
|
|
|
if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED)
|
|
{
|
|
rc = ADDBA_STATUS_INVALID_PARAM;
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "BA Policy is not correct in %s()\n", __func__);
|
|
goto OnADDBAReq_Fail;
|
|
}
|
|
|
|
|
|
rtllib_FlushRxTsPendingPkts(ieee, pTS);
|
|
|
|
DeActivateBAEntry(ieee, pBA);
|
|
pBA->DialogToken = *pDialogToken;
|
|
pBA->BaParamSet = *pBaParamSet;
|
|
pBA->BaTimeoutValue = *pBaTimeoutVal;
|
|
pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
|
|
|
|
if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev)||
|
|
(ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
|
|
pBA->BaParamSet.field.BufferSize = 1;
|
|
else
|
|
pBA->BaParamSet.field.BufferSize = 32;
|
|
|
|
ActivateBAEntry(ieee, pBA, 0);
|
|
rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
|
|
|
|
return 0;
|
|
|
|
OnADDBAReq_Fail:
|
|
{
|
|
struct ba_record BA;
|
|
BA.BaParamSet = *pBaParamSet;
|
|
BA.BaTimeoutValue = *pBaTimeoutVal;
|
|
BA.DialogToken = *pDialogToken;
|
|
BA.BaParamSet.field.BAPolicy = BA_POLICY_IMMEDIATE;
|
|
rtllib_send_ADDBARsp(ieee, dst, &BA, rc);
|
|
return 0;
|
|
}
|
|
|
|
}
|
|
|
|
int rtllib_rx_ADDBARsp( struct rtllib_device* ieee, struct sk_buff *skb)
|
|
{
|
|
struct rtllib_hdr_3addr* rsp = NULL;
|
|
struct ba_record *pPendingBA, *pAdmittedBA;
|
|
struct tx_ts_record *pTS = NULL;
|
|
u8* dst = NULL, *pDialogToken = NULL, *tag = NULL;
|
|
u16* pStatusCode = NULL, *pBaTimeoutVal = NULL;
|
|
union ba_param_set *pBaParamSet = NULL;
|
|
u16 ReasonCode;
|
|
|
|
if (skb->len < sizeof( struct rtllib_hdr_3addr) + 9)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BARSP(%d / %d)\n", (int)skb->len, (int)(sizeof( struct rtllib_hdr_3addr) + 9));
|
|
return -1;
|
|
}
|
|
rsp = ( struct rtllib_hdr_3addr*)skb->data;
|
|
tag = (u8*)rsp;
|
|
dst = (u8*)(&rsp->addr2[0]);
|
|
tag += sizeof( struct rtllib_hdr_3addr);
|
|
pDialogToken = tag + 2;
|
|
pStatusCode = (u16*)(tag + 3);
|
|
pBaParamSet = (union ba_param_set *)(tag + 5);
|
|
pBaTimeoutVal = (u16*)(tag + 7);
|
|
|
|
RT_TRACE(COMP_DBG, "====>rx ADDBARSP from :"MAC_FMT"\n", MAC_ARG(dst));
|
|
if (
|
|
ieee->current_network.qos_data.active == 0 ||
|
|
ieee->pHTInfo->bCurrentHTSupport == false ||
|
|
ieee->pHTInfo->bCurrentAMPDUEnable == false )
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_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);
|
|
ReasonCode = DELBA_REASON_UNKNOWN_BA;
|
|
goto OnADDBARsp_Reject;
|
|
}
|
|
|
|
|
|
if (!GetTs(ieee, (struct ts_common_info **)(&pTS), dst,
|
|
(u8)(pBaParamSet->field.TID), TX_DIR, false)) {
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __func__);
|
|
ReasonCode = DELBA_REASON_UNKNOWN_BA;
|
|
goto OnADDBARsp_Reject;
|
|
}
|
|
|
|
pTS->bAddBaReqInProgress = false;
|
|
pPendingBA = &pTS->TxPendingBARecord;
|
|
pAdmittedBA = &pTS->TxAdmittedBARecord;
|
|
|
|
|
|
if ((pAdmittedBA->bValid==true))
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. Drop because already admit it! \n");
|
|
return -1;
|
|
}
|
|
else if ((pPendingBA->bValid == false) ||(*pDialogToken != pPendingBA->DialogToken))
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "OnADDBARsp(): Recv ADDBA Rsp. BA invalid, DELBA! \n");
|
|
ReasonCode = DELBA_REASON_UNKNOWN_BA;
|
|
goto OnADDBARsp_Reject;
|
|
}
|
|
else
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA is admitted! Status code:%X\n", *pStatusCode);
|
|
DeActivateBAEntry(ieee, pPendingBA);
|
|
}
|
|
|
|
|
|
if (*pStatusCode == ADDBA_STATUS_SUCCESS)
|
|
{
|
|
if (pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED)
|
|
{
|
|
pTS->bAddBaReqDelayed = true;
|
|
DeActivateBAEntry(ieee, pAdmittedBA);
|
|
ReasonCode = DELBA_REASON_END_BA;
|
|
goto OnADDBARsp_Reject;
|
|
}
|
|
|
|
|
|
pAdmittedBA->DialogToken = *pDialogToken;
|
|
pAdmittedBA->BaTimeoutValue = *pBaTimeoutVal;
|
|
pAdmittedBA->BaStartSeqCtrl = pPendingBA->BaStartSeqCtrl;
|
|
pAdmittedBA->BaParamSet = *pBaParamSet;
|
|
DeActivateBAEntry(ieee, pAdmittedBA);
|
|
ActivateBAEntry(ieee, pAdmittedBA, *pBaTimeoutVal);
|
|
} else {
|
|
pTS->bAddBaReqDelayed = true;
|
|
pTS->bDisable_AddBa = true;
|
|
ReasonCode = DELBA_REASON_END_BA;
|
|
goto OnADDBARsp_Reject;
|
|
}
|
|
|
|
return 0;
|
|
|
|
OnADDBARsp_Reject:
|
|
{
|
|
struct ba_record BA;
|
|
BA.BaParamSet = *pBaParamSet;
|
|
rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
|
|
return 0;
|
|
}
|
|
|
|
}
|
|
|
|
int rtllib_rx_DELBA(struct rtllib_device* ieee,struct sk_buff *skb)
|
|
{
|
|
struct rtllib_hdr_3addr* delba = NULL;
|
|
union delba_param_set *pDelBaParamSet = NULL;
|
|
u16* pReasonCode = NULL;
|
|
u8* dst = NULL;
|
|
|
|
if (skb->len < sizeof( struct rtllib_hdr_3addr) + 6)
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in DELBA(%d / %d)\n", (int)skb->len, (int)(sizeof( struct rtllib_hdr_3addr) + 6));
|
|
return -1;
|
|
}
|
|
|
|
if (
|
|
ieee->current_network.qos_data.active == 0 ||
|
|
ieee->pHTInfo->bCurrentHTSupport == false )
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "received DELBA while QOS or HT is not supported(%d, %d)\n",ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport);
|
|
return -1;
|
|
}
|
|
|
|
RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
|
|
delba = ( struct rtllib_hdr_3addr*)skb->data;
|
|
dst = (u8*)(&delba->addr2[0]);
|
|
delba += sizeof( struct rtllib_hdr_3addr);
|
|
pDelBaParamSet = (union delba_param_set *)(delba+2);
|
|
pReasonCode = (u16*)(delba+4);
|
|
|
|
if (pDelBaParamSet->field.Initiator == 1)
|
|
{
|
|
struct rx_ts_record *pRxTs;
|
|
|
|
if ( !GetTs(
|
|
ieee,
|
|
(struct ts_common_info **)&pRxTs,
|
|
dst,
|
|
(u8)pDelBaParamSet->field.TID,
|
|
RX_DIR,
|
|
false) )
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for RXTS in %s().dst:"MAC_FMT" TID:%d\n", __func__, MAC_ARG(dst), (u8)pDelBaParamSet->field.TID);
|
|
return -1;
|
|
}
|
|
|
|
RxTsDeleteBA(ieee, pRxTs);
|
|
}
|
|
else
|
|
{
|
|
struct tx_ts_record *pTxTs;
|
|
|
|
if (!GetTs(
|
|
ieee,
|
|
(struct ts_common_info **)&pTxTs,
|
|
dst,
|
|
(u8)pDelBaParamSet->field.TID,
|
|
TX_DIR,
|
|
false) )
|
|
{
|
|
RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS for TXTS in %s()\n", __func__);
|
|
return -1;
|
|
}
|
|
|
|
pTxTs->bUsingBa = false;
|
|
pTxTs->bAddBaReqInProgress = false;
|
|
pTxTs->bAddBaReqDelayed = false;
|
|
del_timer_sync(&pTxTs->TsAddBaTimer);
|
|
TxTsDeleteBA(ieee, pTxTs);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
TsInitAddBA(
|
|
struct rtllib_device* ieee,
|
|
struct tx_ts_record *pTS,
|
|
u8 Policy,
|
|
u8 bOverwritePending
|
|
)
|
|
{
|
|
struct ba_record *pBA = &pTS->TxPendingBARecord;
|
|
|
|
if (pBA->bValid==true && bOverwritePending==false)
|
|
return;
|
|
|
|
DeActivateBAEntry(ieee, pBA);
|
|
|
|
pBA->DialogToken++;
|
|
pBA->BaParamSet.field.AMSDU_Support = 0;
|
|
pBA->BaParamSet.field.BAPolicy = Policy;
|
|
pBA->BaParamSet.field.TID = pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID;
|
|
pBA->BaParamSet.field.BufferSize = 32;
|
|
pBA->BaTimeoutValue = 0;
|
|
pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096;
|
|
|
|
ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
|
|
|
|
rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
|
|
}
|
|
|
|
void
|
|
TsInitDelBA( struct rtllib_device* ieee, struct ts_common_info *pTsCommonInfo, enum tr_select TxRxSelect)
|
|
{
|
|
|
|
if (TxRxSelect == TX_DIR)
|
|
{
|
|
struct tx_ts_record *pTxTs = (struct tx_ts_record *)pTsCommonInfo;
|
|
|
|
if (TxTsDeleteBA(ieee, pTxTs))
|
|
rtllib_send_DELBA(
|
|
ieee,
|
|
pTsCommonInfo->Addr,
|
|
(pTxTs->TxAdmittedBARecord.bValid)?(&pTxTs->TxAdmittedBARecord):(&pTxTs->TxPendingBARecord),
|
|
TxRxSelect,
|
|
DELBA_REASON_END_BA);
|
|
}
|
|
else if (TxRxSelect == RX_DIR)
|
|
{
|
|
struct rx_ts_record *pRxTs = (struct rx_ts_record *)pTsCommonInfo;
|
|
if (RxTsDeleteBA(ieee, pRxTs))
|
|
rtllib_send_DELBA(
|
|
ieee,
|
|
pTsCommonInfo->Addr,
|
|
&pRxTs->RxAdmittedBARecord,
|
|
TxRxSelect,
|
|
DELBA_REASON_END_BA );
|
|
}
|
|
}
|
|
void BaSetupTimeOut(unsigned long data)
|
|
{
|
|
struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
|
|
|
|
pTxTs->bAddBaReqInProgress = false;
|
|
pTxTs->bAddBaReqDelayed = true;
|
|
pTxTs->TxPendingBARecord.bValid = false;
|
|
}
|
|
|
|
void TxBaInactTimeout(unsigned long data)
|
|
{
|
|
struct tx_ts_record *pTxTs = (struct tx_ts_record *)data;
|
|
struct rtllib_device *ieee = container_of(pTxTs, struct rtllib_device, TxTsRecord[pTxTs->num]);
|
|
TxTsDeleteBA(ieee, pTxTs);
|
|
rtllib_send_DELBA(
|
|
ieee,
|
|
pTxTs->TsCommonInfo.Addr,
|
|
&pTxTs->TxAdmittedBARecord,
|
|
TX_DIR,
|
|
DELBA_REASON_TIMEOUT);
|
|
}
|
|
|
|
void RxBaInactTimeout(unsigned long data)
|
|
{
|
|
struct rx_ts_record *pRxTs = (struct rx_ts_record *)data;
|
|
struct rtllib_device *ieee = container_of(pRxTs, struct rtllib_device, RxTsRecord[pRxTs->num]);
|
|
|
|
RxTsDeleteBA(ieee, pRxTs);
|
|
rtllib_send_DELBA(
|
|
ieee,
|
|
pRxTs->TsCommonInfo.Addr,
|
|
&pRxTs->RxAdmittedBARecord,
|
|
RX_DIR,
|
|
DELBA_REASON_TIMEOUT);
|
|
return ;
|
|
}
|