/*---------------------------------------------------------------------------
wpalPacketGetLength – Get number of bytes in a wpt_packet. It include the
bytes in a BD if it exist.
Param:
pPkt - pointer to a packet to be freed.
Return:
Length of the data include layer-2 headers. For example, if the frame
is 802.3, the length includes the ethernet header.
---------------------------------------------------------------------------*/
wpt_uint32 wpalPacketGetLength(wpt_packet *pPkt)
{
v_U16_t len = 0, pktLen = 0;
// Validate the parameter pointers
if (unlikely(NULL == pPkt))
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"%s : NULL packet pointer", __func__);
return eWLAN_PAL_STATUS_E_INVAL;
}
if( WPAL_PACKET_GET_BD_POINTER(pPkt) )
{
len = WPAL_PACKET_GET_BD_LENGTH(pPkt);
}
if( VOS_IS_STATUS_SUCCESS(vos_pkt_get_packet_length(WPAL_TO_VOS_PKT(pPkt), &pktLen)) )
{
len += pktLen;
}
else
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR, "%s failed",
__func__);
}
return ((wpt_uint32)len);
}/*wpalPacketGetLength*/
/*==========================================================================
FUNCTION WDS_DS_TrimRxPacketInfo
DESCRIPTION
Trim/Remove RX BD header for NON integrated SOC.
It does nothing for integrated SOC.
DEPENDENCIES
PARAMETERS
IN
vosDataBuff vos data buffer
RETURN VALUE
VOS_STATUS_E_FAULT: pointer is NULL and other errors
VOS_STATUS_SUCCESS: Everything is good :)
SIDE EFFECTS
============================================================================*/
VOS_STATUS
WDA_DS_TrimRxPacketInfo
(
vos_pkt_t *vosDataBuff
)
{
#if defined( FEATURE_WLAN_INTEGRATED_SOC )
/* Nothing to trim
* Do Nothing */
return VOS_STATUS_SUCCESS;
#else /* FEATURE_WLAN_INTEGRATED_SOC */
VOS_STATUS vosStatus = VOS_STATUS_SUCCESS;
v_U16_t usPktLen;
v_U8_t ucMPDUHOffset;
v_U16_t usMPDUDOffset;
v_U16_t usMPDULen;
v_U8_t ucMPDUHLen = 0;
v_U8_t aucBDHeader[WLANHAL_RX_BD_HEADER_SIZE];
vos_pkt_pop_head( vosDataBuff, aucBDHeader, WLANHAL_RX_BD_HEADER_SIZE);
ucMPDUHOffset = (v_U8_t)WLANHAL_RX_BD_GET_MPDU_H_OFFSET(aucBDHeader);
usMPDUDOffset = (v_U16_t)WLANHAL_RX_BD_GET_MPDU_D_OFFSET(aucBDHeader);
usMPDULen = (v_U16_t)WLANHAL_RX_BD_GET_MPDU_LEN(aucBDHeader);
ucMPDUHLen = (v_U8_t)WLANHAL_RX_BD_GET_MPDU_H_LEN(aucBDHeader);
VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_INFO_HIGH,
"WLAN TL:BD header processing data: HO %d DO %d Len %d HLen %d"
" Tid %d BD %d",
ucMPDUHOffset, usMPDUDOffset, usMPDULen, ucMPDUHLen,
WLANHAL_RX_BD_HEADER_SIZE );
vos_pkt_get_packet_length( vosDataBuff, &usPktLen);
if (( ucMPDUHOffset >= WLANHAL_RX_BD_HEADER_SIZE ) &&
( usMPDUDOffset > ucMPDUHOffset ) &&
( usMPDULen >= ucMPDUHLen ) &&
( usPktLen >= usMPDULen ))
{
if((ucMPDUHOffset - WLANHAL_RX_BD_HEADER_SIZE) > 0)
{
vos_pkt_trim_head( vosDataBuff, ucMPDUHOffset - WLANHAL_RX_BD_HEADER_SIZE);
}
else
{
/* Nothing to trim
* Do Nothing */
}
vosStatus = VOS_STATUS_SUCCESS;
}
else
{
vosStatus = VOS_STATUS_E_FAILURE;
}
return vosStatus;
#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_TLI_FastHwFwdDataFrame
DESCRIPTION
For NON integrated SOC, this function is called by TL.
Fast path function to quickly forward a data frame if HAL determines BD
signature computed here matches the signature inside current VOSS packet.
If there is a match, HAL and TL fills in the swapped packet length into
BD header and DxE header, respectively. Otherwise, packet goes back to
normal (slow) path and a new BD signature would be tagged into BD in this
VOSS packet later by the WLANHAL_FillTxBd() function.
TODO For integrated SOC, this function does nothing yet. Pima SLM/HAL
should provide the equivelant functionality.
DEPENDENCIES
PARAMETERS
IN
pvosGCtx VOS context
vosDataBuff Ptr to VOSS packet
pMetaInfo For getting frame's TID
pStaInfo For checking STA type
OUT
pvosStatus returned status
puFastFwdOK Flag to indicate whether frame could be fast forwarded
RETURN VALUE
No return.
SIDE EFFECTS
============================================================================*/
void WDA_TLI_FastHwFwdDataFrame
(
v_PVOID_t pvosGCtx,
vos_pkt_t* vosDataBuff,
VOS_STATUS* pvosStatus,
v_U32_t* puFastFwdOK,
WLANTL_MetaInfoType* pMetaInfo,
WLAN_STADescType* pStaInfo
)
{
#if defined( FEATURE_WLAN_INTEGRATED_SOC )
/* FIXME WDI/WDA should support this function
once HAL supports it
*/
#else /* FEATURE_WLAN_INTEGRATED_SOC */
v_PVOID_t pvPeekData;
v_U8_t ucDxEBDWLANHeaderLen = WLANTL_BD_HEADER_LEN(0) + sizeof(WLANBAL_sDXEHeaderType);
v_U8_t ucIsUnicast;
WLANBAL_sDXEHeaderType *pDxEHeader;
v_PVOID_t pvBDHeader;
v_PVOID_t pucBuffPtr;
v_U16_t usPktLen;
/*-----------------------------------------------------------------------
Extract packet length
-----------------------------------------------------------------------*/
vos_pkt_get_packet_length( vosDataBuff, &usPktLen);
/*-----------------------------------------------------------------------
Extract MAC address
-----------------------------------------------------------------------*/
*pvosStatus = vos_pkt_peek_data( vosDataBuff,
WLANTL_MAC_ADDR_ALIGN(0),
(v_PVOID_t)&pvPeekData,
VOS_MAC_ADDR_SIZE );
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));
*pvosStatus = VOS_STATUS_E_INVAL;
return;
}
/*-----------------------------------------------------------------------
Reserve head room for DxE header, BD, and WLAN header
-----------------------------------------------------------------------*/
vos_pkt_reserve_head( vosDataBuff, &pucBuffPtr,
ucDxEBDWLANHeaderLen );
if ( NULL == pucBuffPtr )
{
TLLOGE(VOS_TRACE( VOS_MODULE_ID_TL, VOS_TRACE_LEVEL_ERROR,
"WLAN TL:No enough space in VOSS packet %p for DxE/BD/WLAN header", vosDataBuff));
*pvosStatus = VOS_STATUS_E_INVAL;
return;
}
pDxEHeader = (WLANBAL_sDXEHeaderType *)pucBuffPtr;
pvBDHeader = (v_PVOID_t) &pDxEHeader[1];
/* UMA Tx acceleration is enabled.
* UMA would help convert frames to 802.11, fill partial BD fields and
* construct LLC header. To further accelerate this kind of frames,
* HAL would attempt to reuse the BD descriptor if the BD signature
* matches to the saved BD descriptor.
*/
if(pStaInfo->wSTAType == WLAN_STA_IBSS)
ucIsUnicast = !(((tANI_U8 *)pvPeekData)[0] & 0x01);
else
ucIsUnicast = 1;
*puFastFwdOK = (v_U32_t) WLANHAL_TxBdFastFwd(pvosGCtx, pvPeekData, pMetaInfo->ucTID, ucIsUnicast, pvBDHeader, usPktLen );
/* Can't be fast forwarded. Trim the VOS head back to original location. */
if(! *puFastFwdOK){
vos_pkt_trim_head(vosDataBuff, ucDxEBDWLANHeaderLen);
}else{
/* could be fast forwarded. Now notify BAL DxE header filling could be completely skipped
*/
v_U32_t uPacketSize = WLANTL_BD_HEADER_LEN(0) + usPktLen;
vos_pkt_set_user_data_ptr( vosDataBuff, VOS_PKT_USER_DATA_ID_BAL,
(v_PVOID_t)uPacketSize);
pDxEHeader->size = SWAP_ENDIAN_UINT32(uPacketSize);
}
*pvosStatus = VOS_STATUS_SUCCESS;
return;
#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 */
/*---------------------------------------------------------------------------
wpalLockPacketForTransfer – Map the data buffer from dma so that the
data is commited from cache and the cpu relinquishes
ownership of the buffer
Param:
pPacket – pointer to a wpt_packet
Return:
eWLAN_PAL_STATUS_SUCCESS - success
---------------------------------------------------------------------------*/
wpt_status wpalLockPacketForTransfer( wpt_packet *pPacket)
{
void* pPhyData = NULL;
wpt_iterator_info* pInfo = NULL;
v_U16_t uLenData = 0;
// Validate the parameter pointers
if (unlikely(NULL == pPacket))
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"%s : NULL input pointer", __func__);
return eWLAN_PAL_STATUS_E_INVAL;
}
switch(WPAL_PACKET_GET_TYPE(pPacket))
{
/* For management frames, BD is allocated by WDI, header is in raw buffer,
rest of the frame is also in raw buffer */
case eWLAN_PAL_PKT_TYPE_TX_802_11_MGMT:
{
/*TX Packets need to be DMA-ed to the device, perform DMA mapping
accordingly */
pPhyData = (void*)itGetOSPktAddrForDevice( pPacket );
}
break;
/* Data packets - BD (allocated by WDI), header (in VOSS header),
rest of the packet (DSM items) */
case eWLAN_PAL_PKT_TYPE_TX_802_11_DATA:
case eWLAN_PAL_PKT_TYPE_TX_802_3_DATA:
{
/*TX Packets need to be DMA-ed to the device, perform DMA mapping
accordingly */
pPhyData = (void*)itGetOSPktAddrForDevice( pPacket );
}
break;
/* For Raw RX, BD + header + rest of the packet is all contained in the raw
buffer */
case eWLAN_PAL_PKT_TYPE_RX_RAW:
{
/*RX Packets need to be DMA-ed from the device, perform DMA mapping
accordingly */
pPhyData = (void*)itGetOSPktAddrFromDevice( pPacket );
}
break;
default:
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
" WLAN_PAL: %s: Invalid packet type %d!", __func__,
WPAL_PACKET_GET_TYPE(pPacket) );
WPAL_ASSERT(0);
return eWLAN_PAL_STATUS_E_FAILURE;
}
}
/*Get packet length*/
vos_pkt_get_packet_length(WPAL_TO_VOS_PKT(pPacket),&uLenData);
/*Allocate memory for the current info*/
pInfo = wpalMemoryAllocate( sizeof(wpt_iterator_info) );
// Validate the memory allocation
if (unlikely(NULL == pInfo))
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"%s : Failed to allocate memory ", __func__);
return eWLAN_PAL_STATUS_E_INVAL;
}
pInfo->pPhyAddr = pPhyData;
pInfo->uLen = uLenData;
pPacket->pInternalData = pInfo;
return eWLAN_PAL_STATUS_SUCCESS;
}/*wpalLockPacketForTransfer*/
/*---------------------------------------------------------------------------
wpalPacketAlloc – Allocate a wpt_packet from PAL.
Param:
pktType – specify the type of wpt_packet to allocate
nPktSize - packet size
Return:
A pointer to the wpt_packet. NULL means fail.
---------------------------------------------------------------------------*/
wpt_packet * wpalPacketAlloc(wpt_packet_type pktType, wpt_uint32 nPktSize,
wpalPacketLowPacketCB rxLowCB, void *usrData)
{
VOS_STATUS vosStatus = VOS_STATUS_E_FAILURE;
wpt_packet* pPkt = NULL;
vos_pkt_t* pVosPkt = NULL;
void* pData = NULL;
v_U16_t allocLen;
/*- - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
switch (pktType)
{
case eWLAN_PAL_PKT_TYPE_TX_802_11_MGMT:
vosStatus = vos_pkt_get_packet(&pVosPkt, VOS_PKT_TYPE_TX_802_11_MGMT,
nPktSize, 1, VOS_FALSE,
NULL, NULL /*no callback*/);
break;
case eWLAN_PAL_PKT_TYPE_RX_RAW:
/* Set the wpalPacketAvailableCB before we try to get a VOS
* packet from the 'free list' and reset it if vos_pkt_get_packet()
* returns a valid packet. This order is required to avoid the
* race condition:
* 1. The below call to vos_pkt_get_packet() in RX_Thread determines
* that no more packets are available in the 'free list' and sets
* the low resource callbacks.
* 2. in parallel vos_pkt_return_packet() is called in MC_Thread for a
* Management frame before wpalPacketAlloc() gets a chance to set
* wpalPacketAvailableCB and since the 'low resource callbacks'
* are set the callback function - wpalPacketRXLowResourceCB is
* executed,but since wpalPacketAvailableCB is still NULL the low
* resource recovery fails.
*/
wpalPacketAvailableCB = rxLowCB;
vosStatus = vos_pkt_get_packet(&pVosPkt, VOS_PKT_TYPE_RX_RAW,
nPktSize, 1, VOS_FALSE,
wpalPacketRXLowResourceCB, usrData);
#ifndef FEATURE_R33D
/* Reserve the entire raw rx buffer for DXE */
if( vosStatus == VOS_STATUS_SUCCESS )
{
wpalPacketAvailableCB = NULL;
vosStatus = vos_pkt_reserve_head_fast( pVosPkt, &pData, nPktSize );
}
#endif /* FEATURE_R33D */
if((NULL != pVosPkt) && (VOS_STATUS_E_RESOURCES != vosStatus))
{
vos_pkt_get_packet_length(pVosPkt, &allocLen);
if (nPktSize != allocLen)
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"RX packet alloc has problem, discard this frame, Len %d", allocLen);
vos_pkt_return_packet(pVosPkt);
return NULL;
}
}
break;
default:
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
" try to allocate unsupported packet type (%d)", pktType);
break;
}
if(VOS_IS_STATUS_SUCCESS(vosStatus))
{
pPkt = (wpt_packet *)pVosPkt;
}
return pPkt;
}/*wpalPacketAlloc*/
int bapRsnFormPktFromVosPkt( tAniPacket **ppPacket, vos_pkt_t *pVosPacket )
{
int retVal = ANI_ERROR;
VOS_STATUS status;
v_U16_t uPktLen;
#define BAP_RSN_SNAP_TYPE_OFFSET 20
#define BAP_RSN_ETHERNET_3_HEADER_LEN 22
v_U8_t *pFrame = NULL;
tAniPacket *pAniPacket = NULL;
do
{
status = vos_pkt_get_packet_length( pVosPacket, &uPktLen );
if( !VOS_IS_STATUS_SUCCESS(status) ) break;
if( (uPktLen < BAP_RSN_ETHERNET_3_HEADER_LEN) )
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
" authRsnRxFrameHandler receive eapol packet size (%d) too small (%d)\n",
uPktLen, BAP_RSN_ETHERNET_3_HEADER_LEN );
break;
}
status = vos_pkt_peek_data( pVosPacket, 0, (v_VOID_t *)&pFrame, uPktLen );
if( !VOS_IS_STATUS_SUCCESS(status) || (NULL == pFrame) ) break;
retVal = aniAsfPacketAllocateExplicit(&pAniPacket, uPktLen, 0 );
if( !ANI_IS_STATUS_SUCCESS( retVal ) )
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
" authRsnRxFrameHandler failed to get buffer size (%d) \n",
uPktLen );
break;
}
aniAsfPacketEmptyExplicit( pAniPacket, 0 );
pFrame[ETHER_PROTO_POS] = pFrame[BAP_RSN_SNAP_TYPE_OFFSET];
pFrame[ETHER_PROTO_POS + 1] = pFrame[BAP_RSN_SNAP_TYPE_OFFSET + 1];
//push ethernet II header in
retVal = aniAsfPacketAppendBuffer( pAniPacket, pFrame, ETHER_PROTO_POS + 2 );
if( !ANI_IS_STATUS_SUCCESS( retVal ) ) break;
//Get the rest of the data in
uPktLen -= BAP_RSN_ETHERNET_3_HEADER_LEN;
if (uPktLen <= 0){
VOS_ASSERT(0);
retVal = ANI_ERROR;
break;
}
retVal = aniAsfPacketAppendBuffer( pAniPacket, pFrame + BAP_RSN_ETHERNET_3_HEADER_LEN,
uPktLen );
if( !ANI_IS_STATUS_SUCCESS( retVal ) )
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_ERROR,
" authRsnRxFrameHandler cannot retrieve eapol payload size (%d)\n",
uPktLen );
break;
}
}while( 0 );
if( ANI_IS_STATUS_SUCCESS( retVal ) )
{
*ppPacket = pAniPacket;
}
else if( pAniPacket )
{
aniAsfPacketFree( pAniPacket );
}
return retVal;
}
VOS_STATUS
WLANBAP_InitLinkSupervision
(
ptBtampHandle btampHandle
)
{
VOS_STATUS vosStatus = VOS_STATUS_SUCCESS;
ptBtampContext pBtampCtx = (ptBtampContext) btampHandle;
vos_pkt_t *pLSReqPacket;
vos_pkt_t *pLSRepPacket;
v_U16_t lsPktln;
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;
}
#if 0
/* Initialize Link supervision data structure */
vos_mem_set(pLsInfo, sizeof(tBtampLS),0);
/* Allocate memory for Static Tx Data */
pLsInfo->pTxPktData = vos_mem_malloc(sizeof(tBtampLsPktData)+TX_LS_DATALEN);
/* Initialize Static data for LS pkt Tx */
pLsInfo->pTxPktData->BufLen = TX_LS_DATALEN;
vos_mem_copy (&pLsInfo->pTxPktData->pBuf, LsTxData, pLsInfo->pTxPktData->BufLen);
#endif
pBtampCtx->lsReqPktPending = VOS_FALSE;
pBtampCtx->retries = 0;
vosStatus = WLANBAP_AcquireLSPacket( pBtampCtx, &pLSReqPacket,32, TRUE );
if( VOS_IS_STATUS_SUCCESS( vosStatus ) )
{
pBtampCtx->lsReqPacket = pLSReqPacket;
}
else
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"%s:AcquireLSPacket failed\n",__FUNCTION__);
pBtampCtx->lsReqPacket = NULL;
return vosStatus;
}
vosStatus = WLANBAP_AcquireLSPacket( pBtampCtx, &pLSRepPacket,32,FALSE );
if( VOS_IS_STATUS_SUCCESS( vosStatus ) )
{
pBtampCtx->lsRepPacket = pLSRepPacket;
}
else
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"%s:AcquireLSPacket failed\n",__FUNCTION__);
pBtampCtx->lsRepPacket = NULL;
return vosStatus;
}
vosStatus = vos_pkt_get_packet_length(pBtampCtx->lsRepPacket,&lsPktln);
if ( VOS_STATUS_SUCCESS != vosStatus )
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"%s:vos_pkt_get_length error",__FUNCTION__);
return VOS_STATUS_E_FAULT;
}
pBtampCtx->lsPktln = lsPktln;
/* Start Link Supervision Timer if not configured for infinite */
if (pBtampCtx->bapLinkSupervisionTimerInterval)
{
vosStatus = WLANBAP_StartLinkSupervisionTimer (pBtampCtx,
pBtampCtx->bapLinkSupervisionTimerInterval * WLANBAP_BREDR_BASEBAND_SLOT_TIME);
}
else
{
VOS_TRACE( VOS_MODULE_ID_BAP, VOS_TRACE_LEVEL_INFO,
"%s:No LS configured for infinite",__FUNCTION__);
}
return vosStatus;
}
wpt_status wpalLockPacketForTransfer( wpt_packet *pPacket)
{
void* pPhyData = NULL;
wpt_iterator_info* pInfo = NULL;
v_U16_t uLenData = 0;
//
if (unlikely(NULL == pPacket))
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"%s : NULL input pointer", __func__);
return eWLAN_PAL_STATUS_E_INVAL;
}
switch(WPAL_PACKET_GET_TYPE(pPacket))
{
/*
*/
case eWLAN_PAL_PKT_TYPE_TX_802_11_MGMT:
{
/*
*/
pPhyData = (void*)itGetOSPktAddrForDevice( pPacket );
}
break;
/*
*/
case eWLAN_PAL_PKT_TYPE_TX_802_11_DATA:
case eWLAN_PAL_PKT_TYPE_TX_802_3_DATA:
{
/*
*/
pPhyData = (void*)itGetOSPktAddrForDevice( pPacket );
}
break;
/*
*/
case eWLAN_PAL_PKT_TYPE_RX_RAW:
{
/*
*/
pPhyData = (void*)itGetOSPktAddrFromDevice( pPacket );
}
break;
default:
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
" WLAN_PAL: %s: Invalid packet type %d!", __func__,
WPAL_PACKET_GET_TYPE(pPacket) );
WPAL_ASSERT(0);
return eWLAN_PAL_STATUS_E_FAILURE;
}
}
/* */
vos_pkt_get_packet_length(WPAL_TO_VOS_PKT(pPacket),&uLenData);
/* */
pInfo = wpalMemoryAllocate( sizeof(wpt_iterator_info) );
//
if (unlikely(NULL == pInfo))
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"%s : Failed to allocate memory ", __func__);
return eWLAN_PAL_STATUS_E_INVAL;
}
pInfo->pPhyAddr = pPhyData;
pInfo->uLen = uLenData;
pPacket->pInternalData = pInfo;
return eWLAN_PAL_STATUS_SUCCESS;
}/* */
wpt_packet * wpalPacketAlloc(wpt_packet_type pktType, wpt_uint32 nPktSize,
wpalPacketLowPacketCB rxLowCB, void *usrData)
{
VOS_STATUS vosStatus = VOS_STATUS_E_FAILURE;
wpt_packet* pPkt = NULL;
vos_pkt_t* pVosPkt = NULL;
void* pData = NULL;
v_U16_t allocLen;
/* */
switch (pktType)
{
case eWLAN_PAL_PKT_TYPE_TX_802_11_MGMT:
vosStatus = vos_pkt_get_packet(&pVosPkt, VOS_PKT_TYPE_TX_802_11_MGMT,
nPktSize, 1, VOS_FALSE,
NULL, NULL /* */);
break;
case eWLAN_PAL_PKT_TYPE_RX_RAW:
/*
*/
wpalPacketAvailableCB = rxLowCB;
vosStatus = vos_pkt_get_packet(&pVosPkt, VOS_PKT_TYPE_RX_RAW,
nPktSize, 1, VOS_FALSE,
wpalPacketRXLowResourceCB, usrData);
#ifndef FEATURE_R33D
/* */
if( vosStatus == VOS_STATUS_SUCCESS )
{
wpalPacketAvailableCB = NULL;
vosStatus = vos_pkt_reserve_head_fast( pVosPkt, &pData, nPktSize );
}
#endif /* */
if((NULL != pVosPkt) && (VOS_STATUS_E_RESOURCES != vosStatus))
{
vos_pkt_get_packet_length(pVosPkt, &allocLen);
if (nPktSize != allocLen)
{
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
"RX packet alloc has problem, discard this frame, Len %d", allocLen);
vos_pkt_return_packet(pVosPkt);
return NULL;
}
}
break;
default:
WPAL_TRACE(eWLAN_MODULE_PAL, eWLAN_PAL_TRACE_LEVEL_ERROR,
" try to allocate unsupported packet type (%d)\n", pktType);
break;
}
if(VOS_IS_STATUS_SUCCESS(vosStatus))
{
pPkt = (wpt_packet *)pVosPkt;
}
return pPkt;
}/* */
