1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2012  Realtek Corporation.*/
3 
4 #include "wifi.h"
5 #include "stats.h"
6 #include <linux/export.h>
7 
rtl_query_rxpwrpercentage(s8 antpower)8 u8 rtl_query_rxpwrpercentage(s8 antpower)
9 {
10 	if ((antpower <= -100) || (antpower >= 20))
11 		return 0;
12 	else if (antpower >= 0)
13 		return 100;
14 	else
15 		return 100 + antpower;
16 }
17 EXPORT_SYMBOL(rtl_query_rxpwrpercentage);
18 
rtl_evm_db_to_percentage(s8 value)19 u8 rtl_evm_db_to_percentage(s8 value)
20 {
21 	s8 ret_val = clamp(-value, 0, 33) * 3;
22 
23 	if (ret_val == 99)
24 		ret_val = 100;
25 
26 	return ret_val;
27 }
28 EXPORT_SYMBOL(rtl_evm_db_to_percentage);
29 
rtl_translate_todbm(struct ieee80211_hw * hw,u8 signal_strength_index)30 static long rtl_translate_todbm(struct ieee80211_hw *hw,
31 			 u8 signal_strength_index)
32 {
33 	long signal_power;
34 
35 	signal_power = (long)((signal_strength_index + 1) >> 1);
36 	signal_power -= 95;
37 	return signal_power;
38 }
39 
rtl_signal_scale_mapping(struct ieee80211_hw * hw,long currsig)40 long rtl_signal_scale_mapping(struct ieee80211_hw *hw, long currsig)
41 {
42 	long retsig;
43 
44 	if (currsig >= 61 && currsig <= 100)
45 		retsig = 90 + ((currsig - 60) / 4);
46 	else if (currsig >= 41 && currsig <= 60)
47 		retsig = 78 + ((currsig - 40) / 2);
48 	else if (currsig >= 31 && currsig <= 40)
49 		retsig = 66 + (currsig - 30);
50 	else if (currsig >= 21 && currsig <= 30)
51 		retsig = 54 + (currsig - 20);
52 	else if (currsig >= 5 && currsig <= 20)
53 		retsig = 42 + (((currsig - 5) * 2) / 3);
54 	else if (currsig == 4)
55 		retsig = 36;
56 	else if (currsig == 3)
57 		retsig = 27;
58 	else if (currsig == 2)
59 		retsig = 18;
60 	else if (currsig == 1)
61 		retsig = 9;
62 	else
63 		retsig = currsig;
64 
65 	return retsig;
66 }
67 EXPORT_SYMBOL(rtl_signal_scale_mapping);
68 
rtl_process_ui_rssi(struct ieee80211_hw * hw,struct rtl_stats * pstatus)69 static void rtl_process_ui_rssi(struct ieee80211_hw *hw,
70 				struct rtl_stats *pstatus)
71 {
72 	struct rtl_priv *rtlpriv = rtl_priv(hw);
73 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
74 	u8 rfpath;
75 	u32 last_rssi, tmpval;
76 
77 	if (!pstatus->packet_toself && !pstatus->packet_beacon)
78 		return;
79 
80 	rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
81 	rtlpriv->stats.rssi_calculate_cnt++;
82 
83 	if (rtlpriv->stats.ui_rssi.total_num++ >= PHY_RSSI_SLID_WIN_MAX) {
84 		rtlpriv->stats.ui_rssi.total_num = PHY_RSSI_SLID_WIN_MAX;
85 		last_rssi = rtlpriv->stats.ui_rssi.elements[
86 			rtlpriv->stats.ui_rssi.index];
87 		rtlpriv->stats.ui_rssi.total_val -= last_rssi;
88 	}
89 	rtlpriv->stats.ui_rssi.total_val += pstatus->signalstrength;
90 	rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++] =
91 	    pstatus->signalstrength;
92 	if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
93 		rtlpriv->stats.ui_rssi.index = 0;
94 	tmpval = rtlpriv->stats.ui_rssi.total_val /
95 		rtlpriv->stats.ui_rssi.total_num;
96 	rtlpriv->stats.signal_strength = rtl_translate_todbm(hw,
97 		(u8) tmpval);
98 	pstatus->rssi = rtlpriv->stats.signal_strength;
99 
100 	if (pstatus->is_cck)
101 		return;
102 
103 	for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
104 	     rfpath++) {
105 		if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
106 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
107 			    pstatus->rx_mimo_signalstrength[rfpath];
108 
109 		}
110 		if (pstatus->rx_mimo_signalstrength[rfpath] >
111 		    rtlpriv->stats.rx_rssi_percentage[rfpath]) {
112 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
113 			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
114 			      (RX_SMOOTH_FACTOR - 1)) +
115 			     (pstatus->rx_mimo_signalstrength[rfpath])) /
116 			    (RX_SMOOTH_FACTOR);
117 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
118 			    rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
119 		} else {
120 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
121 			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
122 			      (RX_SMOOTH_FACTOR - 1)) +
123 			     (pstatus->rx_mimo_signalstrength[rfpath])) /
124 			    (RX_SMOOTH_FACTOR);
125 		}
126 		rtlpriv->stats.rx_snr_db[rfpath] = pstatus->rx_snr[rfpath];
127 		rtlpriv->stats.rx_evm_dbm[rfpath] =
128 					pstatus->rx_mimo_evm_dbm[rfpath];
129 		rtlpriv->stats.rx_cfo_short[rfpath] =
130 					pstatus->cfo_short[rfpath];
131 		rtlpriv->stats.rx_cfo_tail[rfpath] = pstatus->cfo_tail[rfpath];
132 	}
133 }
134 
rtl_update_rxsignalstatistics(struct ieee80211_hw * hw,struct rtl_stats * pstatus)135 static void rtl_update_rxsignalstatistics(struct ieee80211_hw *hw,
136 					  struct rtl_stats *pstatus)
137 {
138 	struct rtl_priv *rtlpriv = rtl_priv(hw);
139 	int weighting = 0;
140 
141 	if (rtlpriv->stats.recv_signal_power == 0)
142 		rtlpriv->stats.recv_signal_power = pstatus->recvsignalpower;
143 	if (pstatus->recvsignalpower > rtlpriv->stats.recv_signal_power)
144 		weighting = 5;
145 	else if (pstatus->recvsignalpower < rtlpriv->stats.recv_signal_power)
146 		weighting = (-5);
147 	rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power *
148 		5 + pstatus->recvsignalpower + weighting) / 6;
149 }
150 
rtl_process_pwdb(struct ieee80211_hw * hw,struct rtl_stats * pstatus)151 static void rtl_process_pwdb(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
152 {
153 	struct rtl_priv *rtlpriv = rtl_priv(hw);
154 	struct rtl_sta_info *drv_priv = NULL;
155 	struct ieee80211_sta *sta = NULL;
156 	long undec_sm_pwdb;
157 
158 	rcu_read_lock();
159 	if (rtlpriv->mac80211.opmode != NL80211_IFTYPE_STATION)
160 		sta = rtl_find_sta(hw, pstatus->psaddr);
161 
162 	/* adhoc or ap mode */
163 	if (sta) {
164 		drv_priv = (struct rtl_sta_info *) sta->drv_priv;
165 		undec_sm_pwdb = drv_priv->rssi_stat.undec_sm_pwdb;
166 	} else {
167 		undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;
168 	}
169 
170 	if (undec_sm_pwdb < 0)
171 		undec_sm_pwdb = pstatus->rx_pwdb_all;
172 	if (pstatus->rx_pwdb_all > (u32) undec_sm_pwdb) {
173 		undec_sm_pwdb = (((undec_sm_pwdb) *
174 		      (RX_SMOOTH_FACTOR - 1)) +
175 		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
176 		undec_sm_pwdb = undec_sm_pwdb + 1;
177 	} else {
178 		undec_sm_pwdb = (((undec_sm_pwdb) *
179 		      (RX_SMOOTH_FACTOR - 1)) +
180 		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
181 	}
182 
183 	if (sta) {
184 		drv_priv->rssi_stat.undec_sm_pwdb = undec_sm_pwdb;
185 	} else {
186 		rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
187 	}
188 	rcu_read_unlock();
189 
190 	rtl_update_rxsignalstatistics(hw, pstatus);
191 }
192 
rtl_process_ui_link_quality(struct ieee80211_hw * hw,struct rtl_stats * pstatus)193 static void rtl_process_ui_link_quality(struct ieee80211_hw *hw,
194 					struct rtl_stats *pstatus)
195 {
196 	struct rtl_priv *rtlpriv = rtl_priv(hw);
197 	u32 last_evm, n_stream, tmpval;
198 
199 	if (pstatus->signalquality == 0)
200 		return;
201 
202 	if (rtlpriv->stats.ui_link_quality.total_num++ >=
203 	    PHY_LINKQUALITY_SLID_WIN_MAX) {
204 		rtlpriv->stats.ui_link_quality.total_num =
205 		    PHY_LINKQUALITY_SLID_WIN_MAX;
206 		last_evm = rtlpriv->stats.ui_link_quality.elements[
207 			rtlpriv->stats.ui_link_quality.index];
208 		rtlpriv->stats.ui_link_quality.total_val -= last_evm;
209 	}
210 	rtlpriv->stats.ui_link_quality.total_val += pstatus->signalquality;
211 	rtlpriv->stats.ui_link_quality.elements[
212 		rtlpriv->stats.ui_link_quality.index++] =
213 							pstatus->signalquality;
214 	if (rtlpriv->stats.ui_link_quality.index >=
215 	    PHY_LINKQUALITY_SLID_WIN_MAX)
216 		rtlpriv->stats.ui_link_quality.index = 0;
217 	tmpval = rtlpriv->stats.ui_link_quality.total_val /
218 	    rtlpriv->stats.ui_link_quality.total_num;
219 	rtlpriv->stats.signal_quality = tmpval;
220 	rtlpriv->stats.last_sigstrength_inpercent = tmpval;
221 	for (n_stream = 0; n_stream < 2; n_stream++) {
222 		if (pstatus->rx_mimo_sig_qual[n_stream] != -1) {
223 			if (rtlpriv->stats.rx_evm_percentage[n_stream] == 0) {
224 				rtlpriv->stats.rx_evm_percentage[n_stream] =
225 				    pstatus->rx_mimo_sig_qual[n_stream];
226 			}
227 			rtlpriv->stats.rx_evm_percentage[n_stream] =
228 			    ((rtlpriv->stats.rx_evm_percentage[n_stream]
229 			      * (RX_SMOOTH_FACTOR - 1)) +
230 			     (pstatus->rx_mimo_sig_qual[n_stream] * 1)) /
231 			    (RX_SMOOTH_FACTOR);
232 		}
233 	}
234 }
235 
rtl_process_phyinfo(struct ieee80211_hw * hw,u8 * buffer,struct rtl_stats * pstatus)236 void rtl_process_phyinfo(struct ieee80211_hw *hw, u8 *buffer,
237 			 struct rtl_stats *pstatus)
238 {
239 
240 	if (!pstatus->packet_matchbssid)
241 		return;
242 
243 	rtl_process_ui_rssi(hw, pstatus);
244 	rtl_process_pwdb(hw, pstatus);
245 	rtl_process_ui_link_quality(hw, pstatus);
246 }
247 EXPORT_SYMBOL(rtl_process_phyinfo);
248