skyfall/rtl8188eu
1
0
Fork 0
mirror of https://github.com/lwfinger/rtl8188eu.git synced 2024-11-23 13:03:39 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions
rtl8188eu/hal/phydm/phydm_pathdiv.c

697 lines
23 KiB
C
Raw Normal View History

rtl8188EUS: Initial addition of files in branch v5.2.2.4 Signed-off-by: Larry Finger <Larry.Finger@lwfinger.net>
2018-10-15 00:07:45 +00:00
/******************************************************************************
*
* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
*
* 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.
*
* You should have received a copy of the GNU General Public License along with
* this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
*
*
******************************************************************************/
/* ************************************************************
* include files
* ************************************************************ */
#include "mp_precomp.h"
#include "phydm_precomp.h"
#if (defined(CONFIG_PATH_DIVERSITY))
#if RTL8814A_SUPPORT
void
phydm_dtp_fix_tx_path(
void *p_dm_void,
u8 path
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div;
u8 i, num_enable_path = 0;
if (path == p_dm_path_div->pre_tx_path)
return;
else
p_dm_path_div->pre_tx_path = path;
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(18) | BIT(19), 3);
for (i = 0; i < 4; i++) {
if (path & BIT(i))
num_enable_path++;
}
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" number of trun-on path : (( %d ))\n", num_enable_path));
if (num_enable_path == 1) {
odm_set_bb_reg(p_dm_odm, 0x93c, 0xf00000, path);
if (path == PHYDM_A) { /* 1-1 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n"));
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
} else if (path == PHYDM_B) { /* 1-2 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n"));
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0);
} else if (path == PHYDM_C) { /* 1-3 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n"));
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 0);
} else if (path == PHYDM_D) { /* 1-4 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n"));
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 0);
}
} else if (num_enable_path == 2) {
odm_set_bb_reg(p_dm_odm, 0x93c, 0xf00000, path);
odm_set_bb_reg(p_dm_odm, 0x940, 0xf0, path);
if (path == PHYDM_AB) { /* 2-1 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1);
} else if (path == PHYDM_AC) { /* 2-2 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1);
} else if (path == PHYDM_AD) { /* 2-3 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1);
} else if (path == PHYDM_BC) { /* 2-4 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1);
} else if (path == PHYDM_BD) { /* 2-5 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1);
} else if (path == PHYDM_CD) { /* 2-6 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1);
}
} else if (num_enable_path == 3) {
odm_set_bb_reg(p_dm_odm, 0x93c, 0xf00000, path);
odm_set_bb_reg(p_dm_odm, 0x940, 0xf0, path);
odm_set_bb_reg(p_dm_odm, 0x940, 0xf0000, path);
if (path == PHYDM_ABC) { /* 3-1 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 2);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 2);
/* set for 3ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 2);
} else if (path == PHYDM_ABD) { /* 3-2 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2);
} else if (path == PHYDM_ACD) { /* 3-3 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2);
} else if (path == PHYDM_BCD) { /* 3-4 */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n"));
/* set for 1ss */
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1);
odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 0);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 1);
odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2);
}
} else if (num_enable_path == 4)
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n"));
}
void
phydm_find_default_path(
void *p_dm_void
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div;
u32 rssi_avg_a = 0, rssi_avg_b = 0, rssi_avg_c = 0, rssi_avg_d = 0, rssi_avg_bcd = 0;
u32 rssi_total_a = 0, rssi_total_b = 0, rssi_total_c = 0, rssi_total_d = 0;
/* 2 Default path Selection By RSSI */
rssi_avg_a = (p_dm_path_div->path_a_cnt_all > 0) ? (p_dm_path_div->path_a_sum_all / p_dm_path_div->path_a_cnt_all) : 0 ;
rssi_avg_b = (p_dm_path_div->path_b_cnt_all > 0) ? (p_dm_path_div->path_b_sum_all / p_dm_path_div->path_b_cnt_all) : 0 ;
rssi_avg_c = (p_dm_path_div->path_c_cnt_all > 0) ? (p_dm_path_div->path_c_sum_all / p_dm_path_div->path_c_cnt_all) : 0 ;
rssi_avg_d = (p_dm_path_div->path_d_cnt_all > 0) ? (p_dm_path_div->path_d_sum_all / p_dm_path_div->path_d_cnt_all) : 0 ;
p_dm_path_div->path_a_sum_all = 0;
p_dm_path_div->path_a_cnt_all = 0;
p_dm_path_div->path_b_sum_all = 0;
p_dm_path_div->path_b_cnt_all = 0;
p_dm_path_div->path_c_sum_all = 0;
p_dm_path_div->path_c_cnt_all = 0;
p_dm_path_div->path_d_sum_all = 0;
p_dm_path_div->path_d_cnt_all = 0;
if (p_dm_path_div->use_path_a_as_default_ant == 1) {
rssi_avg_bcd = (rssi_avg_b + rssi_avg_c + rssi_avg_d) / 3;
if ((rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd) {
p_dm_path_div->is_path_a_exist = true;
p_dm_path_div->default_path = PATH_A;
} else
p_dm_path_div->is_path_a_exist = false;
} else {
if ((rssi_avg_a >= rssi_avg_b) && (rssi_avg_a >= rssi_avg_c) && (rssi_avg_a >= rssi_avg_d))
p_dm_path_div->default_path = PATH_A;
else if ((rssi_avg_b >= rssi_avg_c) && (rssi_avg_b >= rssi_avg_d))
p_dm_path_div->default_path = PATH_B;
else if (rssi_avg_c >= rssi_avg_d)
p_dm_path_div->default_path = PATH_C;
else
p_dm_path_div->default_path = PATH_D;
}
}
void
phydm_candidate_dtp_update(
void *p_dm_void
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div;
p_dm_path_div->num_candidate = 3;
if (p_dm_path_div->use_path_a_as_default_ant == 1) {
if (p_dm_path_div->num_tx_path == 3) {
if (p_dm_path_div->is_path_a_exist) {
p_dm_path_div->ant_candidate_1 = PHYDM_ABC;
p_dm_path_div->ant_candidate_2 = PHYDM_ABD;
p_dm_path_div->ant_candidate_3 = PHYDM_ACD;
} else { /* use path BCD */
p_dm_path_div->num_candidate = 1;
phydm_dtp_fix_tx_path(p_dm_odm, PHYDM_BCD);
return;
}
} else if (p_dm_path_div->num_tx_path == 2) {
if (p_dm_path_div->is_path_a_exist) {
p_dm_path_div->ant_candidate_1 = PHYDM_AB;
p_dm_path_div->ant_candidate_2 = PHYDM_AC;
p_dm_path_div->ant_candidate_3 = PHYDM_AD;
} else {
p_dm_path_div->ant_candidate_1 = PHYDM_BC;
p_dm_path_div->ant_candidate_2 = PHYDM_BD;
p_dm_path_div->ant_candidate_3 = PHYDM_CD;
}
}
} else {
/* 2 3 TX mode */
if (p_dm_path_div->num_tx_path == 3) { /* choose 3 ant form 4 */
if (p_dm_path_div->default_path == PATH_A) { /* choose 2 ant form 3 */
p_dm_path_div->ant_candidate_1 = PHYDM_ABC;
p_dm_path_div->ant_candidate_2 = PHYDM_ABD;
p_dm_path_div->ant_candidate_3 = PHYDM_ACD;
} else if (p_dm_path_div->default_path == PATH_B) {
p_dm_path_div->ant_candidate_1 = PHYDM_ABC;
p_dm_path_div->ant_candidate_2 = PHYDM_ABD;
p_dm_path_div->ant_candidate_3 = PHYDM_BCD;
} else if (p_dm_path_div->default_path == PATH_C) {
p_dm_path_div->ant_candidate_1 = PHYDM_ABC;
p_dm_path_div->ant_candidate_2 = PHYDM_ACD;
p_dm_path_div->ant_candidate_3 = PHYDM_BCD;
} else if (p_dm_path_div->default_path == PATH_D) {
p_dm_path_div->ant_candidate_1 = PHYDM_ABD;
p_dm_path_div->ant_candidate_2 = PHYDM_ACD;
p_dm_path_div->ant_candidate_3 = PHYDM_BCD;
}
}
/* 2 2 TX mode */
else if (p_dm_path_div->num_tx_path == 2) { /* choose 2 ant form 4 */
if (p_dm_path_div->default_path == PATH_A) { /* choose 2 ant form 3 */
p_dm_path_div->ant_candidate_1 = PHYDM_AB;
p_dm_path_div->ant_candidate_2 = PHYDM_AC;
p_dm_path_div->ant_candidate_3 = PHYDM_AD;
} else if (p_dm_path_div->default_path == PATH_B) {
p_dm_path_div->ant_candidate_1 = PHYDM_AB;
p_dm_path_div->ant_candidate_2 = PHYDM_BC;
p_dm_path_div->ant_candidate_3 = PHYDM_BD;
} else if (p_dm_path_div->default_path == PATH_C) {
p_dm_path_div->ant_candidate_1 = PHYDM_AC;
p_dm_path_div->ant_candidate_2 = PHYDM_BC;
p_dm_path_div->ant_candidate_3 = PHYDM_CD;
} else if (p_dm_path_div->default_path == PATH_D) {
p_dm_path_div->ant_candidate_1 = PHYDM_AD;
p_dm_path_div->ant_candidate_2 = PHYDM_BD;
p_dm_path_div->ant_candidate_3 = PHYDM_CD;
}
}
}
}
void
phydm_dynamic_tx_path(
void *p_dm_void
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div;
struct sta_info *p_entry;
u32 i;
u8 num_client = 0;
u8 h2c_parameter[6] = {0};
if (!p_dm_odm->is_linked) { /* is_linked==False */
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n"));
if (p_dm_path_div->is_become_linked == true) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n"));
p_dm_path_div->is_become_linked = p_dm_odm->is_linked;
}
return;
} else {
if (p_dm_path_div->is_become_linked == false) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n"));
p_dm_path_div->is_become_linked = p_dm_odm->is_linked;
}
}
/* 2 [period CTRL] */
if (p_dm_path_div->dtp_period >= 2)
p_dm_path_div->dtp_period = 0;
else {
/* ODM_RT_TRACE(p_dm_odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",p_dm_path_div->dtp_period)); */
p_dm_path_div->dtp_period++;
return;
}
/* 2 [Fix path] */
if (p_dm_odm->path_select != PHYDM_AUTO_PATH)
return;
/* 2 [Check Bfer] */
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
#if (BEAMFORMING_SUPPORT == 1)
{
enum beamforming_cap beamform_cap = (p_dm_odm->beamforming_info.beamform_cap);
if (beamform_cap & BEAMFORMER_CAP) { /* BFmer On && Div On->Div Off */
if (p_dm_path_div->fix_path_bfer == 0) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("[ PathDiv : OFF ] BFmer ==1\n"));
p_dm_path_div->fix_path_bfer = 1 ;
}
return;
} else { /* BFmer Off && Div Off->Div On */
if (p_dm_path_div->fix_path_bfer == 1) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("[ PathDiv : ON ] BFmer ==0\n"));
p_dm_path_div->fix_path_bfer = 0;
}
}
}
#endif
#endif
if (p_dm_path_div->use_path_a_as_default_ant == 1) {
phydm_find_default_path(p_dm_odm);
phydm_candidate_dtp_update(p_dm_odm);
} else {
if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_INIT) {
phydm_find_default_path(p_dm_odm);
phydm_candidate_dtp_update(p_dm_odm);
p_dm_path_div->phydm_dtp_state = PHYDM_DTP_RUNNING_1;
}
else if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_RUNNING_1) {
p_dm_path_div->dtp_check_patha_counter++;
if (p_dm_path_div->dtp_check_patha_counter >= NUM_RESET_DTP_PERIOD) {
p_dm_path_div->dtp_check_patha_counter = 0;
p_dm_path_div->phydm_dtp_state = PHYDM_DTP_INIT;
}
/* 2 Search space update */
else {
/* 1. find the worst candidate */
/* 2. repalce the worst candidate */
}
}
}
/* 2 Dynamic path Selection H2C */
if (p_dm_path_div->num_candidate == 1)
return;
else {
h2c_parameter[0] = p_dm_path_div->num_candidate;
h2c_parameter[1] = p_dm_path_div->num_tx_path;
h2c_parameter[2] = p_dm_path_div->ant_candidate_1;
h2c_parameter[3] = p_dm_path_div->ant_candidate_2;
h2c_parameter[4] = p_dm_path_div->ant_candidate_3;
odm_fill_h2c_cmd(p_dm_odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter);
}
}
void
phydm_dynamic_tx_path_init(
void *p_dm_void
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div);
struct _ADAPTER *p_adapter = p_dm_odm->adapter;
#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT)
USB_MODE_MECH *p_usb_mode_mech = &p_adapter->usb_mode_mechanism;
#endif
u8 search_space_2[NUM_CHOOSE2_FROM4] = {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD };
u8 search_space_3[NUM_CHOOSE3_FROM4] = {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC};
#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT)
p_dm_path_div->is_u3_mode = (p_usb_mode_mech->cur_usb_mode == USB_MODE_U3) ? 1 : 0 ;
#else
p_dm_path_div->is_u3_mode = 1;
#endif
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX path Init 8814\n"));
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", p_dm_path_div->is_u3_mode));
memcpy(&(p_dm_path_div->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4);
memcpy(&(p_dm_path_div->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4);
p_dm_path_div->use_path_a_as_default_ant = 1;
p_dm_path_div->phydm_dtp_state = PHYDM_DTP_INIT;
p_dm_odm->path_select = PHYDM_AUTO_PATH;
p_dm_path_div->phydm_path_div_type = PHYDM_4R_PATH_DIV;
if (p_dm_path_div->is_u3_mode) {
p_dm_path_div->num_tx_path = 3;
phydm_dtp_fix_tx_path(p_dm_odm, PHYDM_BCD);/* 3TX Set Init TX path*/
} else {
p_dm_path_div->num_tx_path = 2;
phydm_dtp_fix_tx_path(p_dm_odm, PHYDM_BC);/* 2TX // Set Init TX path*/
}
}
void
phydm_process_rssi_for_path_div(
void *p_dm_void,
void *p_phy_info_void,
void *p_pkt_info_void
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)p_phy_info_void;
struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pkt_info_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div);
if (p_pktinfo->is_packet_to_self || p_pktinfo->is_packet_match_bssid) {
if (p_pktinfo->data_rate > ODM_RATE11M) {
if (p_dm_path_div->phydm_path_div_type == PHYDM_4R_PATH_DIV) {
#if RTL8814A_SUPPORT
if (p_dm_odm->support_ic_type & ODM_RTL8814A) {
p_dm_path_div->path_a_sum_all += p_phy_info->rx_mimo_signal_strength[0];
p_dm_path_div->path_a_cnt_all++;
p_dm_path_div->path_b_sum_all += p_phy_info->rx_mimo_signal_strength[1];
p_dm_path_div->path_b_cnt_all++;
p_dm_path_div->path_c_sum_all += p_phy_info->rx_mimo_signal_strength[2];
p_dm_path_div->path_c_cnt_all++;
p_dm_path_div->path_d_sum_all += p_phy_info->rx_mimo_signal_strength[3];
p_dm_path_div->path_d_cnt_all++;
}
#endif
} else {
p_dm_path_div->path_a_sum[p_pktinfo->station_id] += p_phy_info->rx_mimo_signal_strength[0];
p_dm_path_div->path_a_cnt[p_pktinfo->station_id]++;
p_dm_path_div->path_b_sum[p_pktinfo->station_id] += p_phy_info->rx_mimo_signal_strength[1];
p_dm_path_div->path_b_cnt[p_pktinfo->station_id]++;
}
}
}
}
#endif /* #if RTL8814A_SUPPORT */
void
odm_pathdiv_debug(
void *p_dm_void,
u32 *const dm_value,
u32 *_used,
char *output,
u32 *_out_len
)
{
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div);
u32 used = *_used;
u32 out_len = *_out_len;
p_dm_odm->path_select = (dm_value[0] & 0xf);
PHYDM_SNPRINTF((output + used, out_len - used, "Path_select = (( 0x%x ))\n", p_dm_odm->path_select));
/* 2 [Fix path] */
if (p_dm_odm->path_select != PHYDM_AUTO_PATH) {
PHYDM_SNPRINTF((output + used, out_len - used, "Trun on path [%s%s%s%s]\n",
((p_dm_odm->path_select) & 0x1) ? "A" : "",
((p_dm_odm->path_select) & 0x2) ? "B" : "",
((p_dm_odm->path_select) & 0x4) ? "C" : "",
((p_dm_odm->path_select) & 0x8) ? "D" : ""));
phydm_dtp_fix_tx_path(p_dm_odm, p_dm_odm->path_select);
} else
PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Auto path"));
}
#endif /* #if(defined(CONFIG_PATH_DIVERSITY)) */
void
phydm_c2h_dtp_handler(
void *p_dm_void,
u8 *cmd_buf,
u8 cmd_len
)
{
#if (defined(CONFIG_PATH_DIVERSITY))
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div);
u8 macid = cmd_buf[0];
u8 target = cmd_buf[1];
u8 nsc_1 = cmd_buf[2];
u8 nsc_2 = cmd_buf[3];
u8 nsc_3 = cmd_buf[4];
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Target_candidate = (( %d ))\n", target));
/*
if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3))
{
phydm_dtp_fix_tx_path(p_dm_odm, p_dm_path_div->ant_candidate_1);
}
else if( nsc_2 >= nsc_3)
{
phydm_dtp_fix_tx_path(p_dm_odm, p_dm_path_div->ant_candidate_2);
}
else
{
phydm_dtp_fix_tx_path(p_dm_odm, p_dm_path_div->ant_candidate_3);
}
*/
#endif
}
void
odm_path_diversity(
void *p_dm_void
)
{
#if (defined(CONFIG_PATH_DIVERSITY))
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
if (!(p_dm_odm->support_ability & ODM_BB_PATH_DIV)) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Return: Not Support PathDiv\n"));
return;
}
#if RTL8812A_SUPPORT
if (p_dm_odm->support_ic_type & ODM_RTL8812)
odm_path_diversity_8812a(p_dm_odm);
else
#endif
#if RTL8814A_SUPPORT
if (p_dm_odm->support_ic_type & ODM_RTL8814A)
phydm_dynamic_tx_path(p_dm_odm);
else
#endif
{}
#endif
}
void
odm_path_diversity_init(
void *p_dm_void
)
{
#if (defined(CONFIG_PATH_DIVERSITY))
struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void;
/*p_dm_odm->support_ability |= ODM_BB_PATH_DIV;*/
if (p_dm_odm->mp_mode == true)
return;
if (!(p_dm_odm->support_ability & ODM_BB_PATH_DIV)) {
ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Return: Not Support PathDiv\n"));
return;
}
#if RTL8812A_SUPPORT
if (p_dm_odm->support_ic_type & ODM_RTL8812)
odm_path_diversity_init_8812a(p_dm_odm);
else
#endif
#if RTL8814A_SUPPORT
if (p_dm_odm->support_ic_type & ODM_RTL8814A)
phydm_dynamic_tx_path_init(p_dm_odm);
else
#endif
{}
#endif
}
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
/*
* 2011/12/02 MH Copy from MP oursrc for temporarily test.
* */
void
odm_path_div_chk_ant_switch_callback(
struct timer_list *p_timer
)
{
}
void
odm_path_div_chk_ant_switch_workitem_callback(
void *p_context
)
{
}
void
odm_cck_tx_path_diversity_callback(
struct timer_list *p_timer
)
{
}
void
odm_cck_tx_path_diversity_work_item_callback(
void *p_context
)
{
}
u8
odm_sw_ant_div_select_scan_chnl(
struct _ADAPTER *adapter
)
{
return 0;
}
void
odm_sw_ant_div_construct_scan_chnl(
struct _ADAPTER *adapter,
u8 scan_chnl
)
{
}
#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) */
Reference in a new issue Copy permalink