drivers/net/wireless/rockchip_wlan/rtl8723bu/hal/rtl8723b/rtl8723b_rxdesc.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  *
  19  ******************************************************************************/
  20 #define _RTL8723B_REDESC_C_
  21
  22 #include <rtl8723b_hal.h>
  23
  24 static void process_rssi(_adapter *padapter,union recv_frame *prframe)
  25 {
  26         u32     last_rssi, tmp_val;
  27         struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib;
  28 #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  29         struct signal_stat * signal_stat = &padapter->recvpriv.signal_strength_data;
  30 #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS
  31
  32         //DBG_8192C("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength);
  33         //if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon)
  34         {
  35
  36         #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  37                 if(signal_stat->update_req) {
  38                         signal_stat->total_num = 0;
  39                         signal_stat->total_val = 0;
  40                         signal_stat->update_req = 0;
  41                 }
  42
  43                 signal_stat->total_num++;
  44                 signal_stat->total_val  += pattrib->phy_info.SignalStrength;
  45                 signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num;
  46         #else //CONFIG_NEW_SIGNAL_STAT_PROCESS
  47
  48                 //Adapter->RxStats.RssiCalculateCnt++;  //For antenna Test
  49                 if(padapter->recvpriv.signal_strength_data.total_num++ >= PHY_RSSI_SLID_WIN_MAX)
  50                 {
  51                         padapter->recvpriv.signal_strength_data.total_num = PHY_RSSI_SLID_WIN_MAX;
  52                         last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index];
  53                         padapter->recvpriv.signal_strength_data.total_val -= last_rssi;
  54                 }
  55                 padapter->recvpriv.signal_strength_data.total_val  +=pattrib->phy_info.SignalStrength;
  56
  57                 padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength;
  58                 if(padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX)
  59                         padapter->recvpriv.signal_strength_data.index = 0;
  60
  61
  62                 tmp_val = padapter->recvpriv.signal_strength_data.total_val/padapter->recvpriv.signal_strength_data.total_num;
  63
  64                 if(padapter->recvpriv.is_signal_dbg) {
  65                         padapter->recvpriv.signal_strength= padapter->recvpriv.signal_strength_dbg;
  66                         padapter->recvpriv.rssi=(s8)translate_percentage_to_dbm(padapter->recvpriv.signal_strength_dbg);
  67                 } else {
  68                         padapter->recvpriv.signal_strength= tmp_val;
  69                         padapter->recvpriv.rssi=(s8)translate_percentage_to_dbm(tmp_val);
  70                 }
  71
  72                 RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("UI RSSI = %d, ui_rssi.TotalVal = %d, ui_rssi.TotalNum = %d\n", tmp_val, padapter->recvpriv.signal_strength_data.total_val,padapter->recvpriv.signal_strength_data.total_num));
  73         #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS
  74         }
  75
  76 }// Process_UI_RSSI_8192C
  77
  78 static void process_link_qual(_adapter *padapter,union recv_frame *prframe)
  79 {
  80         u32     last_evm=0, tmpVal;
  81         struct rx_pkt_attrib *pattrib;
  82 #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  83         struct signal_stat * signal_stat;
  84 #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS
  85
  86         if(prframe == NULL || padapter==NULL){
  87                 return;
  88         }
  89
  90         pattrib = &prframe->u.hdr.attrib;
  91 #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  92         signal_stat = &padapter->recvpriv.signal_qual_data;
  93 #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS
  94
  95         //DBG_8192C("process_link_qual=> pattrib->signal_qual(%d)\n ",pattrib->signal_qual);
  96
  97 #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS
  98         if(signal_stat->update_req) {
  99                 signal_stat->total_num = 0;
 100                 signal_stat->total_val = 0;
 101                 signal_stat->update_req = 0;
 102         }
 103
 104         signal_stat->total_num++;
 105         signal_stat->total_val  += pattrib->phy_info.SignalQuality;
 106         signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num;
 107
 108 #else //CONFIG_NEW_SIGNAL_STAT_PROCESS
 109         if(pattrib->phy_info.SignalQuality != 0)
 110         {
 111                         //
 112                         // 1. Record the general EVM to the sliding window.
 113                         //
 114                         if(padapter->recvpriv.signal_qual_data.total_num++ >= PHY_LINKQUALITY_SLID_WIN_MAX)
 115                         {
 116                                 padapter->recvpriv.signal_qual_data.total_num = PHY_LINKQUALITY_SLID_WIN_MAX;
 117                                 last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index];
 118                                 padapter->recvpriv.signal_qual_data.total_val -= last_evm;
 119                         }
 120                         padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality;
 121
 122                         padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality;
 123                         if(padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX)
 124                                 padapter->recvpriv.signal_qual_data.index = 0;
 125
 126                         RT_TRACE(_module_rtl871x_recv_c_,_drv_info_,("Total SQ=%d  pattrib->signal_qual= %d\n", padapter->recvpriv.signal_qual_data.total_val, pattrib->phy_info.SignalQuality));
 127
 128                         // <1> Showed on UI for user, in percentage.
 129                         tmpVal = padapter->recvpriv.signal_qual_data.total_val/padapter->recvpriv.signal_qual_data.total_num;
 130                         padapter->recvpriv.signal_qual=(u8)tmpVal;
 131
 132         }
 133         else
 134         {
 135                 RT_TRACE(_module_rtl871x_recv_c_,_drv_err_,(" pattrib->signal_qual =%d\n", pattrib->phy_info.SignalQuality));
 136         }
 137 #endif //CONFIG_NEW_SIGNAL_STAT_PROCESS
 138
 139 }// Process_UiLinkQuality8192S
 140
 141
 142 void rtl8723b_process_phy_info(_adapter *padapter, void *prframe)
 143 {
 144         union recv_frame *precvframe = (union recv_frame *)prframe;
 145         //
 146         // Check RSSI
 147         //
 148         process_rssi(padapter, precvframe);
 149         //
 150         // Check PWDB.
 151         //
 152         //process_PWDB(padapter, precvframe);
 153
 154         //UpdateRxSignalStatistics8192C(Adapter, pRfd);
 155         //
 156         // Check EVM
 157         //
 158         process_link_qual(padapter,  precvframe);
 159         #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA
 160         rtw_store_phy_info( padapter,prframe);
 161         #endif
 162
 163 }
 164
 165 void rtl8723b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc)
 166 {
 167         struct rx_pkt_attrib    *pattrib = &precvframe->u.hdr.attrib;
 168
 169         _rtw_memset(pattrib, 0, sizeof(struct rx_pkt_attrib));
 170
 171         //Offset 0
 172         pattrib->pkt_len = (u16)GET_RX_STATUS_DESC_PKT_LEN_8723B(pdesc);//(le32_to_cpu(pdesc->rxdw0)&0x00003fff)
 173         pattrib->crc_err = (u8)GET_RX_STATUS_DESC_CRC32_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 14) & 0x1);
 174         pattrib->icv_err = (u8)GET_RX_STATUS_DESC_ICV_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 15) & 0x1);
 175         pattrib->drvinfo_sz = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE_8723B(pdesc) * 8;//((le32_to_cpu(pdesc->rxdw0) >> 16) & 0xf) * 8;//uint 2^3 = 8 bytes
 176         pattrib->encrypt = (u8)GET_RX_STATUS_DESC_SECURITY_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 20) & 0x7);
 177         pattrib->qos = (u8)GET_RX_STATUS_DESC_QOS_8723B(pdesc);//(( le32_to_cpu( pdesc->rxdw0 ) >> 23) & 0x1);// Qos data, wireless lan header length is 26
 178         pattrib->shift_sz = (u8)GET_RX_STATUS_DESC_SHIFT_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 24) & 0x3);
 179         pattrib->physt = (u8)GET_RX_STATUS_DESC_PHY_STATUS_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw0) >> 26) & 0x1);
 180         pattrib->bdecrypted = !GET_RX_STATUS_DESC_SWDEC_8723B(pdesc);//(le32_to_cpu(pdesc->rxdw0) & BIT(27))? 0:1;
 181
 182         //Offset 4
 183         pattrib->priority = (u8)GET_RX_STATUS_DESC_TID_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 8) & 0xf);
 184         pattrib->mdata = (u8)GET_RX_STATUS_DESC_MORE_DATA_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 26) & 0x1);
 185         pattrib->mfrag = (u8)GET_RX_STATUS_DESC_MORE_FRAG_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw1) >> 27) & 0x1);//more fragment bit
 186
 187         //Offset 8
 188         pattrib->seq_num = (u16)GET_RX_STATUS_DESC_SEQ_8723B(pdesc);//(le32_to_cpu(pdesc->rxdw2) & 0x00000fff);
 189         pattrib->frag_num = (u8)GET_RX_STATUS_DESC_FRAG_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw2) >> 12) & 0xf);//fragmentation number
 190
 191         if (GET_RX_STATUS_DESC_RPT_SEL_8723B(pdesc))
 192                 pattrib->pkt_rpt_type = C2H_PACKET;
 193         else
 194                 pattrib->pkt_rpt_type = NORMAL_RX;
 195
 196         //Offset 12
 197         pattrib->data_rate=(u8)GET_RX_STATUS_DESC_RX_RATE_8723B(pdesc);//((le32_to_cpu(pdesc->rxdw3))&0x7f);
 198
 199         //Offset 16
 200         //Offset 20
 201
 202 }
 203
 204
 205