drivers/staging/r8188eu/hal/rtl8188e_rxdesc.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Copyright(c) 2007 - 2011 Realtek Corporation. */
   3
   4 #define _RTL8188E_REDESC_C_
   5
   6 #include "../include/osdep_service.h"
   7 #include "../include/drv_types.h"
   8 #include "../include/rtl8188e_hal.h"
   9
  10 static void process_rssi(struct adapter *padapter, struct recv_frame *prframe)
  11 {
  12         struct rx_pkt_attrib *pattrib = &prframe->attrib;
  13         struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data;
  14
  15         if (signal_stat->update_req) {
  16                 signal_stat->total_num = 0;
  17                 signal_stat->total_val = 0;
  18                 signal_stat->update_req = 0;
  19         }
  20
  21         signal_stat->total_num++;
  22         signal_stat->total_val  += pattrib->phy_info.SignalStrength;
  23         signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num;
  24 } /*  Process_UI_RSSI_8192C */
  25
  26 static void process_link_qual(struct adapter *padapter, struct recv_frame *prframe)
  27 {
  28         struct rx_pkt_attrib *pattrib;
  29         struct signal_stat *signal_stat;
  30
  31         if (!prframe || !padapter)
  32                 return;
  33
  34         pattrib = &prframe->attrib;
  35         signal_stat = &padapter->recvpriv.signal_qual_data;
  36
  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.SignalQuality;
  45         signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num;
  46 }
  47
  48 static void rtl8188e_process_phy_info(struct adapter *padapter, void *prframe)
  49 {
  50         struct recv_frame *precvframe = (struct recv_frame *)prframe;
  51
  52         /*  Check RSSI */
  53         process_rssi(padapter, precvframe);
  54         /*  Check EVM */
  55         process_link_qual(padapter,  precvframe);
  56 }
  57
  58 void update_recvframe_attrib_88e(struct recv_frame *precvframe, struct recv_stat *prxstat)
  59 {
  60         struct rx_pkt_attrib *pattrib = &precvframe->attrib;
  61         memset(pattrib, 0, sizeof(struct rx_pkt_attrib));
  62
  63         pattrib->crc_err = (le32_to_cpu(prxstat->rxdw0) >> 14) & 0x1;
  64
  65         pattrib->pkt_rpt_type = (le32_to_cpu(prxstat->rxdw3) >> 14) & 0x3;
  66
  67         if (pattrib->pkt_rpt_type == NORMAL_RX) {
  68                 pattrib->pkt_len = le32_to_cpu(prxstat->rxdw0) & 0x00003fff;
  69                 pattrib->drvinfo_sz = ((le32_to_cpu(prxstat->rxdw0) >> 16) & 0xf) * 8;
  70
  71                 pattrib->physt = (le32_to_cpu(prxstat->rxdw0) >> 26) & 0x1;
  72
  73                 pattrib->bdecrypted = (le32_to_cpu(prxstat->rxdw0) & BIT(27)) ? 0 : 1;
  74                 pattrib->encrypt = (le32_to_cpu(prxstat->rxdw0) >> 20) & 0x7;
  75
  76                 pattrib->qos = (le32_to_cpu(prxstat->rxdw0) >> 23) & 0x1;
  77                 pattrib->priority = (le32_to_cpu(prxstat->rxdw1) >> 8) & 0xf;
  78
  79                 pattrib->amsdu = (le32_to_cpu(prxstat->rxdw1) >> 13) & 0x1;
  80
  81                 pattrib->seq_num = le32_to_cpu(prxstat->rxdw2) & 0x00000fff;
  82                 pattrib->frag_num = (le32_to_cpu(prxstat->rxdw2) >> 12) & 0xf;
  83                 pattrib->mfrag = (le32_to_cpu(prxstat->rxdw1) >> 27) & 0x1;
  84                 pattrib->mdata = (le32_to_cpu(prxstat->rxdw1) >> 26) & 0x1;
  85
  86                 pattrib->mcs_rate = le32_to_cpu(prxstat->rxdw3) & 0x3f;
  87                 pattrib->rxht = (le32_to_cpu(prxstat->rxdw3) >> 6) & 0x1;
  88
  89                 pattrib->icv_err = (le32_to_cpu(prxstat->rxdw0) >> 15) & 0x1;
  90                 pattrib->shift_sz = (le32_to_cpu(prxstat->rxdw0) >> 24) & 0x3;
  91         } else if (pattrib->pkt_rpt_type == TX_REPORT1) { /* CCX */
  92                 pattrib->pkt_len = TX_RPT1_PKT_LEN;
  93         } else if (pattrib->pkt_rpt_type == TX_REPORT2) {
  94                 pattrib->pkt_len = le32_to_cpu(prxstat->rxdw0) & 0x3FF;
  95
  96                 pattrib->MacIDValidEntry[0] = le32_to_cpu(prxstat->rxdw4);
  97                 pattrib->MacIDValidEntry[1] = le32_to_cpu(prxstat->rxdw5);
  98
  99         } else if (pattrib->pkt_rpt_type == HIS_REPORT) {
 100                 pattrib->pkt_len = le32_to_cpu(prxstat->rxdw0) & 0x00003fff;
 101         }
 102 }
 103
 104 /*
 105  * Notice:
 106  *      Before calling this function,
 107  *      precvframe->rx_data should be ready!
 108  */
 109 void update_recvframe_phyinfo_88e(struct recv_frame *precvframe, struct phy_stat *pphy_status)
 110 {
 111         struct adapter *padapter = precvframe->adapter;
 112         struct rx_pkt_attrib *pattrib = &precvframe->attrib;
 113         struct hal_data_8188e *pHalData = &padapter->haldata;
 114         struct phy_info *pPHYInfo  = &pattrib->phy_info;
 115         u8 *wlanhdr = precvframe->rx_data;
 116         struct odm_per_pkt_info pkt_info;
 117         u8 *sa = NULL;
 118         struct sta_priv *pstapriv;
 119         struct sta_info *psta;
 120
 121         pkt_info.bPacketMatchBSSID = ((!IsFrameTypeCtrl(wlanhdr)) &&
 122                 !pattrib->icv_err && !pattrib->crc_err &&
 123                 !memcmp(get_hdr_bssid(wlanhdr),
 124                  get_bssid(&padapter->mlmepriv), ETH_ALEN));
 125
 126         pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID &&
 127                                  (!memcmp(get_da(wlanhdr),
 128                                   myid(&padapter->eeprompriv), ETH_ALEN));
 129
 130         pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID &&
 131                                  (GetFrameSubType(wlanhdr) == WIFI_BEACON);
 132
 133         if (pkt_info.bPacketBeacon) {
 134                 if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE))
 135                         sa = padapter->mlmepriv.cur_network.network.MacAddress;
 136                 /* to do Ad-hoc */
 137         } else {
 138                 sa = get_sa(wlanhdr);
 139         }
 140
 141         pstapriv = &padapter->stapriv;
 142         pkt_info.StationID = 0xFF;
 143         psta = rtw_get_stainfo(pstapriv, sa);
 144         if (psta)
 145                 pkt_info.StationID = psta->mac_id;
 146         pkt_info.Rate = pattrib->mcs_rate;
 147
 148         ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, (u8 *)pphy_status, &(pkt_info), padapter);
 149
 150         precvframe->psta = NULL;
 151         if (pkt_info.bPacketMatchBSSID &&
 152             (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE))) {
 153                 if (psta) {
 154                         precvframe->psta = psta;
 155                         rtl8188e_process_phy_info(padapter, precvframe);
 156                 }
 157         } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) {
 158                 if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) {
 159                         if (psta)
 160                                 precvframe->psta = psta;
 161                 }
 162                 rtl8188e_process_phy_info(padapter, precvframe);
 163         }
 164 }