229 lines
6.7 KiB
C
229 lines
6.7 KiB
C
|
/******************************************************************************
|
||
|
|
*
|
||
|
|
* Copyright(c) 2007 - 2017 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 files
|
||
|
|
* ************************************************************ */
|
||
|
|
|
||
|
|
#include "mp_precomp.h"
|
||
|
|
#include "phydm_precomp.h"
|
||
|
|
|
||
|
|
#ifdef PHYDM_POWER_TRAINING_SUPPORT
|
||
|
|
void
|
||
|
|
phydm_reset_pt_para(
|
||
|
|
void *dm_void
|
||
|
|
)
|
||
|
|
{
|
||
|
|
struct dm_struct *dm = (struct dm_struct *)dm_void;
|
||
|
|
struct phydm_pow_train_stuc *pow_train_t = &dm->pow_train_table;
|
||
|
|
|
||
|
|
pow_train_t->pow_train_score = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_cck = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void
|
||
|
|
phydm_update_power_training_state(
|
||
|
|
void *dm_void
|
||
|
|
)
|
||
|
|
{
|
||
|
|
struct dm_struct *dm = (struct dm_struct *)dm_void;
|
||
|
|
struct phydm_pow_train_stuc *pow_train_t = &dm->pow_train_table;
|
||
|
|
struct phydm_fa_struct *fa_cnt = &dm->false_alm_cnt;
|
||
|
|
struct phydm_dig_struct *dig_t = &dm->dm_dig_table;
|
||
|
|
u32 pt_score_tmp = 0;
|
||
|
|
u32 crc_ok_cnt;
|
||
|
|
u32 cca_all_cnt;
|
||
|
|
|
||
|
|
|
||
|
|
/*is_disable_power_training is the key to H2C to disable/enable power training*/
|
||
|
|
/*if is_disable_power_training == 1, it will use largest power*/
|
||
|
|
if (!(dm->support_ability & ODM_BB_PWR_TRAIN)) {
|
||
|
|
dm->is_disable_power_training = true;
|
||
|
|
phydm_reset_pt_para(dm);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "%s ======>\n", __FUNCTION__);
|
||
|
|
|
||
|
|
if (pow_train_t->force_power_training_state == DISABLE_POW_TRAIN) {
|
||
|
|
|
||
|
|
dm->is_disable_power_training = true;
|
||
|
|
phydm_reset_pt_para(dm);
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Disable PT\n");
|
||
|
|
return;
|
||
|
|
|
||
|
|
} else if (pow_train_t->force_power_training_state == ENABLE_POW_TRAIN) {
|
||
|
|
|
||
|
|
dm->is_disable_power_training = false;
|
||
|
|
phydm_reset_pt_para(dm);
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Enable PT\n");
|
||
|
|
return;
|
||
|
|
|
||
|
|
} else if (pow_train_t->force_power_training_state == DYNAMIC_POW_TRAIN) {
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Dynamic PT\n");
|
||
|
|
|
||
|
|
if (!dm->is_linked) {
|
||
|
|
dm->is_disable_power_training = true;
|
||
|
|
pow_train_t->pow_train_score = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_cck = 0;
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "PT is disabled due to no link.\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* First connect */
|
||
|
|
if ((dm->is_linked) && (!dig_t->is_media_connect)) {
|
||
|
|
pow_train_t->pow_train_score = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_cck = 0;
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "(PT)First Connect\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Compute score */
|
||
|
|
crc_ok_cnt = dm->phy_dbg_info.num_qry_phy_status_ofdm + dm->phy_dbg_info.num_qry_phy_status_cck;
|
||
|
|
cca_all_cnt = fa_cnt->cnt_cca_all;
|
||
|
|
|
||
|
|
if (crc_ok_cnt < cca_all_cnt) {
|
||
|
|
/* crc_ok <= (2/3)*cca */
|
||
|
|
if ((crc_ok_cnt + (crc_ok_cnt >> 1)) <= cca_all_cnt)
|
||
|
|
pt_score_tmp = DISABLE_PT_SCORE;
|
||
|
|
|
||
|
|
/* crc_ok <= (4/5)*cca */
|
||
|
|
else if ((crc_ok_cnt + (crc_ok_cnt >> 2)) <= cca_all_cnt)
|
||
|
|
pt_score_tmp = KEEP_PRE_PT_SCORE;
|
||
|
|
|
||
|
|
/* crc_ok > (4/5)*cca */
|
||
|
|
else
|
||
|
|
pt_score_tmp = ENABLE_PT_SCORE;
|
||
|
|
} else {
|
||
|
|
pt_score_tmp = ENABLE_PT_SCORE;
|
||
|
|
}
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "crc_ok_cnt = %d, cnt_cca_all = %d\n",
|
||
|
|
crc_ok_cnt, cca_all_cnt);
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "num_qry_phy_status_ofdm = %d, num_qry_phy_status_cck = %d\n",
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_ofdm, dm->phy_dbg_info.num_qry_phy_status_cck);
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "pt_score_tmp = %d\n", pt_score_tmp);
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "pt_score_tmp = 0(DISABLE), 1(KEEP), 2(ENABLE)\n");
|
||
|
|
|
||
|
|
/* smoothing */
|
||
|
|
pow_train_t->pow_train_score = (pt_score_tmp << 4) + (pow_train_t->pow_train_score >> 1) + (pow_train_t->pow_train_score >> 2);
|
||
|
|
pt_score_tmp = (pow_train_t->pow_train_score + 32) >> 6;
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "pow_train_score = %d, score after smoothing = %d\n",
|
||
|
|
pow_train_t->pow_train_score, pt_score_tmp);
|
||
|
|
|
||
|
|
/* mode decision */
|
||
|
|
if (pt_score_tmp == ENABLE_PT_SCORE) {
|
||
|
|
|
||
|
|
dm->is_disable_power_training = false;
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Enable power training under dynamic.\n");
|
||
|
|
|
||
|
|
} else if (pt_score_tmp == DISABLE_PT_SCORE) {
|
||
|
|
|
||
|
|
dm->is_disable_power_training = true;
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Disable PT due to noisy.\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "Final, score = %d, is_disable_power_training = %d\n",
|
||
|
|
pt_score_tmp, dm->is_disable_power_training);
|
||
|
|
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_ofdm = 0;
|
||
|
|
dm->phy_dbg_info.num_qry_phy_status_cck = 0;
|
||
|
|
} else {
|
||
|
|
|
||
|
|
dm->is_disable_power_training = true;
|
||
|
|
phydm_reset_pt_para(dm);
|
||
|
|
|
||
|
|
PHYDM_DBG(dm, DBG_PWR_TRAIN, "PT is disabled due to unknown pt state.\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void
|
||
|
|
phydm_pow_train_debug(
|
||
|
|
void *dm_void,
|
||
|
|
char input[][16],
|
||
|
|
u32 *_used,
|
||
|
|
char *output,
|
||
|
|
u32 *_out_len,
|
||
|
|
u32 input_num
|
||
|
|
)
|
||
|
|
{
|
||
|
|
struct dm_struct *dm = (struct dm_struct *)dm_void;
|
||
|
|
struct phydm_pow_train_stuc *pow_train_t = &dm->pow_train_table;
|
||
|
|
char help[] = "-h";
|
||
|
|
u32 var1[10] = {0};
|
||
|
|
u32 used = *_used;
|
||
|
|
u32 out_len = *_out_len;
|
||
|
|
u32 i;
|
||
|
|
|
||
|
|
if ((strcmp(input[1], help) == 0)) {
|
||
|
|
PDM_SNPF(out_len, used, output + used, out_len - used,
|
||
|
|
"0: Dynamic state\n");
|
||
|
|
PDM_SNPF(out_len, used, output + used, out_len - used,
|
||
|
|
"1: Enable PT\n");
|
||
|
|
PDM_SNPF(out_len, used, output + used, out_len - used,
|
||
|
|
"2: Disable PT\n");
|
||
|
|
|
||
|
|
} else {
|
||
|
|
for (i = 0; i < 10; i++) {
|
||
|
|
if (input[i + 1]) {
|
||
|
|
PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (var1[0] == 0) {
|
||
|
|
pow_train_t->force_power_training_state = DYNAMIC_POW_TRAIN;
|
||
|
|
PDM_SNPF(out_len, used, output + used,
|
||
|
|
out_len - used, "Dynamic state\n");
|
||
|
|
} else if (var1[0] == 1) {
|
||
|
|
pow_train_t->force_power_training_state = ENABLE_POW_TRAIN;
|
||
|
|
PDM_SNPF(out_len, used, output + used,
|
||
|
|
out_len - used, "Enable PT\n");
|
||
|
|
} else if (var1[0] == 2) {
|
||
|
|
pow_train_t->force_power_training_state = DISABLE_POW_TRAIN;
|
||
|
|
PDM_SNPF(out_len, used, output + used,
|
||
|
|
out_len - used, "Disable PT\n");
|
||
|
|
} else {
|
||
|
|
PDM_SNPF(out_len, used, output + used,
|
||
|
|
out_len - used, "Set Error\n");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
*_used = used;
|
||
|
|
*_out_len = out_len;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
|