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
rtw_rx_stats(struct rtw_dev * rtwdev,struct ieee80211_vif * vif,struct sk_buff * skb)9 void rtw_rx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif,
10 struct sk_buff *skb)
11 {
12 struct ieee80211_hdr *hdr;
13 struct rtw_vif *rtwvif;
14
15 hdr = (struct ieee80211_hdr *)skb->data;
16
17 if (!ieee80211_is_data(hdr->frame_control))
18 return;
19
20 if (!is_broadcast_ether_addr(hdr->addr1) &&
21 !is_multicast_ether_addr(hdr->addr1)) {
22 rtwdev->stats.rx_unicast += skb->len;
23 rtwdev->stats.rx_cnt++;
24 if (vif) {
25 rtwvif = (struct rtw_vif *)vif->drv_priv;
26 rtwvif->stats.rx_unicast += skb->len;
27 rtwvif->stats.rx_cnt++;
28 if (rtwvif->stats.rx_cnt > RTW_LPS_THRESHOLD)
29 rtw_leave_lps_irqsafe(rtwdev, rtwvif);
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_addr_match_iter(void * data,u8 * mac,struct ieee80211_vif * vif)42 static void rtw_rx_addr_match_iter(void *data, u8 *mac,
43 struct ieee80211_vif *vif)
44 {
45 struct rtw_rx_addr_match_data *iter_data = data;
46 struct ieee80211_sta *sta;
47 struct ieee80211_hdr *hdr = iter_data->hdr;
48 struct rtw_dev *rtwdev = iter_data->rtwdev;
49 struct rtw_sta_info *si;
50 struct rtw_rx_pkt_stat *pkt_stat = iter_data->pkt_stat;
51 u8 *bssid = iter_data->bssid;
52
53 if (ether_addr_equal(vif->bss_conf.bssid, bssid) &&
54 (ether_addr_equal(vif->addr, hdr->addr1) ||
55 ieee80211_is_beacon(hdr->frame_control)))
56 sta = ieee80211_find_sta_by_ifaddr(rtwdev->hw, hdr->addr2,
57 vif->addr);
58 else
59 return;
60
61 if (!sta)
62 return;
63
64 si = (struct rtw_sta_info *)sta->drv_priv;
65 ewma_rssi_add(&si->avg_rssi, pkt_stat->rssi);
66 }
67
rtw_rx_addr_match(struct rtw_dev * rtwdev,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_hdr * hdr)68 static void rtw_rx_addr_match(struct rtw_dev *rtwdev,
69 struct rtw_rx_pkt_stat *pkt_stat,
70 struct ieee80211_hdr *hdr)
71 {
72 struct rtw_rx_addr_match_data data = {};
73
74 if (pkt_stat->crc_err || pkt_stat->icv_err || !pkt_stat->phy_status ||
75 ieee80211_is_ctl(hdr->frame_control))
76 return;
77
78 data.rtwdev = rtwdev;
79 data.hdr = hdr;
80 data.pkt_stat = pkt_stat;
81 data.bssid = get_hdr_bssid(hdr);
82
83 rtw_iterate_vifs_atomic(rtwdev, rtw_rx_addr_match_iter, &data);
84 }
85
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,u8 * phy_status)86 void rtw_rx_fill_rx_status(struct rtw_dev *rtwdev,
87 struct rtw_rx_pkt_stat *pkt_stat,
88 struct ieee80211_hdr *hdr,
89 struct ieee80211_rx_status *rx_status,
90 u8 *phy_status)
91 {
92 struct ieee80211_hw *hw = rtwdev->hw;
93 u8 path;
94
95 memset(rx_status, 0, sizeof(*rx_status));
96 rx_status->freq = hw->conf.chandef.chan->center_freq;
97 rx_status->band = hw->conf.chandef.chan->band;
98 if (pkt_stat->crc_err)
99 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
100 if (pkt_stat->decrypted)
101 rx_status->flag |= RX_FLAG_DECRYPTED;
102
103 if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0)
104 rx_status->encoding = RX_ENC_VHT;
105 else if (pkt_stat->rate >= DESC_RATEMCS0)
106 rx_status->encoding = RX_ENC_HT;
107
108 if (pkt_stat->rate >= DESC_RATEVHT1SS_MCS0 &&
109 pkt_stat->rate <= DESC_RATEVHT1SS_MCS9) {
110 rx_status->nss = 1;
111 rx_status->rate_idx = pkt_stat->rate - DESC_RATEVHT1SS_MCS0;
112 } else if (pkt_stat->rate >= DESC_RATEVHT2SS_MCS0 &&
113 pkt_stat->rate <= DESC_RATEVHT2SS_MCS9) {
114 rx_status->nss = 2;
115 rx_status->rate_idx = pkt_stat->rate - DESC_RATEVHT2SS_MCS0;
116 } else if (pkt_stat->rate >= DESC_RATEVHT3SS_MCS0 &&
117 pkt_stat->rate <= DESC_RATEVHT3SS_MCS9) {
118 rx_status->nss = 3;
119 rx_status->rate_idx = pkt_stat->rate - DESC_RATEVHT3SS_MCS0;
120 } else if (pkt_stat->rate >= DESC_RATEVHT4SS_MCS0 &&
121 pkt_stat->rate <= DESC_RATEVHT4SS_MCS9) {
122 rx_status->nss = 4;
123 rx_status->rate_idx = pkt_stat->rate - DESC_RATEVHT4SS_MCS0;
124 } else if (pkt_stat->rate >= DESC_RATEMCS0 &&
125 pkt_stat->rate <= DESC_RATEMCS15) {
126 rx_status->rate_idx = pkt_stat->rate - DESC_RATEMCS0;
127 } else if (rx_status->band == NL80211_BAND_5GHZ &&
128 pkt_stat->rate >= DESC_RATE6M &&
129 pkt_stat->rate <= DESC_RATE54M) {
130 rx_status->rate_idx = pkt_stat->rate - DESC_RATE6M;
131 } else if (rx_status->band == NL80211_BAND_2GHZ &&
132 pkt_stat->rate >= DESC_RATE1M &&
133 pkt_stat->rate <= DESC_RATE54M) {
134 rx_status->rate_idx = pkt_stat->rate - DESC_RATE1M;
135 } else {
136 rx_status->rate_idx = 0;
137 }
138
139 rx_status->flag |= RX_FLAG_MACTIME_START;
140 rx_status->mactime = pkt_stat->tsf_low;
141
142 if (pkt_stat->bw == RTW_CHANNEL_WIDTH_80)
143 rx_status->bw = RATE_INFO_BW_80;
144 else if (pkt_stat->bw == RTW_CHANNEL_WIDTH_40)
145 rx_status->bw = RATE_INFO_BW_40;
146 else
147 rx_status->bw = RATE_INFO_BW_20;
148
149 rx_status->signal = pkt_stat->signal_power;
150 for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
151 rx_status->chains |= BIT(path);
152 rx_status->chain_signal[path] = pkt_stat->rx_power[path];
153 }
154
155 rtw_rx_addr_match(rtwdev, pkt_stat, hdr);
156 }
157