1 /******************************************************************************
2  *
3  * Copyright(c) 2009-2012  Realtek Corporation.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of version 2 of the GNU General Public License as
7  * published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
13  *
14  * The full GNU General Public License is included in this distribution in the
15  * file called LICENSE.
16  *
17  * Contact Information:
18  * wlanfae <wlanfae@realtek.com>
19  * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
20  * Hsinchu 300, Taiwan.
21  *
22  * Larry Finger <Larry.Finger@lwfinger.net>
23  *
24  *****************************************************************************/
25 #include "wifi.h"
26 #include "stats.h"
27 #include <linux/export.h>
28 
29 u8 rtl_query_rxpwrpercentage(s8 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 }
38 EXPORT_SYMBOL(rtl_query_rxpwrpercentage);
39 
40 u8 rtl_evm_db_to_percentage(s8 value)
41 {
42 	s8 ret_val = clamp(-value, 0, 33) * 3;
43 
44 	if (ret_val == 99)
45 		ret_val = 100;
46 
47 	return ret_val;
48 }
49 EXPORT_SYMBOL(rtl_evm_db_to_percentage);
50 
51 static long rtl_translate_todbm(struct ieee80211_hw *hw,
52 			 u8 signal_strength_index)
53 {
54 	long signal_power;
55 
56 	signal_power = (long)((signal_strength_index + 1) >> 1);
57 	signal_power -= 95;
58 	return signal_power;
59 }
60 
61 long rtl_signal_scale_mapping(struct ieee80211_hw *hw, long currsig)
62 {
63 	long retsig;
64 
65 	if (currsig >= 61 && currsig <= 100)
66 		retsig = 90 + ((currsig - 60) / 4);
67 	else if (currsig >= 41 && currsig <= 60)
68 		retsig = 78 + ((currsig - 40) / 2);
69 	else if (currsig >= 31 && currsig <= 40)
70 		retsig = 66 + (currsig - 30);
71 	else if (currsig >= 21 && currsig <= 30)
72 		retsig = 54 + (currsig - 20);
73 	else if (currsig >= 5 && currsig <= 20)
74 		retsig = 42 + (((currsig - 5) * 2) / 3);
75 	else if (currsig == 4)
76 		retsig = 36;
77 	else if (currsig == 3)
78 		retsig = 27;
79 	else if (currsig == 2)
80 		retsig = 18;
81 	else if (currsig == 1)
82 		retsig = 9;
83 	else
84 		retsig = currsig;
85 
86 	return retsig;
87 }
88 EXPORT_SYMBOL(rtl_signal_scale_mapping);
89 
90 static void rtl_process_ui_rssi(struct ieee80211_hw *hw,
91 				struct rtl_stats *pstatus)
92 {
93 	struct rtl_priv *rtlpriv = rtl_priv(hw);
94 	struct rtl_phy *rtlphy = &(rtlpriv->phy);
95 	u8 rfpath;
96 	u32 last_rssi, tmpval;
97 
98 	if (!pstatus->packet_toself && !pstatus->packet_beacon)
99 		return;
100 
101 	rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
102 	rtlpriv->stats.rssi_calculate_cnt++;
103 
104 	if (rtlpriv->stats.ui_rssi.total_num++ >= PHY_RSSI_SLID_WIN_MAX) {
105 		rtlpriv->stats.ui_rssi.total_num = PHY_RSSI_SLID_WIN_MAX;
106 		last_rssi = rtlpriv->stats.ui_rssi.elements[
107 			rtlpriv->stats.ui_rssi.index];
108 		rtlpriv->stats.ui_rssi.total_val -= last_rssi;
109 	}
110 	rtlpriv->stats.ui_rssi.total_val += pstatus->signalstrength;
111 	rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++] =
112 	    pstatus->signalstrength;
113 	if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
114 		rtlpriv->stats.ui_rssi.index = 0;
115 	tmpval = rtlpriv->stats.ui_rssi.total_val /
116 		rtlpriv->stats.ui_rssi.total_num;
117 	rtlpriv->stats.signal_strength = rtl_translate_todbm(hw,
118 		(u8) tmpval);
119 	pstatus->rssi = rtlpriv->stats.signal_strength;
120 
121 	if (pstatus->is_cck)
122 		return;
123 
124 	for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
125 	     rfpath++) {
126 		if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
127 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
128 			    pstatus->rx_mimo_signalstrength[rfpath];
129 
130 		}
131 		if (pstatus->rx_mimo_signalstrength[rfpath] >
132 		    rtlpriv->stats.rx_rssi_percentage[rfpath]) {
133 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
134 			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
135 			      (RX_SMOOTH_FACTOR - 1)) +
136 			     (pstatus->rx_mimo_signalstrength[rfpath])) /
137 			    (RX_SMOOTH_FACTOR);
138 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
139 			    rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
140 		} else {
141 			rtlpriv->stats.rx_rssi_percentage[rfpath] =
142 			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
143 			      (RX_SMOOTH_FACTOR - 1)) +
144 			     (pstatus->rx_mimo_signalstrength[rfpath])) /
145 			    (RX_SMOOTH_FACTOR);
146 		}
147 		rtlpriv->stats.rx_snr_db[rfpath] = pstatus->rx_snr[rfpath];
148 		rtlpriv->stats.rx_evm_dbm[rfpath] =
149 					pstatus->rx_mimo_evm_dbm[rfpath];
150 		rtlpriv->stats.rx_cfo_short[rfpath] =
151 					pstatus->cfo_short[rfpath];
152 		rtlpriv->stats.rx_cfo_tail[rfpath] = pstatus->cfo_tail[rfpath];
153 	}
154 }
155 
156 static void rtl_update_rxsignalstatistics(struct ieee80211_hw *hw,
157 					  struct rtl_stats *pstatus)
158 {
159 	struct rtl_priv *rtlpriv = rtl_priv(hw);
160 	int weighting = 0;
161 
162 	if (rtlpriv->stats.recv_signal_power == 0)
163 		rtlpriv->stats.recv_signal_power = pstatus->recvsignalpower;
164 	if (pstatus->recvsignalpower > rtlpriv->stats.recv_signal_power)
165 		weighting = 5;
166 	else if (pstatus->recvsignalpower < rtlpriv->stats.recv_signal_power)
167 		weighting = (-5);
168 	rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power *
169 		5 + pstatus->recvsignalpower + weighting) / 6;
170 }
171 
172 static void rtl_process_pwdb(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
173 {
174 	struct rtl_priv *rtlpriv = rtl_priv(hw);
175 	struct rtl_sta_info *drv_priv = NULL;
176 	struct ieee80211_sta *sta = NULL;
177 	long undec_sm_pwdb;
178 
179 	rcu_read_lock();
180 	if (rtlpriv->mac80211.opmode != NL80211_IFTYPE_STATION)
181 		sta = rtl_find_sta(hw, pstatus->psaddr);
182 
183 	/* adhoc or ap mode */
184 	if (sta) {
185 		drv_priv = (struct rtl_sta_info *) sta->drv_priv;
186 		undec_sm_pwdb = drv_priv->rssi_stat.undec_sm_pwdb;
187 	} else {
188 		undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;
189 	}
190 
191 	if (undec_sm_pwdb < 0)
192 		undec_sm_pwdb = pstatus->rx_pwdb_all;
193 	if (pstatus->rx_pwdb_all > (u32) undec_sm_pwdb) {
194 		undec_sm_pwdb = (((undec_sm_pwdb) *
195 		      (RX_SMOOTH_FACTOR - 1)) +
196 		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
197 		undec_sm_pwdb = undec_sm_pwdb + 1;
198 	} else {
199 		undec_sm_pwdb = (((undec_sm_pwdb) *
200 		      (RX_SMOOTH_FACTOR - 1)) +
201 		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
202 	}
203 
204 	if (sta) {
205 		drv_priv->rssi_stat.undec_sm_pwdb = undec_sm_pwdb;
206 	} else {
207 		rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
208 	}
209 	rcu_read_unlock();
210 
211 	rtl_update_rxsignalstatistics(hw, pstatus);
212 }
213 
214 static void rtl_process_ui_link_quality(struct ieee80211_hw *hw,
215 					struct rtl_stats *pstatus)
216 {
217 	struct rtl_priv *rtlpriv = rtl_priv(hw);
218 	u32 last_evm, n_stream, tmpval;
219 
220 	if (pstatus->signalquality == 0)
221 		return;
222 
223 	if (rtlpriv->stats.ui_link_quality.total_num++ >=
224 	    PHY_LINKQUALITY_SLID_WIN_MAX) {
225 		rtlpriv->stats.ui_link_quality.total_num =
226 		    PHY_LINKQUALITY_SLID_WIN_MAX;
227 		last_evm = rtlpriv->stats.ui_link_quality.elements[
228 			rtlpriv->stats.ui_link_quality.index];
229 		rtlpriv->stats.ui_link_quality.total_val -= last_evm;
230 	}
231 	rtlpriv->stats.ui_link_quality.total_val += pstatus->signalquality;
232 	rtlpriv->stats.ui_link_quality.elements[
233 		rtlpriv->stats.ui_link_quality.index++] =
234 							pstatus->signalquality;
235 	if (rtlpriv->stats.ui_link_quality.index >=
236 	    PHY_LINKQUALITY_SLID_WIN_MAX)
237 		rtlpriv->stats.ui_link_quality.index = 0;
238 	tmpval = rtlpriv->stats.ui_link_quality.total_val /
239 	    rtlpriv->stats.ui_link_quality.total_num;
240 	rtlpriv->stats.signal_quality = tmpval;
241 	rtlpriv->stats.last_sigstrength_inpercent = tmpval;
242 	for (n_stream = 0; n_stream < 2; n_stream++) {
243 		if (pstatus->rx_mimo_sig_qual[n_stream] != -1) {
244 			if (rtlpriv->stats.rx_evm_percentage[n_stream] == 0) {
245 				rtlpriv->stats.rx_evm_percentage[n_stream] =
246 				    pstatus->rx_mimo_sig_qual[n_stream];
247 			}
248 			rtlpriv->stats.rx_evm_percentage[n_stream] =
249 			    ((rtlpriv->stats.rx_evm_percentage[n_stream]
250 			      * (RX_SMOOTH_FACTOR - 1)) +
251 			     (pstatus->rx_mimo_sig_qual[n_stream] * 1)) /
252 			    (RX_SMOOTH_FACTOR);
253 		}
254 	}
255 }
256 
257 void rtl_process_phyinfo(struct ieee80211_hw *hw, u8 *buffer,
258 			 struct rtl_stats *pstatus)
259 {
260 
261 	if (!pstatus->packet_matchbssid)
262 		return;
263 
264 	rtl_process_ui_rssi(hw, pstatus);
265 	rtl_process_pwdb(hw, pstatus);
266 	rtl_process_ui_link_quality(hw, pstatus);
267 }
268 EXPORT_SYMBOL(rtl_process_phyinfo);
269