1 /******************************************************************************
3 * Copyright(c) 2009-2012 Realtek Corporation.
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.
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
14 * The full GNU General Public License is included in this distribution in the
15 * file called LICENSE.
17 * Contact Information:
18 * wlanfae <wlanfae@realtek.com>
19 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
20 * Hsinchu 300, Taiwan.
22 * Larry Finger <Larry.Finger@lwfinger.net>
24 *****************************************************************************/
27 #include <linux/export.h>
29 u8 rtl_query_rxpwrpercentage(char antpower)
31 if ((antpower <= -100) || (antpower >= 20))
33 else if (antpower >= 0)
36 return 100 + antpower;
38 EXPORT_SYMBOL(rtl_query_rxpwrpercentage);
40 u8 rtl_evm_db_to_percentage(char value)
42 char ret_val = clamp(-value, 0, 33) * 3;
49 EXPORT_SYMBOL(rtl_evm_db_to_percentage);
51 u8 rtl_evm_dbm_jaguar(char value)
55 /* -33dB~0dB to 33dB ~ 0dB*/
59 ret_val = 0 - ret_val;
61 ret_val = ret_val >> 1;
64 EXPORT_SYMBOL(rtl_evm_dbm_jaguar);
66 static long rtl_translate_todbm(struct ieee80211_hw *hw,
67 u8 signal_strength_index)
71 signal_power = (long)((signal_strength_index + 1) >> 1);
76 long rtl_signal_scale_mapping(struct ieee80211_hw *hw, long currsig)
80 if (currsig >= 61 && currsig <= 100)
81 retsig = 90 + ((currsig - 60) / 4);
82 else if (currsig >= 41 && currsig <= 60)
83 retsig = 78 + ((currsig - 40) / 2);
84 else if (currsig >= 31 && currsig <= 40)
85 retsig = 66 + (currsig - 30);
86 else if (currsig >= 21 && currsig <= 30)
87 retsig = 54 + (currsig - 20);
88 else if (currsig >= 5 && currsig <= 20)
89 retsig = 42 + (((currsig - 5) * 2) / 3);
90 else if (currsig == 4)
92 else if (currsig == 3)
94 else if (currsig == 2)
96 else if (currsig == 1)
103 EXPORT_SYMBOL(rtl_signal_scale_mapping);
105 static void rtl_process_ui_rssi(struct ieee80211_hw *hw,
106 struct rtl_stats *pstatus)
108 struct rtl_priv *rtlpriv = rtl_priv(hw);
109 struct rtl_phy *rtlphy = &(rtlpriv->phy);
111 u32 last_rssi, tmpval;
113 if (!pstatus->packet_toself && !pstatus->packet_beacon)
116 rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
117 rtlpriv->stats.rssi_calculate_cnt++;
119 if (rtlpriv->stats.ui_rssi.total_num++ >= PHY_RSSI_SLID_WIN_MAX) {
120 rtlpriv->stats.ui_rssi.total_num = PHY_RSSI_SLID_WIN_MAX;
121 last_rssi = rtlpriv->stats.ui_rssi.elements[
122 rtlpriv->stats.ui_rssi.index];
123 rtlpriv->stats.ui_rssi.total_val -= last_rssi;
125 rtlpriv->stats.ui_rssi.total_val += pstatus->signalstrength;
126 rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++] =
127 pstatus->signalstrength;
128 if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
129 rtlpriv->stats.ui_rssi.index = 0;
130 tmpval = rtlpriv->stats.ui_rssi.total_val /
131 rtlpriv->stats.ui_rssi.total_num;
132 rtlpriv->stats.signal_strength = rtl_translate_todbm(hw,
134 pstatus->rssi = rtlpriv->stats.signal_strength;
139 for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
141 if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
142 rtlpriv->stats.rx_rssi_percentage[rfpath] =
143 pstatus->rx_mimo_signalstrength[rfpath];
146 if (pstatus->rx_mimo_signalstrength[rfpath] >
147 rtlpriv->stats.rx_rssi_percentage[rfpath]) {
148 rtlpriv->stats.rx_rssi_percentage[rfpath] =
149 ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
150 (RX_SMOOTH_FACTOR - 1)) +
151 (pstatus->rx_mimo_signalstrength[rfpath])) /
153 rtlpriv->stats.rx_rssi_percentage[rfpath] =
154 rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
156 rtlpriv->stats.rx_rssi_percentage[rfpath] =
157 ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
158 (RX_SMOOTH_FACTOR - 1)) +
159 (pstatus->rx_mimo_signalstrength[rfpath])) /
162 rtlpriv->stats.rx_snr_db[rfpath] = pstatus->rx_snr[rfpath];
163 rtlpriv->stats.rx_evm_dbm[rfpath] =
164 pstatus->rx_mimo_evm_dbm[rfpath];
165 rtlpriv->stats.rx_cfo_short[rfpath] =
166 pstatus->cfo_short[rfpath];
167 rtlpriv->stats.rx_cfo_tail[rfpath] = pstatus->cfo_tail[rfpath];
171 static void rtl_update_rxsignalstatistics(struct ieee80211_hw *hw,
172 struct rtl_stats *pstatus)
174 struct rtl_priv *rtlpriv = rtl_priv(hw);
177 if (rtlpriv->stats.recv_signal_power == 0)
178 rtlpriv->stats.recv_signal_power = pstatus->recvsignalpower;
179 if (pstatus->recvsignalpower > rtlpriv->stats.recv_signal_power)
181 else if (pstatus->recvsignalpower < rtlpriv->stats.recv_signal_power)
183 rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power *
184 5 + pstatus->recvsignalpower + weighting) / 6;
187 static void rtl_process_pwdb(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
189 struct rtl_priv *rtlpriv = rtl_priv(hw);
190 struct rtl_sta_info *drv_priv = NULL;
191 struct ieee80211_sta *sta = NULL;
195 if (rtlpriv->mac80211.opmode != NL80211_IFTYPE_STATION)
196 sta = rtl_find_sta(hw, pstatus->psaddr);
198 /* adhoc or ap mode */
200 drv_priv = (struct rtl_sta_info *) sta->drv_priv;
201 undec_sm_pwdb = drv_priv->rssi_stat.undec_sm_pwdb;
203 undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;
206 if (undec_sm_pwdb < 0)
207 undec_sm_pwdb = pstatus->rx_pwdb_all;
208 if (pstatus->rx_pwdb_all > (u32) undec_sm_pwdb) {
209 undec_sm_pwdb = (((undec_sm_pwdb) *
210 (RX_SMOOTH_FACTOR - 1)) +
211 (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
212 undec_sm_pwdb = undec_sm_pwdb + 1;
214 undec_sm_pwdb = (((undec_sm_pwdb) *
215 (RX_SMOOTH_FACTOR - 1)) +
216 (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
220 drv_priv->rssi_stat.undec_sm_pwdb = undec_sm_pwdb;
222 rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
226 rtl_update_rxsignalstatistics(hw, pstatus);
229 static void rtl_process_ui_link_quality(struct ieee80211_hw *hw,
230 struct rtl_stats *pstatus)
232 struct rtl_priv *rtlpriv = rtl_priv(hw);
233 u32 last_evm, n_stream, tmpval;
235 if (pstatus->signalquality == 0)
238 if (rtlpriv->stats.ui_link_quality.total_num++ >=
239 PHY_LINKQUALITY_SLID_WIN_MAX) {
240 rtlpriv->stats.ui_link_quality.total_num =
241 PHY_LINKQUALITY_SLID_WIN_MAX;
242 last_evm = rtlpriv->stats.ui_link_quality.elements[
243 rtlpriv->stats.ui_link_quality.index];
244 rtlpriv->stats.ui_link_quality.total_val -= last_evm;
246 rtlpriv->stats.ui_link_quality.total_val += pstatus->signalquality;
247 rtlpriv->stats.ui_link_quality.elements[
248 rtlpriv->stats.ui_link_quality.index++] =
249 pstatus->signalquality;
250 if (rtlpriv->stats.ui_link_quality.index >=
251 PHY_LINKQUALITY_SLID_WIN_MAX)
252 rtlpriv->stats.ui_link_quality.index = 0;
253 tmpval = rtlpriv->stats.ui_link_quality.total_val /
254 rtlpriv->stats.ui_link_quality.total_num;
255 rtlpriv->stats.signal_quality = tmpval;
256 rtlpriv->stats.last_sigstrength_inpercent = tmpval;
257 for (n_stream = 0; n_stream < 2; n_stream++) {
258 if (pstatus->rx_mimo_sig_qual[n_stream] != -1) {
259 if (rtlpriv->stats.rx_evm_percentage[n_stream] == 0) {
260 rtlpriv->stats.rx_evm_percentage[n_stream] =
261 pstatus->rx_mimo_sig_qual[n_stream];
263 rtlpriv->stats.rx_evm_percentage[n_stream] =
264 ((rtlpriv->stats.rx_evm_percentage[n_stream]
265 * (RX_SMOOTH_FACTOR - 1)) +
266 (pstatus->rx_mimo_sig_qual[n_stream] * 1)) /
272 void rtl_process_phyinfo(struct ieee80211_hw *hw, u8 *buffer,
273 struct rtl_stats *pstatus)
276 if (!pstatus->packet_matchbssid)
279 rtl_process_ui_rssi(hw, pstatus);
280 rtl_process_pwdb(hw, pstatus);
281 rtl_process_ui_link_quality(hw, pstatus);
283 EXPORT_SYMBOL(rtl_process_phyinfo);