[deliverable/linux.git] / drivers / net / wireless / realtek / rtlwifi / stats.c

/******************************************************************************
 *
 * Copyright(c) 2009-2012  Realtek Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 * wlanfae <wlanfae@realtek.com>
 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
 * Hsinchu 300, Taiwan.
 *
 * Larry Finger <Larry.Finger@lwfinger.net>
 *
 *****************************************************************************/
#include "wifi.h"
#include "stats.h"
#include <linux/export.h>

u8 rtl_query_rxpwrpercentage(char antpower)
{
	if ((antpower <= -100) || (antpower >= 20))
		return 0;
	else if (antpower >= 0)
		return 100;
	else
		return 100 + antpower;
}
EXPORT_SYMBOL(rtl_query_rxpwrpercentage);

u8 rtl_evm_db_to_percentage(char value)
{
	char ret_val = clamp(-value, 0, 33) * 3;

	if (ret_val == 99)
		ret_val = 100;

	return ret_val;
}
EXPORT_SYMBOL(rtl_evm_db_to_percentage);

static long rtl_translate_todbm(struct ieee80211_hw *hw,
			 u8 signal_strength_index)
{
	long signal_power;

	signal_power = (long)((signal_strength_index + 1) >> 1);
	signal_power -= 95;
	return signal_power;
}

long rtl_signal_scale_mapping(struct ieee80211_hw *hw, long currsig)
{
	long retsig;

	if (currsig >= 61 && currsig <= 100)
		retsig = 90 + ((currsig - 60) / 4);
	else if (currsig >= 41 && currsig <= 60)
		retsig = 78 + ((currsig - 40) / 2);
	else if (currsig >= 31 && currsig <= 40)
		retsig = 66 + (currsig - 30);
	else if (currsig >= 21 && currsig <= 30)
		retsig = 54 + (currsig - 20);
	else if (currsig >= 5 && currsig <= 20)
		retsig = 42 + (((currsig - 5) * 2) / 3);
	else if (currsig == 4)
		retsig = 36;
	else if (currsig == 3)
		retsig = 27;
	else if (currsig == 2)
		retsig = 18;
	else if (currsig == 1)
		retsig = 9;
	else
		retsig = currsig;

	return retsig;
}
EXPORT_SYMBOL(rtl_signal_scale_mapping);

static void rtl_process_ui_rssi(struct ieee80211_hw *hw,
				struct rtl_stats *pstatus)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_phy *rtlphy = &(rtlpriv->phy);
	u8 rfpath;
	u32 last_rssi, tmpval;

	if (!pstatus->packet_toself && !pstatus->packet_beacon)
		return;

	rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
	rtlpriv->stats.rssi_calculate_cnt++;

	if (rtlpriv->stats.ui_rssi.total_num++ >= PHY_RSSI_SLID_WIN_MAX) {
		rtlpriv->stats.ui_rssi.total_num = PHY_RSSI_SLID_WIN_MAX;
		last_rssi = rtlpriv->stats.ui_rssi.elements[
			rtlpriv->stats.ui_rssi.index];
		rtlpriv->stats.ui_rssi.total_val -= last_rssi;
	}
	rtlpriv->stats.ui_rssi.total_val += pstatus->signalstrength;
	rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++] =
	    pstatus->signalstrength;
	if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
		rtlpriv->stats.ui_rssi.index = 0;
	tmpval = rtlpriv->stats.ui_rssi.total_val /
		rtlpriv->stats.ui_rssi.total_num;
	rtlpriv->stats.signal_strength = rtl_translate_todbm(hw,
		(u8) tmpval);
	pstatus->rssi = rtlpriv->stats.signal_strength;

	if (pstatus->is_cck)
		return;

	for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
	     rfpath++) {
		if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    pstatus->rx_mimo_signalstrength[rfpath];

		}
		if (pstatus->rx_mimo_signalstrength[rfpath] >
		    rtlpriv->stats.rx_rssi_percentage[rfpath]) {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
			      (RX_SMOOTH_FACTOR - 1)) +
			     (pstatus->rx_mimo_signalstrength[rfpath])) /
			    (RX_SMOOTH_FACTOR);
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    rtlpriv->stats.rx_rssi_percentage[rfpath] + 1;
		} else {
			rtlpriv->stats.rx_rssi_percentage[rfpath] =
			    ((rtlpriv->stats.rx_rssi_percentage[rfpath] *
			      (RX_SMOOTH_FACTOR - 1)) +
			     (pstatus->rx_mimo_signalstrength[rfpath])) /
			    (RX_SMOOTH_FACTOR);
		}
		rtlpriv->stats.rx_snr_db[rfpath] = pstatus->rx_snr[rfpath];
		rtlpriv->stats.rx_evm_dbm[rfpath] =
					pstatus->rx_mimo_evm_dbm[rfpath];
		rtlpriv->stats.rx_cfo_short[rfpath] =
					pstatus->cfo_short[rfpath];
		rtlpriv->stats.rx_cfo_tail[rfpath] = pstatus->cfo_tail[rfpath];
	}
}

