rtl8812au-chinawrj/hal/phydm/phydm_rssi_monitor.c

171 lines
4.4 KiB
C
Raw Normal View History

2018-06-22 16:48:32 +00:00
/******************************************************************************
*
2018-08-24 20:52:34 +00:00
* Copyright(c) 2007 - 2017 Realtek Corporation.
2018-06-22 16:48:32 +00:00
*
* 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
2018-08-24 20:52:34 +00:00
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
2018-06-22 16:48:32 +00:00
* more details.
*
2018-08-24 20:52:34 +00:00
* 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>
*
2018-06-22 16:48:32 +00:00
*****************************************************************************/
2019-05-24 19:43:57 +00:00
/*@************************************************************
2018-06-22 16:48:32 +00:00
* include files
2019-05-24 19:43:57 +00:00
************************************************************/
2018-06-22 16:48:32 +00:00
#include "mp_precomp.h"
#include "phydm_precomp.h"
2019-05-24 19:43:57 +00:00
2018-06-22 16:48:32 +00:00
#ifdef PHYDM_SUPPORT_RSSI_MONITOR
2019-05-24 19:43:57 +00:00
void phydm_rssi_monitor_h2c(void *dm_void, u8 macid)
2018-06-22 16:48:32 +00:00
{
2019-05-24 19:43:57 +00:00
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct ra_table *ra_t = &dm->dm_ra_table;
struct cmn_sta_info *sta = dm->phydm_sta_info[macid];
struct ra_sta_info *ra = NULL;
#ifdef CONFIG_BEAMFORMING
struct bf_cmn_info *bf = NULL;
#endif
u8 h2c[H2C_MAX_LENGTH] = {0};
u8 stbc_en, ldpc_en;
u8 bf_en = 0;
u8 is_rx, is_tx;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
if (is_sta_active(sta)) {
ra = &sta->ra_info;
2018-06-22 16:48:32 +00:00
} else {
2019-05-24 19:43:57 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "[Warning] %s\n", __func__);
2018-06-22 16:48:32 +00:00
return;
}
2019-05-24 19:43:57 +00:00
2018-08-24 20:52:34 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__);
PHYDM_DBG(dm, DBG_RSSI_MNTR, "MACID=%d\n", sta->mac_id);
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
is_rx = (ra->txrx_state == RX_STATE) ? 1 : 0;
is_tx = (ra->txrx_state == TX_STATE) ? 1 : 0;
stbc_en = (sta->stbc_en) ? 1 : 0;
ldpc_en = (sta->ldpc_en) ? 1 : 0;
2018-06-22 16:48:32 +00:00
#ifdef CONFIG_BEAMFORMING
2019-05-24 19:43:57 +00:00
bf = &sta->bf_info;
if ((bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) ||
(bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE))
2018-06-22 16:48:32 +00:00
bf_en = 1;
#endif
2019-05-24 19:43:57 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "RA_th_ofst=(( %s%d ))\n",
((ra_t->ra_ofst_direc) ? "+" : "-"), ra_t->ra_th_ofst);
2018-06-22 16:48:32 +00:00
2019-05-24 19:43:57 +00:00
h2c[0] = sta->mac_id;
h2c[1] = 0;
h2c[2] = sta->rssi_stat.rssi;
h2c[3] = is_rx | (stbc_en << 1) |
((dm->noisy_decision & 0x1) << 2) | (bf_en << 6);
h2c[4] = (ra_t->ra_th_ofst & 0x7f) |
((ra_t->ra_ofst_direc & 0x1) << 7);
h2c[5] = 0;
h2c[6] = 0;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "PHYDM h2c[0x42]=0x%x %x %x %x %x %x %x\n",
2019-05-24 19:43:57 +00:00
h2c[6], h2c[5], h2c[4], h2c[3], h2c[2], h2c[1], h2c[0]);
2018-06-22 16:48:32 +00:00
2019-05-24 19:43:57 +00:00
#if (RTL8188E_SUPPORT)
2018-08-24 20:52:34 +00:00
if (dm->support_ic_type == ODM_RTL8188E)
2019-05-24 19:43:57 +00:00
odm_ra_set_rssi_8188e(dm, sta->mac_id, sta->rssi_stat.rssi);
2018-06-22 16:48:32 +00:00
else
2019-05-24 19:43:57 +00:00
#endif
2018-06-22 16:48:32 +00:00
{
2019-05-24 19:43:57 +00:00
odm_fill_h2c_cmd(dm, ODM_H2C_RSSI_REPORT, H2C_MAX_LENGTH, h2c);
2018-06-22 16:48:32 +00:00
}
}
2019-05-24 19:43:57 +00:00
void phydm_calculate_rssi_min_max(void *dm_void)
2018-06-22 16:48:32 +00:00
{
2019-05-24 19:43:57 +00:00
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct cmn_sta_info *sta;
s8 rssi_max_tmp = 0, rssi_min_tmp = 100;
u8 i;
u8 sta_cnt = 0;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
if (!dm->is_linked)
2018-06-22 16:48:32 +00:00
return;
2018-08-24 20:52:34 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__);
2018-06-22 16:48:32 +00:00
for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
2018-08-24 20:52:34 +00:00
sta = dm->phydm_sta_info[i];
if (is_sta_active(sta)) {
2018-06-22 16:48:32 +00:00
sta_cnt++;
2019-05-24 19:43:57 +00:00
if (sta->rssi_stat.rssi < rssi_min_tmp) {
2018-08-24 20:52:34 +00:00
rssi_min_tmp = sta->rssi_stat.rssi;
2019-05-24 19:43:57 +00:00
dm->rssi_min_macid = i;
}
2018-06-22 16:48:32 +00:00
2019-05-24 19:43:57 +00:00
if (sta->rssi_stat.rssi > rssi_max_tmp) {
2018-08-24 20:52:34 +00:00
rssi_max_tmp = sta->rssi_stat.rssi;
2019-05-24 19:43:57 +00:00
dm->rssi_max_macid = i;
}
2018-06-22 16:48:32 +00:00
2019-05-24 19:43:57 +00:00
/*@[Send RSSI to FW]*/
if (!sta->ra_info.disable_ra)
2018-08-24 20:52:34 +00:00
phydm_rssi_monitor_h2c(dm, i);
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
if (sta_cnt == dm->number_linked_client)
2018-06-22 16:48:32 +00:00
break;
}
}
2019-05-24 19:43:57 +00:00
dm->pre_rssi_min = dm->rssi_min;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
dm->rssi_max = (u8)rssi_max_tmp;
dm->rssi_min = (u8)rssi_min_tmp;
2018-06-22 16:48:32 +00:00
}
2019-05-24 19:43:57 +00:00
void phydm_rssi_monitor_check(void *dm_void)
2018-06-22 16:48:32 +00:00
{
2019-05-24 19:43:57 +00:00
struct dm_struct *dm = (struct dm_struct *)dm_void;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
if (!(dm->support_ability & ODM_BB_RSSI_MONITOR))
2018-06-22 16:48:32 +00:00
return;
2019-05-24 19:43:57 +00:00
/*@for AP watchdog period = 1 sec*/
if ((dm->phydm_sys_up_time % 2) == 1)
2018-06-22 16:48:32 +00:00
return;
2018-08-24 20:52:34 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__);
phydm_calculate_rssi_min_max(dm);
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
PHYDM_DBG(dm, DBG_RSSI_MNTR, "RSSI {max, min} = {%d, %d}\n",
2019-05-24 19:43:57 +00:00
dm->rssi_max, dm->rssi_min);
2018-06-22 16:48:32 +00:00
}
2019-05-24 19:43:57 +00:00
void phydm_rssi_monitor_init(void *dm_void)
2018-06-22 16:48:32 +00:00
{
2019-05-24 19:43:57 +00:00
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct ra_table *ra_tab = &dm->dm_ra_table;
2018-06-22 16:48:32 +00:00
2018-08-24 20:52:34 +00:00
ra_tab->firstconnect = false;
2019-05-24 19:43:57 +00:00
dm->pre_rssi_min = 0;
2018-08-24 20:52:34 +00:00
dm->rssi_max = 0;
dm->rssi_min = 0;
2018-06-22 16:48:32 +00:00
}
#endif