milan/realtek-RTL8812AU
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity
realtek-RTL8812AU/hal/phydm/phydm_pathdiv.c

929 lines
27 KiB
C
Raw Normal View History

initial
2019-11-08 18:09:53 +01:00
/******************************************************************************
*
* 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_PATH_DIVERSITY
#if RTL8814A_SUPPORT
void phydm_dtp_fix_tx_path(
void *dm_void,
u8 path)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u8 i, num_enable_path = 0;
if (path == p_div->pre_tx_path)
return;
else
p_div->pre_tx_path = path;
odm_set_bb_reg(dm, R_0x93c, BIT(18) | BIT(19), 3);
for (i = 0; i < 4; i++) {
if (path & BIT(i))
num_enable_path++;
}
PHYDM_DBG(dm, DBG_PATH_DIV, " number of turn-on path : (( %d ))\n",
num_enable_path);
if (num_enable_path == 1) {
odm_set_bb_reg(dm, R_0x93c, 0xf00000, path);
if (path == BB_PATH_A) { /* @1-1 */
PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( A ))\n");
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
} else if (path == BB_PATH_B) { /* @1-2 */
PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( B ))\n");
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0);
} else if (path == BB_PATH_C) { /* @1-3 */
PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( C ))\n");
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0);
} else if (path == BB_PATH_D) { /* @1-4 */
PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( D ))\n");
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 0);
}
} else if (num_enable_path == 2) {
odm_set_bb_reg(dm, R_0x93c, 0xf00000, path);
odm_set_bb_reg(dm, R_0x940, 0xf0, path);
if (path == (BB_PATH_AB)) { /* @2-1 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A B ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1);
} else if (path == BB_PATH_AC) { /* @2-2 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A C ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1);
} else if (path == BB_PATH_AD) { /* @2-3 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A D ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1);
} else if (path == BB_PATH_BC) { /* @2-4 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( B C ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1);
} else if (path == BB_PATH_BD) { /* @2-5 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( B D ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1);
} else if (path == BB_PATH_CD) { /* @2-6 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( C D ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 0);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1);
}
} else if (num_enable_path == 3) {
odm_set_bb_reg(dm, R_0x93c, 0xf00000, path);
odm_set_bb_reg(dm, R_0x940, 0xf0, path);
odm_set_bb_reg(dm, R_0x940, 0xf0000, path);
if (path == BB_PATH_ABC) { /* @3-1 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A B C))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1);
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 2);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1);
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 2);
/* set for 3ss */
odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1);
odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 2);
} else if (path == BB_PATH_ABD) { /* @3-2 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A B D ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1);
odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2);
} else if (path == BB_PATH_ACD) { /* @3-3 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( A C D ))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0);
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0);
odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1);
odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2);
} else if (path == BB_PATH_BCD) { /* @3-4 */
PHYDM_DBG(dm, DBG_PATH_DIV,
" Turn on path (( B C D))\n");
/* set for 1ss */
odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0);
odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1);
odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2);
/* set for 2ss */
odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0);
odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1);
odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2);
/* set for 3ss */
odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 0);
odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1);
odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2);
}
} else if (num_enable_path == 4)
PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path ((A B C D))\n");
}
void phydm_find_default_path(
void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u32 rssi_a = 0, rssi_b = 0, rssi_c = 0, rssi_d = 0, rssi_bcd = 0;
u32 rssi_total_a = 0, rssi_total_b = 0;
u32 rssi_total_c = 0, rssi_total_d = 0;
/* @2 Default path Selection By RSSI */
rssi_a = (p_div->path_a_cnt_all > 0) ?
(p_div->path_a_sum_all / p_div->path_a_cnt_all) : 0;
rssi_b = (p_div->path_b_cnt_all > 0) ?
(p_div->path_b_sum_all / p_div->path_b_cnt_all) : 0;
rssi_c = (p_div->path_c_cnt_all > 0) ?
(p_div->path_c_sum_all / p_div->path_c_cnt_all) : 0;
rssi_d = (p_div->path_d_cnt_all > 0) ?
(p_div->path_d_sum_all / p_div->path_d_cnt_all) : 0;
p_div->path_a_sum_all = 0;
p_div->path_a_cnt_all = 0;
p_div->path_b_sum_all = 0;
p_div->path_b_cnt_all = 0;
p_div->path_c_sum_all = 0;
p_div->path_c_cnt_all = 0;
p_div->path_d_sum_all = 0;
p_div->path_d_cnt_all = 0;
if (p_div->use_path_a_as_default_ant == 1) {
rssi_bcd = (rssi_b + rssi_c + rssi_d) / 3;
if ((rssi_a + ANT_DECT_RSSI_TH) > rssi_bcd) {
p_div->is_path_a_exist = true;
p_div->default_path = PATH_A;
} else {
p_div->is_path_a_exist = false;
}
} else {
if (rssi_a >= rssi_b &&
rssi_a >= rssi_c &&
rssi_a >= rssi_d)
p_div->default_path = PATH_A;
else if ((rssi_b >= rssi_c) && (rssi_b >= rssi_d))
p_div->default_path = PATH_B;
else if (rssi_c >= rssi_d)
p_div->default_path = PATH_C;
else
p_div->default_path = PATH_D;
}
}
void phydm_candidate_dtp_update(
void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
p_div->num_candidate = 3;
if (p_div->use_path_a_as_default_ant == 1) {
if (p_div->num_tx_path == 3) {
if (p_div->is_path_a_exist) {
p_div->ant_candidate_1 = BB_PATH_ABC;
p_div->ant_candidate_2 = BB_PATH_ABD;
p_div->ant_candidate_3 = BB_PATH_ACD;
} else { /* use path BCD */
p_div->num_candidate = 1;
phydm_dtp_fix_tx_path(dm, BB_PATH_BCD);
return;
}
} else if (p_div->num_tx_path == 2) {
if (p_div->is_path_a_exist) {
p_div->ant_candidate_1 = BB_PATH_AB;
p_div->ant_candidate_2 = BB_PATH_AC;
p_div->ant_candidate_3 = BB_PATH_AD;
} else {
p_div->ant_candidate_1 = BB_PATH_BC;
p_div->ant_candidate_2 = BB_PATH_BD;
p_div->ant_candidate_3 = BB_PATH_CD;
}
}
} else {
/* @2 3 TX mode */
if (p_div->num_tx_path == 3) { /* @choose 3 ant form 4 */
if (p_div->default_path == PATH_A) {
/* @choose 2 ant form 3 */
p_div->ant_candidate_1 = BB_PATH_ABC;
p_div->ant_candidate_2 = BB_PATH_ABD;
p_div->ant_candidate_3 = BB_PATH_ACD;
} else if (p_div->default_path == PATH_B) {
p_div->ant_candidate_1 = BB_PATH_ABC;
p_div->ant_candidate_2 = BB_PATH_ABD;
p_div->ant_candidate_3 = BB_PATH_BCD;
} else if (p_div->default_path == PATH_C) {
p_div->ant_candidate_1 = BB_PATH_ABC;
p_div->ant_candidate_2 = BB_PATH_ACD;
p_div->ant_candidate_3 = BB_PATH_BCD;
} else if (p_div->default_path == PATH_D) {
p_div->ant_candidate_1 = BB_PATH_ABD;
p_div->ant_candidate_2 = BB_PATH_ACD;
p_div->ant_candidate_3 = BB_PATH_BCD;
}
}
/* @2 2 TX mode */
else if (p_div->num_tx_path == 2) { /* @choose 2 ant form 4 */
if (p_div->default_path == PATH_A) {
/* @choose 2 ant form 3 */
p_div->ant_candidate_1 = BB_PATH_AB;
p_div->ant_candidate_2 = BB_PATH_AC;
p_div->ant_candidate_3 = BB_PATH_AD;
} else if (p_div->default_path == PATH_B) {
p_div->ant_candidate_1 = BB_PATH_AB;
p_div->ant_candidate_2 = BB_PATH_BC;
p_div->ant_candidate_3 = BB_PATH_BD;
} else if (p_div->default_path == PATH_C) {
p_div->ant_candidate_1 = BB_PATH_AC;
p_div->ant_candidate_2 = BB_PATH_BC;
p_div->ant_candidate_3 = BB_PATH_CD;
} else if (p_div->default_path == PATH_D) {
p_div->ant_candidate_1 = BB_PATH_AD;
p_div->ant_candidate_2 = BB_PATH_BD;
p_div->ant_candidate_3 = BB_PATH_CD;
}
}
}
}
void phydm_dynamic_tx_path(
void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
struct sta_info *entry;
u32 i;
u8 num_client = 0;
u8 h2c_parameter[6] = {0};
if (!dm->is_linked) { /* @is_linked==False */
PHYDM_DBG(dm, DBG_PATH_DIV, "DTP_8814 [No Link!!!]\n");
if (p_div->is_become_linked) {
PHYDM_DBG(dm, DBG_PATH_DIV, "[Be disconnected]---->\n");
p_div->is_become_linked = dm->is_linked;
}
return;
} else {
if (!p_div->is_become_linked) {
PHYDM_DBG(dm, DBG_PATH_DIV, " [Be Linked !!!]----->\n");
p_div->is_become_linked = dm->is_linked;
}
}
/* @2 [period CTRL] */
if (p_div->dtp_period >= 2) {
p_div->dtp_period = 0;
} else {
p_div->dtp_period++;
return;
}
/* @2 [Fix path] */
if (dm->path_select != PHYDM_AUTO_PATH)
return;
/* @2 [Check Bfer] */
#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
#ifdef PHYDM_BEAMFORMING_SUPPORT
{
enum beamforming_cap beamform_cap = (dm->beamforming_info.beamform_cap);
if (beamform_cap & BEAMFORMER_CAP) { /* @BFmer On && Div On->Div Off */
if (p_div->fix_path_bfer == 0) {
PHYDM_DBG(dm, DBG_PATH_DIV,
"[ PathDiv : OFF ] BFmer ==1\n");
p_div->fix_path_bfer = 1;
}
return;
} else { /* @BFmer Off && Div Off->Div On */
if (p_div->fix_path_bfer == 1) {
PHYDM_DBG(dm, DBG_PATH_DIV,
"[ PathDiv : ON ] BFmer ==0\n");
p_div->fix_path_bfer = 0;
}
}
}
#endif
#endif
if (p_div->use_path_a_as_default_ant == 1) {
phydm_find_default_path(dm);
phydm_candidate_dtp_update(dm);
} else {
if (p_div->phydm_dtp_state == PHYDM_DTP_INIT) {
phydm_find_default_path(dm);
phydm_candidate_dtp_update(dm);
p_div->phydm_dtp_state = PHYDM_DTP_RUNNING_1;
}
else if (p_div->phydm_dtp_state == PHYDM_DTP_RUNNING_1) {
p_div->dtp_check_patha_counter++;
if (p_div->dtp_check_patha_counter >=
NUM_RESET_DTP_PERIOD) {
p_div->dtp_check_patha_counter = 0;
p_div->phydm_dtp_state = PHYDM_DTP_INIT;
}
#if 0
/* @2 Search space update */
else {
/* @1. find the worst candidate */
/* @2. repalce the worst candidate */
}
#endif
}
}
/* @2 Dynamic path Selection H2C */
if (p_div->num_candidate == 1) {
return;
} else {
h2c_parameter[0] = p_div->num_candidate;
h2c_parameter[1] = p_div->num_tx_path;
h2c_parameter[2] = p_div->ant_candidate_1;
h2c_parameter[3] = p_div->ant_candidate_2;
h2c_parameter[4] = p_div->ant_candidate_3;
odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter);
}
}
void phydm_dynamic_tx_path_init(
void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
void *adapter = dm->adapter;
u8 search_space_2[NUM_CHOOSE2_FROM4] = {BB_PATH_AB, BB_PATH_AC, BB_PATH_AD, BB_PATH_BC, BB_PATH_BD, BB_PATH_CD};
u8 search_space_3[NUM_CHOOSE3_FROM4] = {BB_PATH_BCD, BB_PATH_ACD, BB_PATH_ABD, BB_PATH_ABC};
#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT)
p_div->is_u3_mode = (*dm->hub_usb_mode == 2) ? 1 : 0;
PHYDM_DBG(dm, DBG_PATH_DIV, "[WIN USB] is_u3_mode = (( %d ))\n",
p_div->is_u3_mode);
#else
p_div->is_u3_mode = 1;
#endif
PHYDM_DBG(dm, DBG_PATH_DIV, "Dynamic TX path Init 8814\n");
memcpy(&p_div->search_space_2[0], &search_space_2[0],
NUM_CHOOSE2_FROM4);
memcpy(&p_div->search_space_3[0], &search_space_3[0],
NUM_CHOOSE3_FROM4);
p_div->use_path_a_as_default_ant = 1;
p_div->phydm_dtp_state = PHYDM_DTP_INIT;
dm->path_select = PHYDM_AUTO_PATH;
p_div->phydm_path_div_type = PHYDM_4R_PATH_DIV;
if (p_div->is_u3_mode) {
p_div->num_tx_path = 3;
phydm_dtp_fix_tx_path(dm, BB_PATH_BCD); /* @3TX Set Init TX path*/
} else {
p_div->num_tx_path = 2;
phydm_dtp_fix_tx_path(dm, BB_PATH_BC); /* @2TX // Set Init TX path*/
}
}
void phydm_process_rssi_for_path_div_8814a(void *dm_void, void *phy_info_void,
void *pkt_info_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct phydm_phyinfo_struct *phy_info = NULL;
struct phydm_perpkt_info_struct *pktinfo = NULL;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
phy_info = (struct phydm_phyinfo_struct *)phy_info_void;
pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void;
if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid))
return;
if (pktinfo->data_rate <= ODM_RATE11M)
return;
if (p_div->phydm_path_div_type == PHYDM_4R_PATH_DIV) {
p_div->path_a_sum_all += phy_info->rx_mimo_signal_strength[0];
p_div->path_a_cnt_all++;
p_div->path_b_sum_all += phy_info->rx_mimo_signal_strength[1];
p_div->path_b_cnt_all++;
p_div->path_c_sum_all += phy_info->rx_mimo_signal_strength[2];
p_div->path_c_cnt_all++;
p_div->path_d_sum_all += phy_info->rx_mimo_signal_strength[3];
p_div->path_d_cnt_all++;
}
}
void phydm_pathdiv_debug_8814a(void *dm_void, char input[][16], u32 *_used,
char *output, u32 *_out_len)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u32 used = *_used;
u32 out_len = *_out_len;
u32 dm_value[10] = {0};
u8 i, input_idx = 0;
for (i = 0; i < 5; i++) {
if (input[i + 1]) {
PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]);
input_idx++;
}
}
if (input_idx == 0)
return;
dm->path_select = (u8)(dm_value[0] & 0xf);
PDM_SNPF(out_len, used, output + used, out_len - used,
"Path_select = (( 0x%x ))\n", dm->path_select);
/* @2 [Fix path] */
if (dm->path_select != PHYDM_AUTO_PATH) {
PDM_SNPF(out_len, used, output + used, out_len - used,
"Turn on path [%s%s%s%s]\n",
((dm->path_select) & 0x1) ? "A" : "",
((dm->path_select) & 0x2) ? "B" : "",
((dm->path_select) & 0x4) ? "C" : "",
((dm->path_select) & 0x8) ? "D" : "");
phydm_dtp_fix_tx_path(dm, dm->path_select);
} else {
PDM_SNPF(out_len, used, output + used, out_len - used, "%s\n",
"Auto path");
}
*_used = used;
*_out_len = out_len;
}
#endif /* @#if RTL8814A_SUPPORT */
#if RTL8812A_SUPPORT
void phydm_update_tx_path_8812a(void *dm_void, enum bb_path path)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
if (p_div->default_tx_path != path) {
PHYDM_DBG(dm, DBG_PATH_DIV, "Need to Update Tx path\n");
if (path == BB_PATH_A) {
/*Tx by Reg*/
odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111);
/*Resp Tx by Txinfo*/
odm_set_bb_reg(dm, R_0x6d8, 0xc0, 1);
} else {
/*Tx by Reg*/
odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x222);
/*Resp Tx by Txinfo*/
odm_set_bb_reg(dm, R_0x6d8, 0xc0, 2);
}
}
p_div->default_tx_path = path;
PHYDM_DBG(dm, DBG_PATH_DIV, "path=%s\n",
(path == BB_PATH_A) ? "A" : "B");
}
void phydm_path_diversity_init_8812a(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u32 i;
odm_set_bb_reg(dm, R_0x80c, BIT(29), 1); /* Tx path from Reg */
odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111); /* Tx by Reg */
odm_set_bb_reg(dm, R_0x6d8, BIT(7) | BIT6, 1); /* Resp Tx by Txinfo */
phydm_set_tx_path_by_bb_reg(dm, RF_PATH_A);
for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
p_div->path_sel[i] = 1; /* TxInfo default at path-A */
}
#endif
#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT
void phydm_tx_path_diversity_init_jgr3(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u32 i;
for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
p_div->path_sel[i] = BB_PATH_A; /* TxInfo default at path-A */
}
void phydm_tx_by_mac_or_reg_jgr3(void *dm_void, enum phydm_path_ctrl ctrl)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
if (ctrl == TX_PATH_BY_REG) {
odm_set_bb_reg(dm, R_0x1e24, BIT(16), 0);
} else {
odm_set_bb_reg(dm, R_0x1e24, BIT(16), 1);
}
}
void phydm_set_resp_tx_path_by_fw(void *dm_void, u8 macid, enum bb_path path,
boolean enable)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u8 h2c_para[6] = {0};
u8 path_map[4];
u8 num_enable_path = 0;
u8 n_tx_path_ctrl_map = 0;
u8 i = 0, n_sts = 0;
/*Response TX is controlled in FW ctrl info*/
PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =====>\n", __func__);
if (enable) {
n_tx_path_ctrl_map = path;
for (i = 0; i < 4; i++) {
path_map[i] = 0;
if (path & BIT(i))
num_enable_path++;
}
for (i = 0; i < 4; i++) {
if (path & BIT(i)) {
path_map[i] = n_sts;
n_sts++;
if (n_sts == num_enable_path)
break;
}
}
}
PHYDM_DBG(dm, DBG_PATH_DIV, "ctrl_map=0x%x Map[D:A]={%d, %d, %d, %d}\n",
n_tx_path_ctrl_map,
path_map[3], path_map[2], path_map[1], path_map[0]);
h2c_para[0] = macid;
h2c_para[1] = n_tx_path_ctrl_map;
h2c_para[2] = (path_map[3] << 6) | (path_map[2] << 4) |
(path_map[1] << 2) | path_map[0];
odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_para);
}
#endif
void phydm_set_tx_path_by_bb_reg(void *dm_void, enum bb_path path)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] path=%s\n",
__func__, (path == BB_PATH_A) ? "A" : "B");
switch (dm->support_ic_type) {
#if RTL8822C_SUPPORT
case ODM_RTL8822C:
phydm_config_tx_path_8822c(dm, path);
break;
#endif
#if RTL8812A_SUPPORT
case ODM_RTL8812:
phydm_update_tx_path_8812a(dm, path);
break;
#endif
default:
break;
}
}
u8 phydm_get_tx_path_txdesc(void *dm_void, u8 macid)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u8 rpt_val = 0;
if (p_div->path_sel[macid] == BB_PATH_A)
rpt_val = 1;
else if (p_div->path_sel[macid] == BB_PATH_B)
rpt_val = 2;
return rpt_val;
}
void phydm_tx_path_diversity_2ss(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
struct cmn_sta_info *sta;
enum bb_path default_path = BB_PATH_A, path = BB_PATH_A;
u32 rssi_a = 0, rssi_b = 0;
u32 local_max_rssi, min_rssi = 0xff;
u8 i = 0;
PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =======>\n", __func__);
#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT
if (dm->support_ic_type & ODM_IC_JGR3_SERIES) {
if (dm->is_one_entry_only)
phydm_tx_by_mac_or_reg_jgr3(dm, TX_PATH_BY_REG);
else
phydm_tx_by_mac_or_reg_jgr3(dm, TX_PATH_BY_DESC);
}
#endif
for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
sta = dm->phydm_sta_info[i];
if (is_sta_active(sta))
continue;
/* 2 Caculate RSSI per path */
rssi_a = (p_div->path_a_cnt[i]) ?
(p_div->path_a_sum[i] / p_div->path_a_cnt[i]) : 0;
rssi_b = (p_div->path_b_cnt[i]) ?
(p_div->path_b_sum[i] / p_div->path_b_cnt[i]) : 0;
if (rssi_a == rssi_b)
path = p_div->default_tx_path;
else
path = (rssi_a > rssi_b) ? BB_PATH_A : BB_PATH_B;
local_max_rssi = (rssi_a > rssi_b) ? rssi_a : rssi_b;
PHYDM_DBG(dm, DBG_PATH_DIV,
"[%d]PathA sum=%d, cnt=%d, avg_rssi=%d\n",
i, p_div->path_a_sum[i],
p_div->path_a_cnt[i], rssi_a);
PHYDM_DBG(dm, DBG_PATH_DIV,
"[%d]PathB sum=%d, cnt=%d, avg_rssi=%d\n",
i, p_div->path_b_sum[i],
p_div->path_b_cnt[i], rssi_b);
/*Select default Tx path */
if (local_max_rssi < min_rssi) {
min_rssi = local_max_rssi;
default_path = path;
}
if (p_div->path_sel[i] != path) {
p_div->path_sel[i] = path;
#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT
if (dm->support_ic_type & ODM_IC_JGR3_SERIES)
phydm_set_resp_tx_path_by_fw(dm, i, path, true);
#endif
}
p_div->path_a_cnt[i] = 0;
p_div->path_a_sum[i] = 0;
p_div->path_b_cnt[i] = 0;
p_div->path_b_sum[i] = 0;
}
/* 2 Update default Tx path */
if (default_path != p_div->default_tx_path)
phydm_set_tx_path_by_bb_reg(dm, default_path);
}
void phydm_tx_path_diversity(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
if (!(dm->support_ability & ODM_BB_PATH_DIV))
return;
switch (dm->support_ic_type) {
#if (RTL8822C_SUPPORT || RTL8812A_SUPPORT)
case ODM_RTL8812:
case ODM_RTL8822C:
phydm_tx_path_diversity_2ss(dm);
break;
#endif
#if RTL8814A_SUPPORT
case ODM_RTL8814A:
phydm_dynamic_tx_path(dm);
break;
#endif
}
}
void phydm_tx_path_diversity_init(void *dm_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
if (!(dm->support_ability & ODM_BB_PATH_DIV))
return;
switch (dm->support_ic_type) {
#if RTL8822C_SUPPORT
case ODM_RTL8822C:
phydm_tx_path_diversity_init_jgr3(dm);
break;
#endif
#if RTL8812A_SUPPORT
case ODM_RTL8812:
phydm_path_diversity_init_8812a(dm);
break;
#endif
#if RTL8814A_SUPPORT
case ODM_RTL8814A:
phydm_dynamic_tx_path_init(dm);
break;
#endif
}
}
void phydm_process_rssi_for_path_div(void *dm_void, void *phy_info_void,
void *pkt_info_void)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct phydm_phyinfo_struct *phy_info = NULL;
struct phydm_perpkt_info_struct *pktinfo = NULL;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u8 id = 0;
phy_info = (struct phydm_phyinfo_struct *)phy_info_void;
pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void;
if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid))
return;
if (pktinfo->data_rate <= ODM_RATE11M)
return;
id = pktinfo->station_id;
p_div->path_a_sum[id] += phy_info->rx_mimo_signal_strength[0];
p_div->path_a_cnt[id]++;
p_div->path_b_sum[id] += phy_info->rx_mimo_signal_strength[1];
p_div->path_b_cnt[id]++;
}
void phydm_pathdiv_debug(void *dm_void, char input[][16], u32 *_used,
char *output, u32 *_out_len)
{
#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div;
u32 used = *_used;
u32 out_len = *_out_len;
u32 val[10] = {0};
u8 i, input_idx = 0;
if (input_idx == 0)
return;
PHYDM_SSCANF(input[1], DCMD_HEX, &val[0]);
PHYDM_SSCANF(input[2], DCMD_HEX, &val[1]);
if ((strcmp(input[1], "-h") == 0)) {
PDM_SNPF(out_len, used, output + used, out_len - used,
"{1:TX Ctrl Sig} {0:BB, 1:MAC}\n");
PDM_SNPF(out_len, used, output + used, out_len - used,
"{2:BB Default TX REG} {path}\n");
PDM_SNPF(out_len, used, output + used, out_len - used,
"{3:MAC DESC TX} {path} {macid}\n");
PDM_SNPF(out_len, used, output + used, out_len - used,
"{4:MAC Resp TX} {path} {macid}\n");
} else if (val[0] == 1) {
phydm_tx_by_mac_or_reg_jgr3(dm, (enum phydm_path_ctrl)val[1]);
} else if (val[0] == 2) {
phydm_set_tx_path_by_bb_reg(dm, (enum bb_path)val[1]);
} else if (val[0] == 3) {
p_div->path_sel[val[2]] = (enum bb_path)val[1];
} else if (val[0] == 4) {
phydm_set_resp_tx_path_by_fw(dm, (u8)val[2],
(enum bb_path)val[1], true);
}
*_used = used;
*_out_len = out_len;
#endif
}
void phydm_c2h_dtp_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len)
{
struct dm_struct *dm = (struct dm_struct *)dm_void;
struct _ODM_PATH_DIVERSITY_ *p_div = &dm->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];
PHYDM_DBG(dm, DBG_PATH_DIV, "Target_candidate = (( %d ))\n", target);
/*@
if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3))
{
phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_1);
}
else if( nsc_2 >= nsc_3)
{
phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_2);
}
else
{
phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_3);
}
*/
}
#endif /* @#ifdef CONFIG_PATH_DIVERSITY */
Reference in a new issue Copy permalink