1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019 Realtek Corporation
3 */
4
5 #include "main.h"
6 #include "rx.h"
7 #include "ps.h"
8 #include "debug.h"
9 #include "fw.h"
10
rtw_rx_stats(struct rtw_dev * rtwdev,struct ieee80211_vif * vif,struct sk_buff * skb)11 void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif,
12 struct sk_buff *skb)
13 {
14 struct ieee80211_hdr *hdr;
15 struct rtw_vif *rtwvif;
16
17 hdr = (struct ieee80211_hdr *)skb->data;
18
19 if (!ieee80211_is_data(hdr->frame_control))
20 return;
21
22 if (!is_broadcast_ether_addr(hdr->addr1) &&
23 !is_multicast_ether_addr(hdr->addr1)) {
24 rtwdev->stats.rx_unicast += skb->len;
25 rtwdev->stats.rx_cnt++;
26 if (vif) {
27 rtwvif = (struct rtw_vif *)vif->drv_priv;
28 rtwvif->stats.rx_unicast += skb->len;
29 rtwvif->stats.rx_cnt++;
30 }
31 }
32 }
33 EXPORT_SYMBOL(rtw_rx_stats);
34
35 struct rtw_rx_addr_match_data {
36 struct rtw_dev *rtwdev;
37 struct ieee80211_hdr *hdr;
38 struct rtw_rx_pkt_stat *pkt_stat;
39 u8 *bssid;
40 };
41
rtw_rx_phy_stat(struct rtw_dev * rtwdev,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_hdr * hdr)42 static void rtw_rx_phy_stat(struct rtw_dev *rtwdev,
43 struct rtw_rx_pkt_stat *pkt_stat,
44 struct ieee80211_hdr *hdr)
45 {
46 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
47 struct rtw_pkt_count *cur_pkt_cnt = &dm_info->cur_pkt_count;
48 u8 rate_ss, rate_ss_evm, evm_id;
49 u8 i, idx;
50
51 dm_info->curr_rx_rate = pkt_stat->rate;
52
53 if (ieee80211_is_beacon(hdr->frame_control))
54 cur_pkt_cnt->num_bcn_pkt++;
55
56 switch (pkt_stat->rate) {
57 case DESC_RATE1M...DESC_RATE11M:
58 goto pkt_num;
59 case DESC_RATE6M...DESC_RATE54M:
60 rate_ss = 0;
61 rate_ss_evm = 1;
62 evm_id = RTW_EVM_OFDM;
63 break;
64 case DESC_RATEMCS0...DESC_RATEMCS7:
65 case DESC_RATEVHT1SS_MCS0...DESC_RATEVHT1SS_MCS9:
66 rate_ss = 1;
67 rate_ss_evm = 1;
68 evm_id = RTW_EVM_1SS;
69 break;
70 case DESC_RATEMCS8...DESC_RATEMCS15:
71 case DESC_RATEVHT2SS_MCS0...DESC_RATEVHT2SS_MCS9:
72 rate_ss = 2;
73 rate_ss_evm = 2;
74 evm_id = RTW_EVM_2SS_A;
75 break;
76 case DESC_RATEMCS16...DESC_RATEMCS23:
77 case DESC_RATEVHT3SS_MCS0...DESC_RATEVHT3SS_MCS9:
78 rate_ss = 3;
79 rate_ss_evm = 3;
80 evm_id = RTW_EVM_3SS_A;
81 break;
82 default:
83 rtw_warn(rtwdev, "unknown pkt rate = %d\n", pkt_stat->rate);
84 return;
85 }
86
87 for (i = 0; i < rate_ss_evm; i++) {
88 idx = evm_id + i;
89 ewma_evm_add(&dm_info->ewma_evm[idx],
90 dm_info->rx_evm_dbm[i]);
91 }
92
93 for (i = 0; i < rtwdev->hal.rf_path_num; i++) {
94 idx = RTW_SNR_OFDM_A + 4 * rate_ss + i;
95 ewma_snr_add(&dm_info->ewma_snr[idx],
96 dm_info->rx_snr[i]);
97 }
98 pkt_num:
99 cur_pkt_cnt->num_qry_pkt[pkt_stat->rate]++;
100 }
101
rtw_rx_addr_match_iter(void * data,u8 * mac,struct ieee80211_vif * vif)102 static void rtw_rx_addr_match_iter(void *data, u8 *mac,
103 struct ieee80211_vif *vif)
104 {
105 struct rtw_rx_addr_match_data *iter_data = data;
106 struct ieee80211_sta *sta;
107 struct ieee80211_hdr *hdr = iter_data->hdr;
108 struct rtw_dev *rtwdev = iter_data->rtwdev;
109 struct rtw_sta_info *si;
110 struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat;
111 u8 *bssid = iter_data->bssid;
112
113 if (!ether_addr_equal(vif->bss_conf.bssid, bssid))
114 return;
115
116 if (!(ether_addr_equal(vif->addr, hdr->addr1) ||
117 ieee80211_is_beacon(hdr->frame_control)))
118 return;
119
120 rtw_rx_phy_stat(rtwdev, pkt_stat, hdr);
121 sta = ieee80211_find_sta_by_ifaddr(rtwdev->hw, hdr->addr2,
122 vif->addr);
123 if (!sta)
124 return;
125
126 si = (struct rtw_sta_info *)sta->drv_priv;
127 ewma_rssi_add(&si->avg_rssi, pkt_stat->rssi);
128 }
129
rtw_rx_addr_match(struct rtw_dev * rtwdev,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_hdr * hdr)130 static void rtw_rx_addr_match(struct rtw_dev *rtwdev,
131 struct rtw_rx_pkt_stat *pkt_stat,
132 struct ieee80211_hdr *hdr)
133 {
134 struct rtw_rx_addr_match_data data = {};
135
136 if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status ||
137 ieee80211_is_ctl(hdr->frame_control))
138 return;
139
140 data.rtwdev = rtwdev;
141 data.hdr = hdr;
142 data.pkt_stat = pkt_stat;
143 data.bssid = get_hdr_bssid(hdr);
144
145 rtw_iterate_vifs_atomic(rtwdev, rtw_rx_addr_match_iter, &data);
146 }
147
rtw_set_rx_freq_by_pktstat(struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_rx_status * rx_status)148 static void rtw_set_rx_freq_by_pktstat(struct rtw_rx_pkt_stat *pkt_stat,
149 struct ieee80211_rx_status *rx_status)
150 {
151 rx_status->freq = pkt_stat->freq;
152 rx_status->band = pkt_stat->band;
153 }
154
rtw_update_rx_freq_from_ie(struct rtw_dev * rtwdev,struct sk_buff * skb,struct ieee80211_rx_status * rx_status,struct rtw_rx_pkt_stat * pkt_stat)155 void rtw_update_rx_freq_from_ie(struct rtw_dev *rtwdev, struct sk_buff *skb,
156 struct ieee80211_rx_status *rx_status,
157 struct rtw_rx_pkt_stat *pkt_stat)
158 {
159 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
160 int channel = rtwdev->hal.current_channel;
161 size_t hdr_len, ielen;
162 int channel_number;
163 u8 *variable;
164
165 if (!test_bit(RTW_FLAG_SCANNING, rtwdev->flags))
166 goto fill_rx_status;
167
168 if (ieee80211_is_beacon(mgmt->frame_control)) {
169 variable = mgmt->u.beacon.variable;
170 hdr_len = offsetof(struct ieee80211_mgmt,
171 u.beacon.variable);
172 } else if (ieee80211_is_probe_resp(mgmt->frame_control)) {
173 variable = mgmt->u.probe_resp.variable;
174 hdr_len = offsetof(struct ieee80211_mgmt,
175 u.probe_resp.variable);
176 } else {
177 goto fill_rx_status;
178 }
179
180 if (skb->len > hdr_len)
181 ielen = skb->len - hdr_len;
182 else
183 goto fill_rx_status;
184
185 channel_number = cfg80211_get_ies_channel_number(variable, ielen,
186 NL80211_BAND_2GHZ);
187 if (channel_number != -1)
188 channel = channel_number;
189
190 fill_rx_status:
191 rtw_set_rx_freq_band(pkt_stat, channel);
192 rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status);
193 }
194 EXPORT_SYMBOL(rtw_update_rx_freq_from_ie);
195
rtw_rx_fill_rx_status(struct rtw_dev * rtwdev,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_hdr * hdr,struct ieee80211_rx_status * rx_status)196 static void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev,
197 struct rtw_rx_pkt_stat *pkt_stat,
198 struct ieee80211_hdr *hdr,
199 struct ieee80211_rx_status *rx_status)
200 {
201 struct ieee80211_hw *hw = rtwdev->hw;
202 u8 path;
203
204 memset(rx_status, 0, sizeof(*rx_status));
205 rx_status->freq = hw->conf.chandef.chan->center_freq;
206 rx_status->band = hw->conf.chandef.chan->band;
207 if (rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_SCAN_OFFLOAD) &&
208 test_bit(RTW_FLAG_SCANNING, rtwdev->flags))
209 rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status);
210 if (pkt_stat->crc_err)
211 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
212 if (pkt_stat->decrypted)
213 rx_status->flag |= RX_FLAG_DECRYPTED;
214
215 if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0)
216 rx_status->encoding = RX_ENC_VHT;
217 else if (pkt_stat->rate >= DESC_RATEMCS0)
218 rx_status->encoding = RX_ENC_HT;
219
220 if (rx_status->band == NL80211_BAND_5GHZ &&
221 pkt_stat->rate >= DESC_RATE6M &&
222 pkt_stat->rate <= DESC_RATE54M) {
223 rx_status->rate_idx = pkt_stat->rate - DESC_RATE6M;
224 } else if (rx_status->band == NL80211_BAND_2GHZ &&
225 pkt_stat->rate >= DESC_RATE1M &&
226 pkt_stat->rate <= DESC_RATE54M) {
227 rx_status->rate_idx = pkt_stat->rate - DESC_RATE1M;
228 } else if (pkt_stat->rate >= DESC_RATEMCS0) {
229 rtw_desc_to_mcsrate(pkt_stat->rate, &rx_status->rate_idx,
230 &rx_status->nss);
231 }
232
233 rx_status->flag |= RX_FLAG_MACTIME_START;
234 rx_status->mactime = pkt_stat->tsf_low;
235
236 if (pkt_stat->bw == RTW_CHANNEL_WIDTH_80)
237 rx_status->bw = RATE_INFO_BW_80;
238 else if (pkt_stat->bw == RTW_CHANNEL_WIDTH_40)
239 rx_status->bw = RATE_INFO_BW_40;
240 else
241 rx_status->bw = RATE_INFO_BW_20;
242
243 if (pkt_stat->phy_status) {
244 rx_status->signal = pkt_stat->signal_power;
245 for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
246 rx_status->chains |= BIT(path);
247 rx_status->chain_signal[path] = pkt_stat->rx_power[path];
248 }
249 } else {
250 rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
251 }
252
253 rtw_rx_addr_match(rtwdev, pkt_stat, hdr);
254
255 /* Rtl8723cs driver checks for size < 14 or size > 8192 and
256 * simply drops the packet.
257 */
258 if (rtwdev->chip->id == RTW_CHIP_TYPE_8703B && pkt_stat->pkt_len == 0) {
259 rx_status->flag |= RX_FLAG_NO_PSDU;
260 rtw_dbg(rtwdev, RTW_DBG_RX, "zero length packet");
261 }
262 }
263
rtw_rx_query_rx_desc(struct rtw_dev * rtwdev,void * rx_desc8,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_rx_status * rx_status)264 void rtw_rx_query_rx_desc(struct rtw_dev *rtwdev, void *rx_desc8,
265 struct rtw_rx_pkt_stat *pkt_stat,
266 struct ieee80211_rx_status *rx_status)
267 {
268 u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz;
269 struct rtw_rx_desc *rx_desc = rx_desc8;
270 struct ieee80211_hdr *hdr;
271 u32 enc_type, swdec;
272 void *phy_status;
273
274 memset(pkt_stat, 0, sizeof(*pkt_stat));
275
276 pkt_stat->pkt_len = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_PKT_LEN);
277 pkt_stat->crc_err = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_CRC32);
278 pkt_stat->icv_err = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_ICV_ERR);
279 pkt_stat->drv_info_sz = le32_get_bits(rx_desc->w0,
280 RTW_RX_DESC_W0_DRV_INFO_SIZE);
281 enc_type = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_ENC_TYPE);
282 pkt_stat->shift = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_SHIFT);
283 pkt_stat->phy_status = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_PHYST);
284 swdec = le32_get_bits(rx_desc->w0, RTW_RX_DESC_W0_SWDEC);
285 pkt_stat->decrypted = !swdec && enc_type != RX_DESC_ENC_NONE;
286
287 pkt_stat->cam_id = le32_get_bits(rx_desc->w1, RTW_RX_DESC_W1_MACID);
288
289 pkt_stat->is_c2h = le32_get_bits(rx_desc->w2, RTW_RX_DESC_W2_C2H);
290 pkt_stat->ppdu_cnt = le32_get_bits(rx_desc->w2, RTW_RX_DESC_W2_PPDU_CNT);
291
292 pkt_stat->rate = le32_get_bits(rx_desc->w3, RTW_RX_DESC_W3_RX_RATE);
293
294 pkt_stat->bw = le32_get_bits(rx_desc->w4, RTW_RX_DESC_W4_BW);
295
296 pkt_stat->tsf_low = le32_get_bits(rx_desc->w5, RTW_RX_DESC_W5_TSFL);
297
298 /* drv_info_sz is in unit of 8-bytes */
299 pkt_stat->drv_info_sz *= 8;
300
301 /* c2h cmd pkt's rx/phy status is not interested */
302 if (pkt_stat->is_c2h)
303 return;
304
305 phy_status = rx_desc8 + desc_sz + pkt_stat->shift;
306 hdr = phy_status + pkt_stat->drv_info_sz;
307 pkt_stat->hdr = hdr;
308
309 if (pkt_stat->phy_status)
310 rtwdev->chip->ops->query_phy_status(rtwdev, phy_status, pkt_stat);
311
312 rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status);
313 }
314 EXPORT_SYMBOL(rtw_rx_query_rx_desc);
315