rx.c

  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
 11void 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}
 33EXPORT_SYMBOL(rtw_rx_stats);
 34
 35struct 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
 42static 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	}
 98pkt_num:
 99	cur_pkt_cnt->num_qry_pkt[pkt_stat->rate]++;
100}
101
102static 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
130static 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
148static 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
155void 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
190fill_rx_status:
191	rtw_set_rx_freq_band(pkt_stat, channel);
192	rtw_set_rx_freq_by_pktstat(pkt_stat, rx_status);
193}
194EXPORT_SYMBOL(rtw_update_rx_freq_from_ie);
195
196static 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
264void 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}
314EXPORT_SYMBOL(rtw_rx_query_rx_desc);