123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521 |
- #define _RTL8812A_XMIT_C_
- #include <rtl8812a_hal.h>
- void _dbg_dump_tx_info(_adapter *padapter,int frame_tag, u8 *ptxdesc)
- {
- u8 bDumpTxPkt;
- u8 bDumpTxDesc = _FALSE;
- rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DUMP_TXPKT, &(bDumpTxPkt));
- if(bDumpTxPkt ==1){
- DBG_871X("dump tx_desc for data frame\n");
- if((frame_tag&0x0f) == DATA_FRAMETAG){
- bDumpTxDesc = _TRUE;
- }
- }
- else if(bDumpTxPkt ==2){
- DBG_871X("dump tx_desc for mgnt frame\n");
- if((frame_tag&0x0f) == MGNT_FRAMETAG){
- bDumpTxDesc = _TRUE;
- }
- }
- else if(bDumpTxPkt ==3){
- }
-
- if(bDumpTxDesc){
-
-
- DBG_8192C("=====================================\n");
- DBG_8192C("Offset00(0x%08x)\n",*((u32 *)(ptxdesc)));
- DBG_8192C("Offset04(0x%08x)\n",*((u32 *)(ptxdesc+4)));
- DBG_8192C("Offset08(0x%08x)\n",*((u32 *)(ptxdesc+8)));
- DBG_8192C("Offset12(0x%08x)\n",*((u32 *)(ptxdesc+12)));
- DBG_8192C("Offset16(0x%08x)\n",*((u32 *)(ptxdesc+16)));
- DBG_8192C("Offset20(0x%08x)\n",*((u32 *)(ptxdesc+20)));
- DBG_8192C("Offset24(0x%08x)\n",*((u32 *)(ptxdesc+24)));
- DBG_8192C("Offset28(0x%08x)\n",*((u32 *)(ptxdesc+28)));
- DBG_8192C("Offset32(0x%08x)\n",*((u32 *)(ptxdesc+32)));
- DBG_8192C("Offset36(0x%08x)\n",*((u32 *)(ptxdesc+36)));
- DBG_8192C("=====================================\n");
- }
- }
- #ifdef CONFIG_TX_EARLY_MODE
- #if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1
- #define EARLY_MODE_MAX_PKT_NUM 10
- #else
- #define EARLY_MODE_MAX_PKT_NUM 5
- #endif
- struct EMInfo{
- u8 EMPktNum;
- u16 EMPktLen[EARLY_MODE_MAX_PKT_NUM];
- };
- void
- InsertEMContent_8812(
- struct EMInfo *pEMInfo,
- IN pu1Byte VirtualAddress)
- {
- #if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1
- u1Byte index=0;
- u4Byte dwtmp=0;
- #endif
- _rtw_memset(VirtualAddress, 0, EARLY_MODE_INFO_SIZE);
- if(pEMInfo->EMPktNum==0)
- return;
- #ifdef DBG_EMINFO
- {
- int i;
- DBG_8192C("\n%s ==> pEMInfo->EMPktNum =%d\n",__FUNCTION__,pEMInfo->EMPktNum);
- for(i=0;i< EARLY_MODE_MAX_PKT_NUM;i++){
- DBG_8192C("%s ==> pEMInfo->EMPktLen[%d] =%d\n",__FUNCTION__,i,pEMInfo->EMPktLen[i]);
- }
- }
- #endif
-
- #if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1
- SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum);
- if(pEMInfo->EMPktNum == 1){
- dwtmp = pEMInfo->EMPktLen[0];
- }else{
- dwtmp = pEMInfo->EMPktLen[0];
- dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4;
- dwtmp += pEMInfo->EMPktLen[1];
- }
- SET_EARLYMODE_LEN0(VirtualAddress, dwtmp);
- if(pEMInfo->EMPktNum <= 3){
- dwtmp = pEMInfo->EMPktLen[2];
- }else{
- dwtmp = pEMInfo->EMPktLen[2];
- dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4;
- dwtmp += pEMInfo->EMPktLen[3];
- }
- SET_EARLYMODE_LEN1(VirtualAddress, dwtmp);
- if(pEMInfo->EMPktNum <= 5){
- dwtmp = pEMInfo->EMPktLen[4];
- }else{
- dwtmp = pEMInfo->EMPktLen[4];
- dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4;
- dwtmp += pEMInfo->EMPktLen[5];
- }
- SET_EARLYMODE_LEN2_1(VirtualAddress, dwtmp&0xF);
- SET_EARLYMODE_LEN2_2(VirtualAddress, dwtmp>>4);
- if(pEMInfo->EMPktNum <= 7){
- dwtmp = pEMInfo->EMPktLen[6];
- }else{
- dwtmp = pEMInfo->EMPktLen[6];
- dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4;
- dwtmp += pEMInfo->EMPktLen[7];
- }
- SET_EARLYMODE_LEN3(VirtualAddress, dwtmp);
- if(pEMInfo->EMPktNum <= 9){
- dwtmp = pEMInfo->EMPktLen[8];
- }else{
- dwtmp = pEMInfo->EMPktLen[8];
- dwtmp += ((dwtmp%4)?(4-dwtmp%4):0)+4;
- dwtmp += pEMInfo->EMPktLen[9];
- }
- SET_EARLYMODE_LEN4(VirtualAddress, dwtmp);
- #else
- SET_EARLYMODE_PKTNUM(VirtualAddress, pEMInfo->EMPktNum);
- SET_EARLYMODE_LEN0(VirtualAddress, pEMInfo->EMPktLen[0]);
- SET_EARLYMODE_LEN1(VirtualAddress, pEMInfo->EMPktLen[1]);
- SET_EARLYMODE_LEN2_1(VirtualAddress, pEMInfo->EMPktLen[2]&0xF);
- SET_EARLYMODE_LEN2_2(VirtualAddress, pEMInfo->EMPktLen[2]>>4);
- SET_EARLYMODE_LEN3(VirtualAddress, pEMInfo->EMPktLen[3]);
- SET_EARLYMODE_LEN4(VirtualAddress, pEMInfo->EMPktLen[4]);
- #endif
-
- }
- void UpdateEarlyModeInfo8812(struct xmit_priv *pxmitpriv,struct xmit_buf *pxmitbuf )
- {
-
- int index,j;
- u16 offset,pktlen;
- PTXDESC_8812 ptxdesc;
-
- u8 *pmem,*pEMInfo_mem;
- s8 node_num_0=0,node_num_1=0;
- struct EMInfo eminfo;
- struct agg_pkt_info *paggpkt;
- struct xmit_frame *pframe = (struct xmit_frame*)pxmitbuf->priv_data;
- pmem= pframe->buf_addr;
-
- #ifdef DBG_EMINFO
- DBG_8192C("\n%s ==> agg_num:%d\n",__FUNCTION__, pframe->agg_num);
- for(index=0;index<pframe->agg_num;index++){
- offset = pxmitpriv->agg_pkt[index].offset;
- pktlen = pxmitpriv->agg_pkt[index].pkt_len;
- DBG_8192C("%s ==> agg_pkt[%d].offset=%d\n",__FUNCTION__,index,offset);
- DBG_8192C("%s ==> agg_pkt[%d].pkt_len=%d\n",__FUNCTION__,index,pktlen);
- }
- #endif
-
- if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM)
- {
- node_num_0 = pframe->agg_num;
- node_num_1= EARLY_MODE_MAX_PKT_NUM-1;
- }
-
- for(index=0;index<pframe->agg_num;index++){
- offset = pxmitpriv->agg_pkt[index].offset;
- pktlen = pxmitpriv->agg_pkt[index].pkt_len;
- _rtw_memset(&eminfo,0,sizeof(struct EMInfo));
- if( pframe->agg_num > EARLY_MODE_MAX_PKT_NUM){
- if(node_num_0 > EARLY_MODE_MAX_PKT_NUM){
- eminfo.EMPktNum = EARLY_MODE_MAX_PKT_NUM;
- node_num_0--;
- }
- else{
- eminfo.EMPktNum = node_num_1;
- node_num_1--;
- }
- }
- else{
- eminfo.EMPktNum = pframe->agg_num-(index+1);
- }
- for(j=0;j< eminfo.EMPktNum ;j++){
- eminfo.EMPktLen[j] = pxmitpriv->agg_pkt[index+1+j].pkt_len+4;
- }
-
- if(pmem){
- if(index==0){
- ptxdesc = (PTXDESC_8812)(pmem);
- pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE;
- }
- else{
- pmem = pmem + pxmitpriv->agg_pkt[index-1].offset;
- ptxdesc = (PTXDESC_8812)(pmem);
- pEMInfo_mem = ((u8 *)ptxdesc)+TXDESC_SIZE;
- }
-
- #ifdef DBG_EMINFO
- DBG_8192C("%s ==> desc.pkt_len=%d\n",__FUNCTION__,ptxdesc->pktlen);
- #endif
- InsertEMContent_8812(&eminfo,pEMInfo_mem);
- }
-
-
- }
- _rtw_memset(pxmitpriv->agg_pkt,0,sizeof(struct agg_pkt_info)*MAX_AGG_PKT_NUM);
- }
- #endif
- void rtl8812a_cal_txdesc_chksum(u8 *ptxdesc)
- {
- u16 *usPtr;
- u32 count;
- u32 index;
- u16 checksum = 0;
- usPtr = (u16*)ptxdesc;
-
-
-
- count = 16;
-
- SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, 0);
- for(index = 0 ; index < count ; index++){
- checksum = checksum ^ le16_to_cpu(*(usPtr + index));
- }
- SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, checksum);
- }
- void rtl8812a_fill_fake_txdesc(
- PADAPTER padapter,
- u8* pDesc,
- u32 BufferLen,
- u8 IsPsPoll,
- u8 IsBTQosNull)
- {
- struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
-
- _rtw_memset(pDesc, 0, TXDESC_SIZE);
- SET_TX_DESC_FIRST_SEG_8812(pDesc, 1);
- SET_TX_DESC_LAST_SEG_8812(pDesc, 1);
- SET_TX_DESC_OFFSET_8812(pDesc, TXDESC_SIZE);
- SET_TX_DESC_PKT_SIZE_8812(pDesc, BufferLen);
- SET_TX_DESC_QUEUE_SEL_8812(pDesc, QSLT_MGNT);
- if (pmlmeext->cur_wireless_mode & WIRELESS_11B) {
- SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_B);
- } else {
- SET_TX_DESC_RATE_ID_8812(pDesc, RATEID_IDX_G);
- }
-
- if (IsPsPoll)
- {
- SET_TX_DESC_NAV_USE_HDR_8812(pDesc, 1);
- }
- else
- {
- SET_TX_DESC_HWSEQ_EN_8812(pDesc, 1);
- }
- if(IsBTQosNull)
- {
- SET_TX_DESC_BT_INT_8812(pDesc, 1);
- }
- SET_TX_DESC_USE_RATE_8812(pDesc, 1);
- SET_TX_DESC_OWN_8812(pDesc, 1);
-
- SET_TX_DESC_TX_RATE_8812(pDesc, MRateToHwRate(pmlmeext->tx_rate));
- #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI)
-
-
- rtl8812a_cal_txdesc_chksum(pDesc);
- #endif
- }
- void rtl8812a_fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc)
- {
- if ((pattrib->encrypt > 0) && !pattrib->bswenc)
- {
- switch (pattrib->encrypt)
- {
-
- case _WEP40_:
- case _WEP104_:
- case _TKIP_:
- case _TKIP_WTMIC_:
- SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x1);
- break;
- #ifdef CONFIG_WAPI_SUPPORT
- case _SMS4_:
- SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x2);
- break;
- #endif
- case _AES_:
- SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x3);
- break;
- case _NO_PRIVACY_:
- default:
- SET_TX_DESC_SEC_TYPE_8812(ptxdesc, 0x0);
- break;
-
- }
-
- }
- }
- void rtl8812a_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc)
- {
- struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
- struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
-
- if (pattrib->vcs_mode) {
- switch(pattrib->vcs_mode)
- {
- case RTS_CTS:
- SET_TX_DESC_RTS_ENABLE_8812(ptxdesc, 1);
- break;
- case CTS_TO_SELF:
- SET_TX_DESC_CTS2SELF_8812(ptxdesc, 1);
- break;
- case NONE_VCS:
- default:
- break;
- }
- if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT)
- SET_TX_DESC_RTS_SHORT_8812(ptxdesc, 1);
- SET_TX_DESC_RTS_RATE_8812(ptxdesc, 0x8);
- SET_TX_DESC_RTS_RATE_FB_LIMIT_8812(ptxdesc, 0xf);
-
-
- }
- }
- void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 *ptxdesc)
- {
-
- if(pattrib->ht_en)
- {
-
- SET_TX_DESC_DATA_BW_8812(ptxdesc, BWMapping_8812(padapter,pattrib));
-
- }
- }
- u8
- BWMapping_8812(
- IN PADAPTER Adapter,
- IN struct pkt_attrib *pattrib
- )
- {
- u8 BWSettingOfDesc = 0;
- PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);
-
- if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_80)
- {
- if(pattrib->bwmode == CHANNEL_WIDTH_80)
- BWSettingOfDesc= 2;
- else if(pattrib->bwmode == CHANNEL_WIDTH_40)
- BWSettingOfDesc = 1;
- else
- BWSettingOfDesc = 0;
- }
- else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40)
- {
- if((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80))
- BWSettingOfDesc = 1;
- else
- BWSettingOfDesc = 0;
- }
- else
- BWSettingOfDesc = 0;
- return BWSettingOfDesc;
- }
- u8
- SCMapping_8812(
- IN PADAPTER Adapter,
- IN struct pkt_attrib *pattrib
- )
- {
- u8 SCSettingOfDesc = 0;
- PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter);
-
-
- if(pHalData->CurrentChannelBW == CHANNEL_WIDTH_80)
- {
- if(pattrib->bwmode == CHANNEL_WIDTH_80)
- {
- SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE;
- }
- else if(pattrib->bwmode == CHANNEL_WIDTH_40)
- {
- if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)
- SCSettingOfDesc = VHT_DATA_SC_40_LOWER_OF_80MHZ;
- else if(pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)
- SCSettingOfDesc = VHT_DATA_SC_40_UPPER_OF_80MHZ;
- else
- DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n");
- }
- else
- {
- if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER))
- SCSettingOfDesc = VHT_DATA_SC_20_LOWEST_OF_80MHZ;
- else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER))
- SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ;
- else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER))
- SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ;
- else if((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER))
- SCSettingOfDesc = VHT_DATA_SC_20_UPPERST_OF_80MHZ;
- else
- DBG_871X("SCMapping: Not Correct Primary40MHz Setting \n");
- }
- }
- else if(pHalData->CurrentChannelBW== CHANNEL_WIDTH_40)
- {
-
- if(pattrib->bwmode == CHANNEL_WIDTH_40)
- {
- SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE;
- }
- else if(pattrib->bwmode == CHANNEL_WIDTH_20)
- {
- if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)
- {
- SCSettingOfDesc = VHT_DATA_SC_20_UPPER_OF_80MHZ;
- }
- else if(pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER)
- {
- SCSettingOfDesc = VHT_DATA_SC_20_LOWER_OF_80MHZ;
- }
- else
- {
- SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE;
- }
-
- }
- }
- else
- {
- SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE;
- }
- return SCSettingOfDesc;
- }
|