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