tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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 * 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
28u8 stg_rtl_query_rxpwrpercentage(char antpower)
29{
30 if ((antpower <= -100) || (antpower >= 20))
31 return 0;
32 else if (antpower >= 0)
33 return 100;
34 else
35 return 100 + antpower;
36}
37EXPORT_SYMBOL(stg_rtl_query_rxpwrpercentage);
38
39u8 stg_rtl_evm_db_to_percentage(char value)
40{
41 char ret_val;
42 ret_val = value;
43
44 if (ret_val >= 0)
45 ret_val = 0;
46 if (ret_val <= -33)
47 ret_val = -33;
48 ret_val = 0 - ret_val;
49 ret_val *= 3;
50 if (ret_val == 99)
51 ret_val = 100;
52
53 return ret_val;
54}
55EXPORT_SYMBOL(stg_rtl_evm_db_to_percentage);
56
57u8 rtl_evm_dbm_jaguar(char value)
58{
59 char ret_val;
60 ret_val = value;
61
62 /* -33dB~0dB to 33dB ~ 0dB*/
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 stg_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(stg_rtl_signal_scale_mapping);
111
112static void rtl_process_ui_rssi(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
113{
114 struct rtl_priv *rtlpriv = rtl_priv(hw);
115 struct rtl_phy *rtlphy = &(rtlpriv->phy);
116 u8 rfpath;
117 u32 last_rssi, tmpval;
118
119 if (!pstatus->b_packet_toself && !pstatus->b_packet_beacon)
120 return;
121
122 rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
123 rtlpriv->stats.rssi_calculate_cnt++;
124
125 if (rtlpriv->stats.ui_rssi.total_num++ >= PHY_RSSI_SLID_WIN_MAX) {
126 rtlpriv->stats.ui_rssi.total_num = PHY_RSSI_SLID_WIN_MAX;
127 last_rssi = rtlpriv->stats.ui_rssi.elements[
128 rtlpriv->stats.ui_rssi.index];
129 rtlpriv->stats.ui_rssi.total_val -= last_rssi;
130 }
131 rtlpriv->stats.ui_rssi.total_val += pstatus->signalstrength;
132 rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++] =
133 pstatus->signalstrength;
134 if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
135 rtlpriv->stats.ui_rssi.index = 0;
136 tmpval = rtlpriv->stats.ui_rssi.total_val /
137 rtlpriv->stats.ui_rssi.total_num;
138 rtlpriv->stats.signal_strength = rtl_translate_todbm(hw,
139 (u8) tmpval);
140 pstatus->rssi = rtlpriv->stats.signal_strength;
141
142 if (pstatus->b_is_cck)
143 return;
144
145 for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
146 rfpath++) {
147 if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
148 rtlpriv->stats.rx_rssi_percentage[rfpath] =
149 pstatus->rx_mimo_signalstrength[rfpath];
150 }
151 if (pstatus->rx_mimo_signalstrength[rfpath] >
152 rtlpriv->stats.rx_rssi_percentage[rfpath]) {
153 rtlpriv->stats.rx_rssi_percentage[rfpath] =
154 ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
155 (RX_SMOOTH_FACTOR - 1)) +
156 (pstatus->rx_mimo_signalstrength[rfpath])) /
157 (RX_SMOOTH_FACTOR);
158 rtlpriv->stats.rx_rssi_percentage[rfpath] =
159 rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
160 } else {
161 rtlpriv->stats.rx_rssi_percentage[rfpath] =
162 ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
163 (RX_SMOOTH_FACTOR - 1)) +
164 (pstatus->rx_mimo_signalstrength[rfpath])) /
165 (RX_SMOOTH_FACTOR);
166 }
167 rtlpriv->stats.rx_snr_db[rfpath] = pstatus->rx_snr[rfpath];
168 rtlpriv->stats.rx_evm_dbm[rfpath] =
169 pstatus->rx_mimo_evm_dbm[rfpath];
170 rtlpriv->stats.rx_cfo_short[rfpath] =
171 pstatus->cfo_short[rfpath];
172 rtlpriv->stats.rx_cfo_tail[rfpath] = pstatus->cfo_tail[rfpath];
173 }
174}
175
176static void rtl_update_rxsignalstatistics(struct ieee80211_hw *hw,
177 struct rtl_stats *pstatus)
178{
179 struct rtl_priv *rtlpriv = rtl_priv(hw);
180 int weighting = 0;
181
182 if (rtlpriv->stats.recv_signal_power == 0)
183 rtlpriv->stats.recv_signal_power = pstatus->recvsignalpower;
184 if (pstatus->recvsignalpower > rtlpriv->stats.recv_signal_power)
185 weighting = 5;
186 else if (pstatus->recvsignalpower < rtlpriv->stats.recv_signal_power)
187 weighting = (-5);
188 rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power *
189 5 + pstatus->recvsignalpower + weighting) / 6;
190}
191
192static void rtl_process_pwdb(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
193{
194 struct rtl_priv *rtlpriv = rtl_priv(hw);
195 struct rtl_sta_info *drv_priv = NULL;
196 struct ieee80211_sta *sta = NULL;
197 long undecorated_smoothed_pwdb;
198
199 rcu_read_lock();
200 if (rtlpriv->mac80211.opmode != NL80211_IFTYPE_STATION)
201 sta = rtl_find_sta(hw, pstatus->psaddr);
202
203 /* adhoc or ap mode */
204 if (sta) {
205 drv_priv = (struct rtl_sta_info *)sta->drv_priv;
206 undecorated_smoothed_pwdb =
207 drv_priv->rssi_stat.undecorated_smoothed_pwdb;
208 } else {
209 undecorated_smoothed_pwdb =
210 rtlpriv->dm.undecorated_smoothed_pwdb;
211 }
212
213 if (undecorated_smoothed_pwdb < 0)
214 undecorated_smoothed_pwdb = pstatus->rx_pwdb_all;
215 if (pstatus->rx_pwdb_all > (u32) undecorated_smoothed_pwdb) {
216 undecorated_smoothed_pwdb = (((undecorated_smoothed_pwdb) *
217 (RX_SMOOTH_FACTOR - 1)) +
218 (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
219 undecorated_smoothed_pwdb = undecorated_smoothed_pwdb + 1;
220 } else {
221 undecorated_smoothed_pwdb = (((undecorated_smoothed_pwdb) *
222 (RX_SMOOTH_FACTOR - 1)) +
223 (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
224 }
225
226 if (sta) {
227 drv_priv->rssi_stat.undecorated_smoothed_pwdb =
228 undecorated_smoothed_pwdb;
229 } else {
230 rtlpriv->dm.undecorated_smoothed_pwdb = undecorated_smoothed_pwdb;
231 }
232 rcu_read_unlock();
233
234 rtl_update_rxsignalstatistics(hw, pstatus);
235}
236
237static void rtl_process_ui_link_quality(struct ieee80211_hw *hw,
238 struct rtl_stats *pstatus)
239{
240 struct rtl_priv *rtlpriv = rtl_priv(hw);
241 u32 last_evm, n_stream, tmpval;
242
243 if (pstatus->signalquality == 0)
244 return;
245
246 if (rtlpriv->stats.ui_link_quality.total_num++ >=
247 PHY_LINKQUALITY_SLID_WIN_MAX) {
248 rtlpriv->stats.ui_link_quality.total_num =
249 PHY_LINKQUALITY_SLID_WIN_MAX;
250 last_evm = rtlpriv->stats.ui_link_quality.elements[
251 rtlpriv->stats.ui_link_quality.index];
252 rtlpriv->stats.ui_link_quality.total_val -= last_evm;
253 }
254 rtlpriv->stats.ui_link_quality.total_val += pstatus->signalquality;
255 rtlpriv->stats.ui_link_quality.elements[
256 rtlpriv->stats.ui_link_quality.index++] =
257 pstatus->signalquality;
258 if (rtlpriv->stats.ui_link_quality.index >=
259 PHY_LINKQUALITY_SLID_WIN_MAX)
260 rtlpriv->stats.ui_link_quality.index = 0;
261 tmpval = rtlpriv->stats.ui_link_quality.total_val /
262 rtlpriv->stats.ui_link_quality.total_num;
263 rtlpriv->stats.signal_quality = tmpval;
264 rtlpriv->stats.last_sigstrength_inpercent = tmpval;
265 for (n_stream = 0; n_stream < 2; n_stream++) {
266 if (pstatus->rx_mimo_signalquality[n_stream] != -1) {
267 if (rtlpriv->stats.rx_evm_percentage[n_stream] == 0) {
268 rtlpriv->stats.rx_evm_percentage[n_stream] =
269 pstatus->rx_mimo_signalquality[n_stream];
270 }
271 rtlpriv->stats.rx_evm_percentage[n_stream] =
272 ((rtlpriv->stats.rx_evm_percentage[n_stream]
273 * (RX_SMOOTH_FACTOR - 1)) +
274 (pstatus->rx_mimo_signalquality[n_stream] * 1)) /
275 (RX_SMOOTH_FACTOR);
276 }
277 }
278}
279
280void stg_rtl_process_phyinfo(struct ieee80211_hw *hw, u8 *buffer,
281 struct rtl_stats *pstatus)
282{
283 if (!pstatus->b_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(stg_rtl_process_phyinfo);