realtek/rtw88/rx.c

0001 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
0002 /* Copyright(c) 2018-2019  Realtek Corporation
0003  */
0004
0005 #include "main.h"
0006 #include "rx.h"
0007 #include "ps.h"
0008 #include "debug.h"
0009 #include "fw.h"
0010
0011 void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif,
0012           struct sk_buff *skb)
0013 {
0014     struct ieee80211_hdr *hdr;
0015     struct rtw_vif *rtwvif;
0016
0017     hdr = (struct ieee80211_hdr *)skb->data;
0018
0019     if (!ieee80211_is_data(hdr->frame_control))
0020         return;
0021
0022     if (!is_broadcast_ether_addr(hdr->addr1) &&
0023         !is_multicast_ether_addr(hdr->addr1)) {
0024         rtwdev->stats.rx_unicast += skb->len;
0025         rtwdev->stats.rx_cnt++;
0026         if (vif) {
0027             rtwvif = (struct rtw_vif *)vif->drv_priv;
0028             rtwvif->stats.rx_unicast += skb->len;
0029             rtwvif->stats.rx_cnt++;
0030         }
0031     }
0032 }
0033 EXPORT_SYMBOL(rtw_rx_stats);
0034
0035 struct rtw_rx_addr_match_data {
0036     struct rtw_dev *rtwdev;
0037     struct ieee80211_hdr *hdr;
0038     struct rtw_rx_pkt_stat *pkt_stat;
0039     u8 *bssid;
0040 };
0041
0042 static void rtw_rx_phy_stat(struct rtw_dev *rtwdev,
0043                 struct rtw_rx_pkt_stat *pkt_stat,
0044                 struct ieee80211_hdr *hdr)
0045 {
0046     struct rtw_dm_info *dm_info = &rtwdev->dm_info;
0047     struct rtw_pkt_count *cur_pkt_cnt = &dm_info->cur_pkt_count;
0048     u8 rate_ss, rate_ss_evm, evm_id;
0049     u8 i, idx;
0050
0051     dm_info->curr_rx_rate = pkt_stat->rate;
0052
0053     if (ieee80211_is_beacon(hdr->frame_control))
0054         cur_pkt_cnt->num_bcn_pkt++;
0055
0056     switch (pkt_stat->rate) {
0057     case DESC_RATE1M...DESC_RATE11M:
0058         goto pkt_num;
0059     case DESC_RATE6M...DESC_RATE54M:
0060         rate_ss = 0;
0061         rate_ss_evm = 1;
0062         evm_id = RTW_EVM_OFDM;
0063         break;
0064     case DESC_RATEMCS0...DESC_RATEMCS7:
0065     case DESC_RATEVHT1SS_MCS0...DESC_RATEVHT1SS_MCS9:
0066         rate_ss = 1;
0067         rate_ss_evm = 1;
0068         evm_id = RTW_EVM_1SS;
0069         break;
0070     case DESC_RATEMCS8...DESC_RATEMCS15:
0071     case DESC_RATEVHT2SS_MCS0...DESC_RATEVHT2SS_MCS9:
0072         rate_ss = 2;
0073         rate_ss_evm = 2;
0074         evm_id = RTW_EVM_2SS_A;
0075         break;
0076     default:
0077         rtw_warn(rtwdev, "unknown pkt rate = %d\n", pkt_stat->rate);
0078         return;
0079     }
0080
0081     for (i = 0; i < rate_ss_evm; i++) {
0082         idx = evm_id + i;
0083         ewma_evm_add(&dm_info->ewma_evm[idx],
0084                  dm_info->rx_evm_dbm[i]);
0085     }
0086
0087     for (i = 0; i < rtwdev->hal.rf_path_num; i++) {
0088         idx = RTW_SNR_OFDM_A + 4 * rate_ss + i;
0089         ewma_snr_add(&dm_info->ewma_snr[idx],
0090                  dm_info->rx_snr[i]);
0091     }
0092 pkt_num:
0093     cur_pkt_cnt->num_qry_pkt[pkt_stat->rate]++;
0094 }
0095
0096 static void rtw_rx_addr_match_iter(void *data, u8 *mac,
0097                    struct ieee80211_vif *vif)
0098 {
0099     struct rtw_rx_addr_match_data *iter_data = data;
0100     struct ieee80211_sta *sta;
0101     struct ieee80211_hdr *hdr = iter_data->hdr;
0102     struct rtw_dev *rtwdev = iter_data->rtwdev;
0103     struct rtw_sta_info *si;
0104     struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat;
0105     u8 *bssid = iter_data->bssid;
0106
0107     if (!ether_addr_equal(vif->bss_conf.bssid, bssid))
0108         return;
0109
0110     if (!(ether_addr_equal(vif->addr, hdr->addr1) ||
0111           ieee80211_is_beacon(hdr->frame_control)))
0112         return;
0113
0114     rtw_rx_phy_stat(rtwdev, pkt_stat, hdr);
0115     sta = ieee80211_find_sta_by_ifaddr(rtwdev->hw, hdr->addr2,
0116                        vif->addr);
0117     if (!sta)
0118         return;
0119
0120     si = (struct rtw_sta_info *)sta->drv_priv;
0121     ewma_rssi_add(&si->avg_rssi, pkt_stat->rssi);
0122 }
0123
0124 static void rtw_rx_addr_match(struct rtw_dev *rtwdev,
0125                   struct rtw_rx_pkt_stat *pkt_stat,
0126                   struct ieee80211_hdr *hdr)
0127 {
0128     struct rtw_rx_addr_match_data data = {};
0129
0130     if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status ||
0131         ieee80211_is_ctl(hdr->frame_control))
0132         return;
0133
0134     data.rtwdev = rtwdev;
0135     data.hdr = hdr;
0136     data.pkt_stat = pkt_stat;
0137     data.bssid = get_hdr_bssid(hdr);
0138
0139     rtw_iterate_vifs_atomic(rtwdev, rtw_rx_addr_match_iter, &data);
0140 }
0141
0142 static void rtw_set_rx_freq_by_pktstat(struct rtw_rx_pkt_stat *pkt_stat,
0143                        struct ieee80211_rx_status *rx_status)
0144 {
0145     rx_status->freq = pkt_stat->freq;
0146     rx_status->band = pkt_stat->band;
0147 }
0148
0149 void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev,
0150                struct rtw_rx_pkt_stat *pkt_stat,
0151                struct ieee80211_hdr *hdr,
0152                struct ieee80211_rx_status *rx_status,
0153                u8 *phy_status)
0154 {
0155     struct ieee80211_hw *hw = rtwdev->hw;
0156     u8 path;
0157
0158     memset(rx_status, 0, sizeof(*rx_status));
0159     rx_status->freq = hw->conf.chandef.chan->center_freq;
0160     rx_status->band = hw->conf.chandef.chan->band;
0161     if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) &&
0162         test_bit(RTW_FLAG_SCANNING, rtwdev->flags))
0163         rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status);
0164     if (pkt_stat->crc_err)
0165         rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
0166     if (pkt_stat->decrypted)
0167         rx_status->flag |= RX_FLAG_DECRYPTED;
0168
0169     if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0)
0170         rx_status->encoding = RX_ENC_VHT;
0171     else if (pkt_stat->rate >= DESC_RATEMCS0)
0172         rx_status->encoding = RX_ENC_HT;
0173
0174     if (rx_status->band == NL80211_BAND_5GHZ &&
0175         pkt_stat->rate >= DESC_RATE6M &&
0176         pkt_stat->rate <= DESC_RATE54M) {
0177         rx_status->rate_idx = pkt_stat->rate - DESC_RATE6M;
0178     } else if (rx_status->band == NL80211_BAND_2GHZ &&
0179            pkt_stat->rate >= DESC_RATE1M &&
0180            pkt_stat->rate <= DESC_RATE54M) {
0181         rx_status->rate_idx = pkt_stat->rate - DESC_RATE1M;
0182     } else if (pkt_stat->rate >= DESC_RATEMCS0) {
0183         rtw_desc_to_mcsrate(pkt_stat->rate, &rx_status->rate_idx,
0184                     &rx_status->nss);
0185     }
0186
0187     rx_status->flag |= RX_FLAG_MACTIME_START;
0188     rx_status->mactime = pkt_stat->tsf_low;
0189
0190     if (pkt_stat->bw == RTW_CHANNEL_WIDTH_80)
0191         rx_status->bw = RATE_INFO_BW_80;
0192     else if (pkt_stat->bw == RTW_CHANNEL_WIDTH_40)
0193         rx_status->bw = RATE_INFO_BW_40;
0194     else
0195         rx_status->bw = RATE_INFO_BW_20;
0196
0197     rx_status->signal = pkt_stat->signal_power;
0198     for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
0199         rx_status->chains |= BIT(path);
0200         rx_status->chain_signal[path] = pkt_stat->rx_power[path];
0201     }
0202
0203     rtw_rx_addr_match(rtwdev, pkt_stat, hdr);
0204 }
0205 EXPORT_SYMBOL(rtw_rx_fill_rx_status);