/*==========================================================================
FUNCTION WDA_DS_GetFrameTypeSubType
DESCRIPTION
Get typeSubtype from the packet. The BD header should have this.
But some reason, Libra/Volans read it from 802.11 header and save it
back to BD header. So for NON integrated SOC, this function does
the same.
For integrated SOC, WDI does the same, not TL.
It does return typeSubtype from RX meta info for integrated SOC.
DEPENDENCIES
PARAMETERS
IN
pvosGCtx VOS context
vosDataBuff vos data buffer
pRxHeader RX meta info or BD header pointer
OUT
ucTypeSubtype typeSubtype
RETURN VALUE
VOS_STATUS_E_FAULT: pointer is NULL and other errors
VOS_STATUS_SUCCESS: Everything is good :)
SIDE EFFECTS
============================================================================*/
VOS_STATUS
WDA_DS_GetFrameTypeSubType
(
v_PVOID_t pvosGCtx,
vos_pkt_t *vosDataBuff,
v_PVOID_t pRxHeader,
v_U8_t *ucTypeSubtype
)
{
#if defined( FEATURE_WLAN_INTEGRATED_SOC )
/*------------------------------------------------------------------------
Sanity check
------------------------------------------------------------------------*/
if ( NULL == pRxHeader )
{
VOS_TRACE( VOS_MODULE_ID_WDA, VOS_TRACE_LEVEL_ERROR,
"WDA:Invalid parameter sent on WDA_DS_GetFrameTypeSubType" );
return VOS_STATUS_E_FAULT;
}
*ucTypeSubtype = ( WDA_GET_RX_TYPE( pRxHeader ) << 4 ) | WDA_GET_RX_SUBTYPE( pRxHeader );
return VOS_STATUS_SUCCESS;
#else /* FEATURE_WLAN_INTEGRATED_SOC */
v_PVOID_t pvBDHeader = pRxHeader;
v_U16_t usFrmCtrl = 0;
v_U8_t ucFrmType;
v_SIZE_t usFrmCtrlSize = sizeof(usFrmCtrl);
VOS_STATUS vosStatus;
/*---------------------------------------------------------------------
Extract frame control field from 802.11 header if present
(frame translation not done)
---------------------------------------------------------------------*/
vosStatus = vos_pkt_extract_data( vosDataBuff,
( 0 == WLANHAL_RX_BD_GET_FT(pvBDHeader) ) ?
WLANHAL_RX_BD_GET_MPDU_H_OFFSET(pvBDHeader):
WLANHAL_RX_BD_HEADER_SIZE,
&usFrmCtrl, &usFrmCtrlSize );
if (( VOS_STATUS_SUCCESS != vosStatus ) ||
( sizeof(usFrmCtrl) != usFrmCtrlSize ))
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL: Cannot extract Frame Control Field" );
return VOS_STATUS_E_FAILURE;
}
ucFrmType = (v_U8_t)WLANHAL_RxBD_GetFrameTypeSubType( pvBDHeader,
usFrmCtrl);
WLANHAL_RX_BD_SET_TYPE_SUBTYPE(pvBDHeader, ucFrmType);
*ucTypeSubtype = ucFrmType;
return VOS_STATUS_SUCCESS;
#endif /* FEATURE_WLAN_INTEGRATED_SOC */
}
/*==========================================================================
FUNCTION WDA_DS_BuildTxPacketInfo
DESCRIPTION
Build TX meta info for integrated SOC.
Same function calls HAL for reserve BD header space into VOS packet and
HAL function to fill it.
DEPENDENCIES
PARAMETERS
IN
pvosGCtx VOS context
vosDataBuff vos data buffer
pvDestMacAddr destination MAC address ponter
ucDisableFrmXtl Is frame xtl disabled?
ucQosEnabled Is QoS enabled?
ucWDSEnabled Is WDS enabled?
extraHeadSpace Extra head bytes. If it's not 0 due to 4 bytes align
of BD header.
typeSubtype typeSubtype from MAC header or TX metainfo/BD
pAddr2 address 2
uTid tid
txFlag
timeStamp
ucIsEapol
ucUP
OUT
*pusPktLen Packet length
RETURN VALUE
VOS_STATUS_E_FAULT: pointer is NULL and other errors
VOS_STATUS_SUCCESS: Everything is good :)
SIDE EFFECTS
============================================================================*/
VOS_STATUS
WDA_DS_BuildTxPacketInfo
(
v_PVOID_t pvosGCtx,
vos_pkt_t* vosDataBuff,
v_MACADDR_t* pvDestMacAddr,
v_U8_t ucDisableFrmXtl,
v_U16_t* pusPktLen,
v_U8_t ucQosEnabled,
v_U8_t ucWDSEnabled,
v_U8_t extraHeadSpace,
v_U8_t typeSubtype,
v_PVOID_t pAddr2,
v_U8_t uTid,
v_U32_t txFlag,
v_U32_t timeStamp,
v_U8_t ucIsEapol,
v_U8_t ucUP
)
{
VOS_STATUS vosStatus;
WDI_DS_TxMetaInfoType* pTxMetaInfo = NULL;
v_SIZE_t usMacAddrSize;
wpt_FrameCtrl *pFrameControl;
/*- - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -*/
/*------------------------------------------------------------------------
Sanity check
Extract TL control block
------------------------------------------------------------------------*/
if ( ( NULL == pvosGCtx ) || ( NULL == vosDataBuff ) || ( NULL == pvDestMacAddr ) )
{
VOS_TRACE( VOS_MODULE_ID_WDA, VOS_TRACE_LEVEL_ERROR,
"WDA:Invalid parameter sent on WDA_DS_BuildTxPacketInfo" );
return VOS_STATUS_E_FAULT;
}
/*------------------------------------------------------------------------
Extract TX Meta Info pointer from PAL packet
------------------------------------------------------------------------*/
pTxMetaInfo = WDI_DS_ExtractTxMetaData( VOS_TO_WPAL_PKT(vosDataBuff) );
if ( NULL == pTxMetaInfo )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:Invalid RxMetaInfo pointer from PAL packet on WLANTL_RxFrames");
VOS_ASSERT( 0 );
return VOS_STATUS_E_FAULT;
}
/* Zero out memeory */
vos_mem_zero( pTxMetaInfo, sizeof( WDI_DS_TxMetaInfoType ) );
/* Fill the TX Meta info */
pTxMetaInfo->txFlags = txFlag;
pTxMetaInfo->qosEnabled = ucQosEnabled;
pTxMetaInfo->fenableWDS = ucWDSEnabled;
pTxMetaInfo->ac = ucUP;
pTxMetaInfo->fUP = uTid;
pTxMetaInfo->isEapol = ucIsEapol;
pTxMetaInfo->fdisableFrmXlt = ucDisableFrmXtl;
pTxMetaInfo->frmType = ( ( typeSubtype & 0x30 ) >> 4 );
pTxMetaInfo->typeSubtype = typeSubtype;
/* Length = MAC header + payload */
vos_pkt_get_packet_length( vosDataBuff, pusPktLen);
pTxMetaInfo->fPktlen = *pusPktLen;
/* For management frames, peek into Frame Control
field to get value of Protected Frame bit */
pTxMetaInfo->fProtMgmtFrame = 0;
if ( WDA_TLI_MGMT_FRAME_TYPE == pTxMetaInfo->frmType )
{
if ( 1 == ucDisableFrmXtl ) /* should be 802.11, but check */
{
vosStatus = vos_pkt_peek_data( vosDataBuff, 0, (v_PVOID_t)&pFrameControl,
sizeof( wpt_FrameCtrl ));
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WDA: Failed while attempting to extract Protect Bit in "
"Frame Control, status %d", vosStatus );
VOS_ASSERT( 0 );
return VOS_STATUS_E_FAULT;
}
pTxMetaInfo->fProtMgmtFrame = pFrameControl->wep;
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_INFO_LOW,
"WLAN TL: fProtMgmtFrame:%d", pTxMetaInfo->fProtMgmtFrame );
}
}
// Dst address
usMacAddrSize = VOS_MAC_ADDR_SIZE;
vosStatus = vos_pkt_extract_data( vosDataBuff,
WLANTL_MAC_ADDR_ALIGN( ucDisableFrmXtl ),
(v_PVOID_t)pvDestMacAddr,
&usMacAddrSize );
if ((VOS_STATUS_SUCCESS != vosStatus) ||
(usMacAddrSize != VOS_MAC_ADDR_SIZE))
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WDA:Failed while attempting to extract MAC Addr %d",
vosStatus );
VOS_ASSERT( 0 );
return VOS_STATUS_E_FAULT;
}
vos_copy_macaddr( (v_MACADDR_t*)pTxMetaInfo->fSTAMACAddress, pvDestMacAddr );
// ADDR2
vos_copy_macaddr( (v_MACADDR_t*)pTxMetaInfo->addr2MACAddress, pAddr2 );
/* Dump TX meta infro for debugging */
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_INFO_LOW,
"WLAN TL: Dump TX meta info: "
"txFlags:%d, qosEnabled:%d, ac:%d, "
"isEapol:%d, fdisableFrmXlt:%d, frmType:%d",
pTxMetaInfo->txFlags, ucQosEnabled, pTxMetaInfo->ac,
pTxMetaInfo->isEapol, pTxMetaInfo->fdisableFrmXlt,
pTxMetaInfo->frmType );
return VOS_STATUS_SUCCESS;
}
/*==========================================================================
FUNCTION WDA_DS_BuildTxPacketInfo
DESCRIPTION
Build TX meta info for integrated SOC.
Same function calls HAL for reserve BD header space into VOS packet and
HAL function to fill it.
DEPENDENCIES
PARAMETERS
IN
pvosGCtx VOS context
vosDataBuff vos data buffer
pvDestMacAddr destination MAC address ponter
ucDisableFrmXtl Is frame xtl disabled?
ucQosEnabled Is QoS enabled?
ucWDSEnabled Is WDS enabled?
extraHeadSpace Extra head bytes. If it's not 0 due to 4 bytes align
of BD header.
typeSubtype typeSubtype from MAC header or TX metainfo/BD
pAddr2 address 2
uTid tid
txFlag
timeStamp
ucIsEapol
ucUP
OUT
*pusPktLen Packet length
RETURN VALUE
VOS_STATUS_E_FAULT: pointer is NULL and other errors
VOS_STATUS_SUCCESS: Everything is good :)
SIDE EFFECTS
============================================================================*/
VOS_STATUS
WDA_DS_BuildTxPacketInfo
(
v_PVOID_t pvosGCtx,
vos_pkt_t* vosDataBuff,
v_MACADDR_t* pvDestMacAddr,
v_U8_t ucDisableFrmXtl,
v_U16_t* pusPktLen,
v_U8_t ucQosEnabled,
v_U8_t ucWDSEnabled,
v_U8_t extraHeadSpace,
v_U8_t typeSubtype,
v_PVOID_t pAddr2,
v_U8_t uTid,
v_U8_t txFlag,
v_U32_t timeStamp,
v_U8_t ucIsEapol,
v_U8_t ucUP
)
{
#if defined( FEATURE_WLAN_INTEGRATED_SOC )
VOS_STATUS vosStatus;
WDI_DS_TxMetaInfoType* pTxMetaInfo = NULL;
v_SIZE_t usMacAddrSize;
/*- - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -*/
/*------------------------------------------------------------------------
Sanity check
Extract TL control block
------------------------------------------------------------------------*/
if ( ( NULL == pvosGCtx ) || ( NULL == vosDataBuff ) || ( NULL == pvDestMacAddr ) )
{
VOS_TRACE( VOS_MODULE_ID_WDA, VOS_TRACE_LEVEL_ERROR,
"WDA:Invalid parameter sent on WDA_DS_BuildTxPacketInfo" );
return VOS_STATUS_E_FAULT;
}
/*------------------------------------------------------------------------
Extract TX Meta Info pointer from PAL packet
------------------------------------------------------------------------*/
pTxMetaInfo = WDI_DS_ExtractTxMetaData( VOS_TO_WPAL_PKT(vosDataBuff) );
if ( NULL == pTxMetaInfo )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:Invalid RxMetaInfo pointer from PAL packet on WLANTL_RxFrames");
VOS_ASSERT( 0 );
return VOS_STATUS_E_FAULT;
}
/* Zero out memeory */
vos_mem_zero( pTxMetaInfo, sizeof( WDI_DS_TxMetaInfoType ) );
/* Fill the TX Meta info */
pTxMetaInfo->txFlags = txFlag;
pTxMetaInfo->qosEnabled = ucQosEnabled;
pTxMetaInfo->fenableWDS = ucWDSEnabled;
pTxMetaInfo->ac = ucUP;
pTxMetaInfo->fUP = uTid;
pTxMetaInfo->isEapol = ucIsEapol;
pTxMetaInfo->fdisableFrmXlt = ucDisableFrmXtl;
pTxMetaInfo->frmType = ( ( typeSubtype & 0x30 ) >> 4 );
pTxMetaInfo->typeSubtype = typeSubtype;
/* Length = MAC header + payload */
vos_pkt_get_packet_length( vosDataBuff, pusPktLen);
pTxMetaInfo->fPktlen = *pusPktLen;
// Dst address
usMacAddrSize = VOS_MAC_ADDR_SIZE;
vosStatus = vos_pkt_extract_data( vosDataBuff,
WLANTL_MAC_ADDR_ALIGN( ucDisableFrmXtl ),
(v_PVOID_t)pvDestMacAddr,
&usMacAddrSize );
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WDA:Failed while attempting to extract MAC Addr %d",
vosStatus );
VOS_ASSERT( 0 );
return VOS_STATUS_E_FAULT;
}
VOS_ASSERT(usMacAddrSize == VOS_MAC_ADDR_SIZE);
vos_copy_macaddr( (v_MACADDR_t*)pTxMetaInfo->fSTAMACAddress, pvDestMacAddr );
// ADDR2
vos_copy_macaddr( (v_MACADDR_t*)pTxMetaInfo->addr2MACAddress, pAddr2 );
/* Dump TX meta infro for debugging */
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_INFO_LOW,
"WLAN TL: Dump TX meta info: "
"txFlags:%d, qosEnabled:%d, ac:%d, "
"isEapol:%d, fdisableFrmXlt:%d" "frmType%d",
pTxMetaInfo->txFlags, ucQosEnabled, pTxMetaInfo->ac,
pTxMetaInfo->isEapol, pTxMetaInfo->fdisableFrmXlt, pTxMetaInfo->frmType );
return VOS_STATUS_SUCCESS;
#else /* FEATURE_WLAN_INTEGRATED_SOC */
VOS_STATUS vosStatus;
v_PVOID_t pvBDHeader;
WDA_DS_PrepareBDHeader( vosDataBuff, &pvBDHeader, pvDestMacAddr, ucDisableFrmXtl,
&vosStatus, pusPktLen, ucQosEnabled, ucWDSEnabled, extraHeadSpace );
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:Failed while attempting to prepare BD %d", vosStatus );
return vosStatus;
}
vosStatus = WLANHAL_FillTxBd( pvosGCtx, typeSubtype, pvDestMacAddr, pAddr2,
&uTid, ucDisableFrmXtl, pvBDHeader, txFlag, timeStamp );
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:Failed while attempting to fill BD %d", vosStatus );
return vosStatus;
}
return VOS_STATUS_SUCCESS;
#endif /* FEATURE_WLAN_INTEGRATED_SOC */
}
/*==========================================================================
FUNCTION WDA_DS_PrepareBDHeader
DESCRIPTION
Inline function for preparing BD header before HAL processing.
DEPENDENCIES
Just notify HAL that suspend in TL is complete.
PARAMETERS
IN
vosDataBuff: vos data buffer
ucDisableFrmXtl: is frame xtl disabled
OUT
ppvBDHeader: it will contain the BD header
pvDestMacAddr: it will contain the destination MAC address
pvosStatus: status of the combined processing
pusPktLen: packet len.
RETURN VALUE
No return.
SIDE EFFECTS
============================================================================*/
void
WDA_DS_PrepareBDHeader
(
vos_pkt_t* vosDataBuff,
v_PVOID_t* ppvBDHeader,
v_MACADDR_t* pvDestMacAddr,
v_U8_t ucDisableFrmXtl,
VOS_STATUS* pvosStatus,
v_U16_t* pusPktLen,
v_U8_t ucQosEnabled,
v_U8_t ucWDSEnabled,
v_U8_t extraHeadSpace
)
{
v_U8_t ucHeaderOffset;
v_U8_t ucHeaderLen;
#ifndef WLAN_SOFTAP_FEATURE
v_PVOID_t pvPeekData;
#endif
v_U8_t ucBDHeaderLen = WLANTL_BD_HEADER_LEN(ucDisableFrmXtl);
/*- - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -*/
/*-------------------------------------------------------------------------
Get header pointer from VOSS
!!! make sure reserve head zeros out the memory
-------------------------------------------------------------------------*/
vos_pkt_get_packet_length( vosDataBuff, pusPktLen);
if ( WLANTL_MAC_HEADER_LEN(ucDisableFrmXtl) > *pusPktLen )
{
TLLOGE(VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL: Length of the packet smaller than expected network"
" header %d", *pusPktLen ));
*pvosStatus = VOS_STATUS_E_INVAL;
return;
}
vos_pkt_reserve_head( vosDataBuff, ppvBDHeader,
ucBDHeaderLen );
if ( NULL == *ppvBDHeader )
{
TLLOGE(VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:VOSS packet corrupted on Attach BD header"));
*pvosStatus = VOS_STATUS_E_INVAL;
return;
}
/*-----------------------------------------------------------------------
Extract MAC address
-----------------------------------------------------------------------*/
#ifdef WLAN_SOFTAP_FEATURE
{
v_SIZE_t usMacAddrSize = VOS_MAC_ADDR_SIZE;
*pvosStatus = vos_pkt_extract_data( vosDataBuff,
ucBDHeaderLen +
WLANTL_MAC_ADDR_ALIGN(ucDisableFrmXtl),
(v_PVOID_t)pvDestMacAddr,
&usMacAddrSize );
}
#else
*pvosStatus = vos_pkt_peek_data( vosDataBuff,
ucBDHeaderLen +
WLANTL_MAC_ADDR_ALIGN(ucDisableFrmXtl),
(v_PVOID_t)&pvPeekData,
VOS_MAC_ADDR_SIZE );
/*Fix me*/
vos_copy_macaddr(pvDestMacAddr, (v_MACADDR_t*)pvPeekData);
#endif
if ( VOS_STATUS_SUCCESS != *pvosStatus )
{
TLLOGE(VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:Failed while attempting to extract MAC Addr %d",
*pvosStatus));
}
else
{
/*---------------------------------------------------------------------
Fill MPDU info fields:
- MPDU data start offset
- MPDU header start offset
- MPDU header length
- MPDU length - this is a 16b field - needs swapping
--------------------------------------------------------------------*/
ucHeaderOffset = ucBDHeaderLen;
ucHeaderLen = WLANTL_MAC_HEADER_LEN(ucDisableFrmXtl);
if ( 0 != ucDisableFrmXtl )
{
if ( 0 != ucQosEnabled )
{
ucHeaderLen += WLANTL_802_11_HEADER_QOS_CTL;
}
// Similar to Qos we need something for WDS format !
if ( ucWDSEnabled != 0 )
{
// If we have frame translation enabled
ucHeaderLen += WLANTL_802_11_HEADER_ADDR4_LEN;
}
if ( extraHeadSpace != 0 )
{
// Decrease the packet length with the extra padding after the header
*pusPktLen = *pusPktLen - extraHeadSpace;
}
}
WLANHAL_TX_BD_SET_MPDU_HEADER_LEN( *ppvBDHeader, ucHeaderLen);
WLANHAL_TX_BD_SET_MPDU_HEADER_OFFSET( *ppvBDHeader, ucHeaderOffset);
WLANHAL_TX_BD_SET_MPDU_DATA_OFFSET( *ppvBDHeader,
ucHeaderOffset + ucHeaderLen + extraHeadSpace);
WLANHAL_TX_BD_SET_MPDU_LEN( *ppvBDHeader, *pusPktLen);
TLLOG2(VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_INFO_HIGH,
"WLAN TL: VALUES ARE HLen=%x Hoff=%x doff=%x len=%x ex=%d",
ucHeaderLen, ucHeaderOffset,
(ucHeaderOffset + ucHeaderLen + extraHeadSpace),
*pusPktLen, extraHeadSpace));
}/* if peek MAC success*/
}/* WLANTL_PrepareBDHeader */
/*----------------------------------------------------------------------------
FUNCTION WLANBAP_STARxCB
DESCRIPTION
The receive callback registered with TL.
TL will call this to notify the client when a packet was received
for a registered STA.
PARAMETERS
IN
pvosGCtx: pointer to the global vos context; a handle to
TL's or HDD's control block can be extracted from
its context
vosDataBuff: pointer to the VOSS data buffer that was received
(it may be a linked list)
ucSTAId: station id
pRxMetaInfo: meta info for the received packet(s)
RETURN VALUE
The result code associated with performing the operation
----------------------------------------------------------------------------*/
VOS_STATUS
WLANBAP_STARxCB
(
v_PVOID_t pvosGCtx,
vos_pkt_t* vosDataBuff,
v_U8_t ucSTAId,
WLANTL_RxMetaInfoType* pRxMetaInfo
)
{
VOS_STATUS vosStatus;
ptBtampHandle bapHdl; /* holds ptBtampHandle value returned */
ptBtampContext bapContext; /* Holds the btampContext value returned */
v_PVOID_t pHddHdl; /* Handle to return BSL context in */
ptBtampHandle btampHandle;
WLANBAP_8023HeaderType w8023Header;
v_U8_t aucLLCHeader[WLANBAP_LLC_HEADER_LEN];
v_U16_t protoType ;
v_SIZE_t llcHeaderLen = WLANBAP_LLC_HEADER_LEN ;
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"In WLANBAP_STARxCB");
/* Lookup the BSL and BAP contexts using the StaId */
vosStatus = WLANBAP_GetCtxFromStaId (
ucSTAId, /* The StaId (used by TL, PE, and HAL) */
&bapHdl, /* "handle" to return ptBtampHandle value in */
&bapContext, /* "handle" to return ptBtampContext value in */
&pHddHdl); /* "handle" to return BSL context in */
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"Unable to retrieve BSL or BAP context from STA Id in WLANBAP_STARxCB");
/* Drop packet */
vos_pkt_return_packet(vosDataBuff);
return VOS_STATUS_E_FAULT;
}
vosStatus = vos_pkt_extract_data( vosDataBuff, sizeof(w8023Header), (v_VOID_t *)aucLLCHeader,
&llcHeaderLen);
if ( NULL == aucLLCHeader/*LLC Header*/ )
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLANBAP_STARxCB:Cannot extract LLC header");
/* Drop packet */
vos_pkt_return_packet(vosDataBuff);
return VOS_STATUS_E_FAULT;
}
vos_mem_copy(&protoType,&aucLLCHeader[WLANBAP_LLC_PROTO_TYPE_OFFSET],WLANBAP_LLC_PROTO_TYPE_SIZE);
protoType = vos_be16_to_cpu(protoType);
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"%s: received : %d, => BAP",__FUNCTION__,
protoType);
if(WLANBAP_BT_AMP_TYPE_DATA == protoType)
{
if (bapContext->bapLinkSupervisionTimerInterval)
{
/* Reset Link Supervision timer */
//vosStatus = WLANBAP_StopLinkSupervisionTimer(bapContext);
//vosStatus = WLANBAP_StartLinkSupervisionTimer(bapContext,7000);
bapContext->dataPktPending = VOS_TRUE;//Indication for LinkSupervision module that data is pending
/* Invoke the callback that BSL registered with me */
vosStatus = (*bapContext->pfnBtamp_STARxCB)(
pHddHdl,
vosDataBuff,
pRxMetaInfo);
}
else
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_FATAL,
"WLANBAP_STARxCB:bapLinkSupervisionTimerInterval is 0");
/* Drop packet */
vos_pkt_return_packet(vosDataBuff);
}
}
else
{
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"%s: link Supervision packet received over TL: %d, => BAP",
__FUNCTION__,protoType);
btampHandle = (ptBtampHandle)bapContext;
vosStatus = WLANBAP_RxProcLsPkt(
btampHandle,
bapContext->phy_link_handle,
protoType,
vosDataBuff
);
}
return vosStatus;
} /* WLANBAP_STARxCB */
/*===========================================================================
FUNCTION WLANBAP_RxProcLsPkt
DESCRIPTION
This API will be called when Link Supervision frames are received at BAP
PARAMETERS
btampHandle: The BT-AMP PAL handle returned in WLANBAP_GetNewHndl.
pucAC: Pointer to return the access category
vosDataBuff: The data buffer containing the 802.3 frame to be
translated to BT HCI Data Packet
RETURN VALUE
The result code associated with performing the operation
VOS_STATUS_E_INVAL: Input parameters are invalid
VOS_STATUS_E_FAULT: BAP handle is NULL
VOS_STATUS_SUCCESS: Everything is good :)
SIDE EFFECTS
============================================================================*/
VOS_STATUS
WLANBAP_RxProcLsPkt
(
ptBtampHandle btampHandle,
v_U8_t phy_link_handle, /* Used by BAP to indentify the WLAN assoc. (StaId) */
v_U16_t RxProtoType, /* Protocol Type from the frame received */
vos_pkt_t *vosRxLsBuff
)
{
VOS_STATUS vosStatus;
ptBtampContext pBtampCtx = (ptBtampContext) btampHandle;
WLANBAP_8023HeaderType w8023Header;
v_SIZE_t HeaderLen = sizeof(w8023Header);
/*------------------------------------------------------------------------
Sanity check params
------------------------------------------------------------------------*/
if ( NULL == pBtampCtx)
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
"Invalid BAP handle value in %s", __FUNCTION__);
return VOS_STATUS_E_FAULT;
}
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
"In %s Received RxProtoType=%x", __FUNCTION__,RxProtoType);
vos_pkt_extract_data(vosRxLsBuff,0,(v_VOID_t*)&w8023Header,&HeaderLen);
if ( !(vos_mem_compare( w8023Header.vDA, pBtampCtx->self_mac_addr, VOS_MAC_ADDR_SIZE)
&& vos_mem_compare( w8023Header.vSA, pBtampCtx->peer_mac_addr, VOS_MAC_ADDR_SIZE)))
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
"MAC address mismatch in %s", __FUNCTION__);
return VOS_STATUS_E_FAULT;
}
/*Free the vos packet*/
vosStatus = vos_pkt_return_packet( vosRxLsBuff );
if ( VOS_STATUS_SUCCESS != vosStatus)
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
"Failed to free VOS packet in %s", __FUNCTION__);
return VOS_STATUS_E_FAULT;
}
/* Reset Link Supervision timer */
if (RxProtoType == WLANTL_BT_AMP_TYPE_LS_REP)
{
pBtampCtx->lsReqPktPending = FALSE;
pBtampCtx->retries = 0;
if (pBtampCtx->bapLinkSupervisionTimerInterval)
{
/* Restart the LS timer */
WLANBAP_StopLinkSupervisionTimer(pBtampCtx);
vosStatus = WLANBAP_StartLinkSupervisionTimer (pBtampCtx,
pBtampCtx->bapLinkSupervisionTimerInterval * WLANBAP_BREDR_BASEBAND_SLOT_TIME);
}
}
else if(RxProtoType == WLANTL_BT_AMP_TYPE_LS_REQ)
{
if (pBtampCtx->bapLinkSupervisionTimerInterval)
{
/* Restart the LS timer */
WLANBAP_StopLinkSupervisionTimer(pBtampCtx);
vosStatus = WLANBAP_StartLinkSupervisionTimer (pBtampCtx,
pBtampCtx->bapLinkSupervisionTimerInterval * WLANBAP_BREDR_BASEBAND_SLOT_TIME);
}
pBtampCtx->pPacket = pBtampCtx->lsRepPacket;
// Handle LS rep frame
vosStatus = WLANBAP_TxLinkSupervision( btampHandle, phy_link_handle, pBtampCtx->pPacket, WLANTL_BT_AMP_TYPE_LS_REP);
}
return vosStatus;
}
