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