1
0
mirror of https://github.com/aircrack-ng/rtl8812au.git synced 2024-11-26 23:24:11 +00:00
rtl8812au/hal/phydm/phydm_dynamictxpower.c
2019-05-24 21:43:57 +02:00

518 lines
15 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 CONFIG_DYNAMIC_TX_TWR
#ifdef BB_RAM_SUPPORT
void
phydm_2ndtype_dtp_init(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u8 pwr_offset_minus3, pwr_offset_minus7;
/*@ 2's com, for offset 3dB and 7dB, which 1 step will be 0.25dB*/
pwr_offset_minus3 = BIT(7) | 0x74;
pwr_offset_minus7 = BIT(7) | 0x64;
odm_set_bb_reg(dm, 0x1e70, 0x00ff0000, pwr_offset_minus3);
odm_set_bb_reg(dm, 0x1e70, 0xff000000, pwr_offset_minus7);
};
void
phdm_2ndtype_rd_ram_pwr(void *dm_void, u8 macid)
{
};
void
phdm_2ndtype_wt_ram_pwr(void *dm_void, u8 macid, boolean pwr_offset0_en,
boolean pwr_offset1_en, s8 pwr_offset0, s8 pwr_offset1)
{
u32 reg_io_0x1e84 = 0;
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL;
dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[macid];
dm_ram_per_sta->tx_pwr_offset0_en = pwr_offset0_en;
dm_ram_per_sta->tx_pwr_offset1_en = pwr_offset1_en;
dm_ram_per_sta->tx_pwr_offset0 = pwr_offset0;
dm_ram_per_sta->tx_pwr_offset1 = pwr_offset1;
reg_io_0x1e84 = (dm_ram_per_sta->hw_igi_en<<7) + dm_ram_per_sta->hw_igi;
reg_io_0x1e84 |= (pwr_offset0_en<<15) + ((pwr_offset0&0x7f)<<8);
reg_io_0x1e84 |= (pwr_offset1_en<<23) + ((pwr_offset1&0x7f)<<16);
reg_io_0x1e84 |= (macid&0x3f)<<24;
reg_io_0x1e84 |= BIT(30);
odm_set_bb_reg(dm, 0x1e84, 0xffffffff, reg_io_0x1e84);
};
u8 phydm_pwr_lv_mapping_2ndtype(u8 tx_pwr_lv)
{
if (tx_pwr_lv == tx_high_pwr_level_level3)
/*PHYDM_2ND_OFFSET_MINUS_11DB;*/
return PHYDM_2ND_OFFSET_MINUS_7DB;
else if (tx_pwr_lv == tx_high_pwr_level_level2)
return PHYDM_2ND_OFFSET_MINUS_7DB;
else if (tx_pwr_lv == tx_high_pwr_level_level1)
return PHYDM_2ND_OFFSET_MINUS_3DB;
else
return PHYDM_2ND_OFFSET_ZERO;
}
void phydm_dtp_fill_cmninfo_2ndtype(void *dm_void, u8 macid, u8 dtp_lvl)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct dtp_info *dtp = NULL;
dtp = &dm->phydm_sta_info[macid]->dtp_stat;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
dtp->dyn_tx_power = phydm_pwr_lv_mapping_2ndtype(dtp_lvl);
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"Fill cmninfo TxPwr: macid=(%d), PwrLv (%d)\n", macid,
dtp->dyn_tx_power);
/* dyn_tx_power is 2 bit at 8822C/14B/98F/12F*/
}
#endif
boolean
phydm_check_rates(void *dm_void, u8 rate_idx)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u32 check_rate_bitmap0 = 0x08080808; /* @check CCK11M, OFDM54M, MCS7, MCS15*/
u32 check_rate_bitmap1 = 0x80200808; /* @check MCS23, MCS31, VHT1SS M9, VHT2SS M9*/
u32 check_rate_bitmap2 = 0x00080200; /* @check VHT3SS M9, VHT4SS M9*/
u32 bitmap_result;
#if (RTL8822B_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8822B) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0xfffff000;
check_rate_bitmap0 &= 0x0fffffff;
}
#endif
#if (RTL8197F_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8197F) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0;
check_rate_bitmap0 &= 0x0fffffff;
}
#endif
#if (RTL8192E_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8192E) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0;
check_rate_bitmap0 &= 0x0fffffff;
}
#endif
/*@jj add 20170822*/
#if (RTL8192F_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8192F) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0;
check_rate_bitmap0 &= 0x0fffffff;
}
#endif
#if (RTL8721D_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8721D) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0;
check_rate_bitmap0 &= 0x000fffff;
}
#endif
#if (RTL8821C_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8821C) {
check_rate_bitmap2 &= 0;
check_rate_bitmap1 &= 0x003ff000;
check_rate_bitmap0 &= 0x000fffff;
}
#endif
if (rate_idx >= 64)
bitmap_result = BIT(rate_idx - 64) & check_rate_bitmap2;
else if (rate_idx >= 32)
bitmap_result = BIT(rate_idx - 32) & check_rate_bitmap1;
else if (rate_idx <= 31)
bitmap_result = BIT(rate_idx) & check_rate_bitmap0;
if (bitmap_result != 0)
return true;
else
return false;
}
enum rf_path
phydm_check_paths(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
enum rf_path max_path = RF_PATH_A;
if (dm->num_rf_path == 1)
max_path = RF_PATH_A;
if (dm->num_rf_path == 2)
max_path = RF_PATH_B;
if (dm->num_rf_path == 3)
max_path = RF_PATH_C;
if (dm->num_rf_path == 4)
max_path = RF_PATH_D;
return max_path;
}
#ifndef PHYDM_COMMON_API_SUPPORT
u8 phydm_dtp_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u8 ret = 0xff;
#if (RTL8192E_SUPPORT == 1)
ret = config_phydm_read_txagc_n(dm, path, hw_rate);
#endif
return ret;
}
#endif
u8 phydm_search_min_power_index(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
enum rf_path path;
enum rf_path max_path;
u8 min_gain_index = 0x3f;
u8 gain_index;
u8 rate_idx;
PHYDM_DBG(dm, DBG_DYN_TXPWR, "%s\n", __func__);
max_path = phydm_check_paths(dm);
for (path = 0; path <= max_path; path++)
for (rate_idx = 0; rate_idx < 84; rate_idx++)
if (phydm_check_rates(dm, rate_idx)) {
#ifdef PHYDM_COMMON_API_SUPPORT
/*This is for API support IC : 97F,8822B,92F,8821C*/
gain_index = phydm_api_get_txagc(dm, path, rate_idx);
#else
/*This is for API non-support IC : 92E */
gain_index = phydm_dtp_get_txagc(dm, path, rate_idx);
#endif
if (gain_index == 0xff) {
min_gain_index = 0x20;
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"Error Gain idx!! Rewite to: ((%d))\n", min_gain_index);
break;
}
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"Support Rate: ((%d)) -> Gain idx: ((%d))\n",
rate_idx, gain_index);
if (gain_index < min_gain_index)
min_gain_index = gain_index;
}
return min_gain_index;
}
void phydm_dynamic_tx_power_init(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u8 i;
dm->last_dtp_lvl = tx_high_pwr_level_normal;
dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal;
for (i = 0; i < 3; i++) {
dm->enhance_pwr_th[i] = 0xff;
}
dm->set_pwr_th[0] = TX_POWER_NEAR_FIELD_THRESH_LVL1;
dm->set_pwr_th[1] = TX_POWER_NEAR_FIELD_THRESH_LVL2;
dm->set_pwr_th[2] = 0xff;
dm->min_power_index = phydm_search_min_power_index(dm);
PHYDM_DBG(dm, DBG_DYN_TXPWR, "DTP init: Min Gain idx: ((%d))\n",
dm->min_power_index);
}
void phydm_noisy_enhance_hp_th(void *dm_void, u8 noisy_state)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
if (noisy_state == 0) {
dm->enhance_pwr_th[0] = dm->set_pwr_th[0];
dm->enhance_pwr_th[1] = dm->set_pwr_th[1];
dm->enhance_pwr_th[2] = dm->set_pwr_th[2];
} else {
dm->enhance_pwr_th[0] = dm->set_pwr_th[0] + 8;
dm->enhance_pwr_th[1] = dm->set_pwr_th[1] + 5;
dm->enhance_pwr_th[2] = dm->set_pwr_th[2];
}
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"DTP hp_th: Lv1_th =%d ,Lv2_th = %d ,Lv3_th = %d\n",
dm->enhance_pwr_th[0], dm->enhance_pwr_th[1],
dm->enhance_pwr_th[2]);
}
u8 phydm_pwr_lvl_check(void *dm_void, u8 input_rssi)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u8 th0,th1,th2;
th2 = dm->enhance_pwr_th[2];
th1 = dm->enhance_pwr_th[1];
th0 = dm->enhance_pwr_th[0];
if (input_rssi >= th2)
return tx_high_pwr_level_level3;
else if (input_rssi < (th2 - 3) && input_rssi >= th1)
return tx_high_pwr_level_level2;
else if (input_rssi < (th1 - 3) && input_rssi >= th0)
return tx_high_pwr_level_level1;
else if (input_rssi < (th0 - 3))
return tx_high_pwr_level_normal;
else
return tx_high_pwr_level_unchange;
}
u8 phydm_pwr_lv_mapping(u8 tx_pwr_lv)
{
if (tx_pwr_lv == tx_high_pwr_level_level3)
return PHYDM_OFFSET_MINUS_11DB;
else if (tx_pwr_lv == tx_high_pwr_level_level2)
return PHYDM_OFFSET_MINUS_7DB;
else if (tx_pwr_lv == tx_high_pwr_level_level1)
return PHYDM_OFFSET_MINUS_3DB;
else
return PHYDM_OFFSET_ZERO;
}
void phydm_dynamic_response_power(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
u8 rpwr;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
if (dm->dynamic_tx_high_power_lvl == tx_high_pwr_level_unchange) {
dm->dynamic_tx_high_power_lvl = dm->last_dtp_lvl;
PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr not change\n");
return;
}
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"RespPwr update_DTP_lv: ((%d)) -> ((%d))\n", dm->last_dtp_lvl,
dm->dynamic_tx_high_power_lvl);
dm->last_dtp_lvl = dm->dynamic_tx_high_power_lvl;
rpwr = phydm_pwr_lv_mapping(dm->dynamic_tx_high_power_lvl);
odm_set_mac_reg(dm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT(19) | BIT(18), rpwr);
PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr Set TxPwr: Lv (%d)\n",
dm->dynamic_tx_high_power_lvl);
}
void phydm_dtp_fill_cmninfo(void *dm_void, u8 macid, u8 dtp_lvl)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct dtp_info *dtp = NULL;
dtp = &dm->phydm_sta_info[macid]->dtp_stat;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
dtp->dyn_tx_power = phydm_pwr_lv_mapping(dtp_lvl);
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"Fill cmninfo TxPwr: macid=(%d), PwrLv (%d)\n", macid,
dtp->dyn_tx_power);
}
void phydm_dtp_per_sta(void *dm_void, u8 macid)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct cmn_sta_info *sta = dm->phydm_sta_info[macid];
struct dtp_info *dtp = NULL;
struct rssi_info *rssi = NULL;
if (is_sta_active(sta)) {
dtp = &sta->dtp_stat;
rssi = &sta->rssi_stat;
dtp->sta_tx_high_power_lvl = phydm_pwr_lvl_check(dm, rssi->rssi);
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"STA=%d , RSSI: %d , GetPwrLv: %d\n", macid,
rssi->rssi, dtp->sta_tx_high_power_lvl);
if (dtp->sta_tx_high_power_lvl == tx_high_pwr_level_unchange
|| dtp->sta_tx_high_power_lvl == dtp->sta_last_dtp_lvl) {
dtp->sta_tx_high_power_lvl = dtp->sta_last_dtp_lvl;
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"DTP_lv not change: ((%d))\n",
dtp->sta_tx_high_power_lvl);
return;
}
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"DTP_lv update: ((%d)) -> ((%d))\n", dm->last_dtp_lvl,
dm->dynamic_tx_high_power_lvl);
dtp->sta_last_dtp_lvl = dtp->sta_tx_high_power_lvl;
#ifdef BB_RAM_SUPPORT
phydm_dtp_fill_cmninfo_2ndtype(dm, macid, dtp->sta_tx_high_power_lvl);
#else
phydm_dtp_fill_cmninfo(dm, macid, dtp->sta_tx_high_power_lvl);
#endif
}
}
void odm_set_dyntxpwr(void *dm_void, u8 *desc, u8 macid)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct dtp_info *dtp = NULL;
dtp = &dm->phydm_sta_info[macid]->dtp_stat;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
if (dm->fill_desc_dyntxpwr)
dm->fill_desc_dyntxpwr(dm, desc, dtp->dyn_tx_power);
else
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"%s: fill_desc_dyntxpwr is null!\n", __func__);
if (dtp->last_tx_power != dtp->dyn_tx_power) {
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"%s: last_offset=%d, txpwr_offset=%d\n", __func__,
dtp->last_tx_power, dtp->dyn_tx_power);
dtp->last_tx_power = dtp->dyn_tx_power;
}
}
void phydm_dtp_debug(void *dm_void, char input[][16], u32 *_used, char *output,
u32 *_out_len)
{
u32 used = *_used;
u32 out_len = *_out_len;
struct dm_struct *dm = (struct dm_struct *)dm_void;
char help[] = "-h";
u32 var1[3] = {0};
u8 set_pwr_th1, set_pwr_th2, set_pwr_th3;
u8 i;
if ((strcmp(input[1], help) == 0)) {
PDM_SNPF(out_len, used, output + used, out_len - used,
"Set DTP threhosld: {1} {TH[0]} {TH[1]} {TH[2]}\n");
} else {
for (i = 0; i < 3; i++) {
if (input[i + 1])
PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]);
}
if (var1[0] == 1) {
for (i = 0; i < 3; i++)
if (var1[i] == 0 || var1[i] > 100)
dm->set_pwr_th[i] = 0xff;
else
dm->set_pwr_th[i] = (u8)var1[1 + i];
PDM_SNPF(out_len, used, output + used, out_len - used,
"DTP_TH[0:2] = {%d, %d, %d}\n",
dm->set_pwr_th[0], dm->set_pwr_th[1],
dm->set_pwr_th[2]);
}
}
*_used = used;
*_out_len = out_len;
}
void phydm_dynamic_tx_power(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct cmn_sta_info *sta = NULL;
u8 i;
u8 cnt = 0;
u8 rssi_min = dm->rssi_min;
u8 rssi_tmp = 0;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
PHYDM_DBG(dm, DBG_DYN_TXPWR,
"[%s] RSSI_min = %d, Noisy_dec = %d\n", __func__, rssi_min,
dm->noisy_decision);
phydm_noisy_enhance_hp_th(dm, dm->noisy_decision);
#ifndef BB_RAM_SUPPORT
/* Response Power */
dm->dynamic_tx_high_power_lvl = phydm_pwr_lvl_check(dm, rssi_min);
phydm_dynamic_response_power(dm);
#endif /* #ifndef BB_RAM_SUPPORT */
/* Per STA Tx power */
for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
phydm_dtp_per_sta(dm, i);
cnt++;
if (cnt >= dm->number_linked_client)
break;
}
}
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
void phydm_dynamic_tx_power_init_win(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
void *adapter = dm->adapter;
PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo;
HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter);
mgnt_info->bDynamicTxPowerEnable = false;
#if DEV_BUS_TYPE == RT_USB_INTERFACE
if (RT_GetInterfaceSelection((PADAPTER)adapter) ==
INTF_SEL1_USB_High_Power) {
mgnt_info->bDynamicTxPowerEnable = true;
}
#endif
hal_data->LastDTPLvl = tx_high_pwr_level_normal;
hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal;
PHYDM_DBG(dm, DBG_DYN_TXPWR, "[%s] DTP=%d\n", __func__,
mgnt_info->bDynamicTxPowerEnable);
}
void phydm_dynamic_tx_power_win(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR))
return;
#if (RTL8814A_SUPPORT == 1)
if (dm->support_ic_type == ODM_RTL8814A)
odm_dynamic_tx_power_8814a(dm);
#endif
#if (RTL8821A_SUPPORT == 1)
if (dm->support_ic_type & ODM_RTL8821) {
void *adapter = dm->adapter;
PMGNT_INFO mgnt_info = GetDefaultMgntInfo((PADAPTER)adapter);
if (mgnt_info->RegRspPwr == 1) {
if (dm->rssi_min > 60) {
/*Resp TXAGC offset = -3dB*/
odm_set_mac_reg(dm, 0x6d8, 0x1C0000, 1);
} else if (dm->rssi_min < 55) {
/*Resp TXAGC offset = 0dB*/
odm_set_mac_reg(dm, 0x6d8, 0x1C0000, 0);
}
}
}
#endif
}
#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/
#endif /* @#ifdef CONFIG_DYNAMIC_TX_TWR */