static void rtl_update_rxsignalstatistics(struct ieee80211_hw *hw,
					  struct rtl_stats *pstatus)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	int weighting = 0;

	if (rtlpriv->stats.recv_signal_power == 0)
		rtlpriv->stats.recv_signal_power = pstatus->recvsignalpower;
	if (pstatus->recvsignalpower > rtlpriv->stats.recv_signal_power)
		weighting = 5;
	else if (pstatus->recvsignalpower < rtlpriv->stats.recv_signal_power)
		weighting = (-5);
	rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power *
		5 + pstatus->recvsignalpower + weighting) / 6;
}

static void rtl_process_pwdb(struct ieee80211_hw *hw, struct rtl_stats *pstatus)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_sta_info *drv_priv = NULL;
	struct ieee80211_sta *sta = NULL;
	long undec_sm_pwdb;

	rcu_read_lock();
	if (rtlpriv->mac80211.opmode != NL80211_IFTYPE_STATION)
		sta = rtl_find_sta(hw, pstatus->psaddr);

	/* adhoc or ap mode */
	if (sta) {
		drv_priv = (struct rtl_sta_info *) sta->drv_priv;
		undec_sm_pwdb = drv_priv->rssi_stat.undec_sm_pwdb;
	} else {
		undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;
	}

	if (undec_sm_pwdb < 0)
		undec_sm_pwdb = pstatus->rx_pwdb_all;
	if (pstatus->rx_pwdb_all > (u32) undec_sm_pwdb) {
		undec_sm_pwdb = (((undec_sm_pwdb) *
		      (RX_SMOOTH_FACTOR - 1)) +
		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
		undec_sm_pwdb = undec_sm_pwdb + 1;
	} else {
		undec_sm_pwdb = (((undec_sm_pwdb) *
		      (RX_SMOOTH_FACTOR - 1)) +
		     (pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
	}

	if (sta) {
		drv_priv->rssi_stat.undec_sm_pwdb = undec_sm_pwdb;
	} else {
		rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
	}
	rcu_read_unlock();

	rtl_update_rxsignalstatistics(hw, pstatus);
}

static void rtl_process_ui_link_quality(struct ieee80211_hw *hw,
					struct rtl_stats *pstatus)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	u32 last_evm, n_stream, tmpval;

	if (pstatus->signalquality == 0)
		return;

	if (rtlpriv->stats.ui_link_quality.total_num++ >=
	    PHY_LINKQUALITY_SLID_WIN_MAX) {
		rtlpriv->stats.ui_link_quality.total_num =
		    PHY_LINKQUALITY_SLID_WIN_MAX;
		last_evm = rtlpriv->stats.ui_link_quality.elements[
			rtlpriv->stats.ui_link_quality.index];
		rtlpriv->stats.ui_link_quality.total_val -= last_evm;
	}
	rtlpriv->stats.ui_link_quality.total_val += pstatus->signalquality;
	rtlpriv->stats.ui_link_quality.elements[
		rtlpriv->stats.ui_link_quality.index++] =
							pstatus->signalquality;
	if (rtlpriv->stats.ui_link_quality.index >=
	    PHY_LINKQUALITY_SLID_WIN_MAX)
		rtlpriv->stats.ui_link_quality.index = 0;
	tmpval = rtlpriv->stats.ui_link_quality.total_val /
	    rtlpriv->stats.ui_link_quality.total_num;
	rtlpriv->stats.signal_quality = tmpval;
	rtlpriv->stats.last_sigstrength_inpercent = tmpval;
	for (n_stream = 0; n_stream < 2; n_stream++) {
		if (pstatus->rx_mimo_sig_qual[n_stream] != -1) {
			if (rtlpriv->stats.rx_evm_percentage[n_stream] == 0) {
				rtlpriv->stats.rx_evm_percentage[n_stream] =
				    pstatus->rx_mimo_sig_qual[n_stream];
			}
			rtlpriv->stats.rx_evm_percentage[n_stream] =
			    ((rtlpriv->stats.rx_evm_percentage[n_stream]
			      * (RX_SMOOTH_FACTOR - 1)) +
			     (pstatus->rx_mimo_sig_qual[n_stream] * 1)) /
			    (RX_SMOOTH_FACTOR);
		}
	}
}

void rtl_process_phyinfo(struct ieee80211_hw *hw, u8 *buffer,
			 struct rtl_stats *pstatus)
{

	if (!pstatus->packet_matchbssid)
		return;

	rtl_process_ui_rssi(hw, pstatus);
	rtl_process_pwdb(hw, pstatus);
	rtl_process_ui_link_quality(hw, pstatus);
}
EXPORT_SYMBOL(rtl_process_phyinfo);
Commit	Line	Data
a2905935 LF	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	*
a2905935 LF	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(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	}
	38	EXPORT_SYMBOL(rtl_query_rxpwrpercentage);
	39
	40	u8 rtl_evm_db_to_percentage(char value)
	41	{
54fb66d6	42	char ret_val = clamp(-value, 0, 33) * 3;
a2905935	43
a2905935 LF	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,
f3a97e93	52	u8 signal_strength_index)
a2905935 LF	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
f3a97e93 LF	98	if (!pstatus->packet_toself && !pstatus->packet_beacon)
	99	return;
	100
	101	rtlpriv->stats.pwdb_all_cnt += pstatus->rx_pwdb_all;
a2905935 LF	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	}
f3a97e93 LF	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];
a2905935 LF	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;
0f015453	177	long undec_sm_pwdb;
a2905935 LF	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;
0f015453	186	undec_sm_pwdb = drv_priv->rssi_stat.undec_sm_pwdb;
a2905935	187	} else {
0f015453	188	undec_sm_pwdb = rtlpriv->dm.undec_sm_pwdb;
a2905935 LF	189	}
a2905935 LF	190
0f015453 LF	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) *
a2905935 LF	195	(RX_SMOOTH_FACTOR - 1)) +
a2905935 LF	196	(pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
0f015453	197	undec_sm_pwdb = undec_sm_pwdb + 1;
a2905935	198	} else {
f3a97e93	199	undec_sm_pwdb = (((undec_sm_pwdb) *
d82403a9 LF	200	(RX_SMOOTH_FACTOR - 1)) +
d82403a9 LF	201	(pstatus->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);
a2905935 LF	202	}
	203
	204	if (sta) {
0f015453	205	drv_priv->rssi_stat.undec_sm_pwdb = undec_sm_pwdb;
a2905935	206	} else {
0f015453	207	rtlpriv->dm.undec_sm_pwdb = undec_sm_pwdb;
a2905935 LF	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++] =
f3a97e93	234	pstatus->signalquality;
a2905935 LF	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,
f3a97e93	258	struct rtl_stats *pstatus)
a2905935 LF	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);