/*========================================================================== 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_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_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 */