| /****************************************************************************** |
| * |
| * 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. |
| * |
| *****************************************************************************/ |
| |
| /* ************************************************************ |
| * 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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->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, 0x93c, BIT(18) | BIT(19), 3); |
| |
| for (i = 0; i < 4; i++) { |
| if (path & BIT(i)) |
| num_enable_path++; |
| } |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" number of turn-on path : (( %d ))\n", num_enable_path)); |
| |
| if (num_enable_path == 1) { |
| odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); |
| |
| if (path == BB_PATH_A) { /* 1-1 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A ))\n")); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| } else if (path == BB_PATH_B) { /* 1-2 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B ))\n")); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); |
| } else if (path == BB_PATH_C) { /* 1-3 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( C ))\n")); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 0); |
| |
| } else if (path == BB_PATH_D) { /* 1-4 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( D ))\n")); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 0); |
| } |
| |
| } else if (num_enable_path == 2) { |
| odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); |
| odm_set_bb_reg(p_dm, 0x940, 0xf0, path); |
| |
| if (path == (BB_PATH_AB)) { /* 2-1 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); |
| } else if (path == BB_PATH_AC) { /* 2-2 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A C ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); |
| } else if (path == BB_PATH_AD) { /* 2-3 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A D ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); |
| } else if (path == BB_PATH_BC) { /* 2-4 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B C ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); |
| } else if (path == BB_PATH_BD) { /* 2-5 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B D ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); |
| } else if (path == BB_PATH_CD) { /* 2-6 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( C D ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); |
| } |
| |
| } else if (num_enable_path == 3) { |
| odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); |
| odm_set_bb_reg(p_dm, 0x940, 0xf0, path); |
| odm_set_bb_reg(p_dm, 0x940, 0xf0000, path); |
| |
| if (path == BB_PATH_ABC) { /* 3-1 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B C))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 2); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 2); |
| /* set for 3ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 2); |
| } else if (path == BB_PATH_ABD) { /* 3-2 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B D ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); |
| /* set for 3ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); |
| |
| } else if (path == BB_PATH_ACD) { /* 3-3 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A C D ))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); |
| /* set for 3ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); |
| } else if (path == BB_PATH_BCD) { /* 3-4 */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B C D))\n")); |
| /* set for 1ss */ |
| odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); |
| odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); |
| /* set for 2ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); |
| /* set for 3ss */ |
| odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 0); |
| odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 1); |
| odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); |
| } |
| } else if (num_enable_path == 4) |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path ((A B C D))\n")); |
| |
| } |
| |
| void |
| phydm_find_default_path( |
| void *p_dm_void |
| ) |
| { |
| struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->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 = BB_PATH_ABC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_ACD; |
| } else { /* use path BCD */ |
| p_dm_path_div->num_candidate = 1; |
| phydm_dtp_fix_tx_path(p_dm, BB_PATH_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 = BB_PATH_AB; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_AC; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_AD; |
| } else { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_BC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_BD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_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 = BB_PATH_ABC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_ACD; |
| } else if (p_dm_path_div->default_path == PATH_B) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_BCD; |
| } else if (p_dm_path_div->default_path == PATH_C) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_ACD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_BCD; |
| } else if (p_dm_path_div->default_path == PATH_D) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_ABD; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_ACD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_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 = BB_PATH_AB; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_AC; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_AD; |
| } else if (p_dm_path_div->default_path == PATH_B) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_AB; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_BC; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_BD; |
| } else if (p_dm_path_div->default_path == PATH_C) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_AC; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_BC; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_CD; |
| } else if (p_dm_path_div->default_path == PATH_D) { |
| p_dm_path_div->ant_candidate_1 = BB_PATH_AD; |
| p_dm_path_div->ant_candidate_2 = BB_PATH_BD; |
| p_dm_path_div->ant_candidate_3 = BB_PATH_CD; |
| } |
| } |
| } |
| } |
| |
| |
| void |
| phydm_dynamic_tx_path( |
| void *p_dm_void |
| ) |
| { |
| struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->dm_path_div; |
| |
| struct sta_info *p_entry; |
| u32 i; |
| u8 num_client = 0; |
| u8 h2c_parameter[6] = {0}; |
| |
| |
| if (!p_dm->is_linked) { /* is_linked==False */ |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("DTP_8814 [No Link!!!]\n")); |
| |
| if (p_dm_path_div->is_become_linked == true) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" [Be disconnected]----->\n")); |
| p_dm_path_div->is_become_linked = p_dm->is_linked; |
| } |
| return; |
| } else { |
| if (p_dm_path_div->is_become_linked == false) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, (" [Be Linked !!!]----->\n")); |
| p_dm_path_div->is_become_linked = p_dm->is_linked; |
| } |
| } |
| |
| /* 2 [period CTRL] */ |
| if (p_dm_path_div->dtp_period >= 2) |
| p_dm_path_div->dtp_period = 0; |
| else { |
| /* PHYDM_DBG(p_dm,DBG_PATH_DIV, ("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->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->beamforming_info.beamform_cap); |
| |
| if (beamform_cap & BEAMFORMER_CAP) { /* BFmer On && Div On->Div Off */ |
| if (p_dm_path_div->fix_path_bfer == 0) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[ 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) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[ 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); |
| phydm_candidate_dtp_update(p_dm); |
| } else { |
| if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_INIT) { |
| phydm_find_default_path(p_dm); |
| phydm_candidate_dtp_update(p_dm); |
| 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, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter); |
| } |
| |
| } |
| |
| |
| |
| void |
| phydm_dynamic_tx_path_init( |
| void *p_dm_void |
| ) |
| { |
| struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); |
| struct _ADAPTER *p_adapter = p_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_dm_path_div->is_u3_mode = (*p_dm->hub_usb_mode == 2) ? 1 : 0; |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[WIN USB] is_u3_mode = (( %d ))\n", p_dm_path_div->is_u3_mode)); |
| #else |
| p_dm_path_div->is_u3_mode = 1; |
| #endif |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Dynamic TX path Init 8814\n")); |
| |
| 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->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, BB_PATH_BCD);/* 3TX Set Init TX path*/ |
| |
| } else { |
| p_dm_path_div->num_tx_path = 2; |
| phydm_dtp_fix_tx_path(p_dm, BB_PATH_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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; |
| struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->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->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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); |
| u32 used = *_used; |
| u32 out_len = *_out_len; |
| |
| p_dm->path_select = (dm_value[0] & 0xf); |
| PHYDM_SNPRINTF((output + used, out_len - used, "Path_select = (( 0x%x ))\n", p_dm->path_select)); |
| |
| /* 2 [Fix path] */ |
| if (p_dm->path_select != PHYDM_AUTO_PATH) { |
| PHYDM_SNPRINTF((output + used, out_len - used, "Trun on path [%s%s%s%s]\n", |
| ((p_dm->path_select) & 0x1) ? "A" : "", |
| ((p_dm->path_select) & 0x2) ? "B" : "", |
| ((p_dm->path_select) & 0x4) ? "C" : "", |
| ((p_dm->path_select) & 0x8) ? "D" : "")); |
| |
| phydm_dtp_fix_tx_path(p_dm, p_dm->path_select); |
| } else |
| PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Auto path")); |
| |
| *_used = used; |
| *_out_len = out_len; |
| } |
| |
| #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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_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(p_dm, DBG_PATH_DIV, ("Target_candidate = (( %d ))\n", target)); |
| /* |
| if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) |
| { |
| phydm_dtp_fix_tx_path(p_dm, p_dm_path_div->ant_candidate_1); |
| } |
| else if( nsc_2 >= nsc_3) |
| { |
| phydm_dtp_fix_tx_path(p_dm, p_dm_path_div->ant_candidate_2); |
| } |
| else |
| { |
| phydm_dtp_fix_tx_path(p_dm, 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 = (struct PHY_DM_STRUCT *)p_dm_void; |
| |
| if (!(p_dm->support_ability & ODM_BB_PATH_DIV)) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Return: Not Support PathDiv\n")); |
| return; |
| } |
| |
| #if RTL8812A_SUPPORT |
| |
| if (p_dm->support_ic_type & ODM_RTL8812) |
| odm_path_diversity_8812a(p_dm); |
| else |
| #endif |
| |
| #if RTL8814A_SUPPORT |
| if (p_dm->support_ic_type & ODM_RTL8814A) |
| phydm_dynamic_tx_path(p_dm); |
| else |
| #endif |
| {} |
| #endif |
| } |
| |
| void |
| phydm_path_diversity_init( |
| void *p_dm_void |
| ) |
| { |
| #if (defined(CONFIG_PATH_DIVERSITY)) |
| struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; |
| |
| /*p_dm->support_ability |= ODM_BB_PATH_DIV;*/ |
| |
| if (*(p_dm->p_mp_mode) == true) |
| return; |
| |
| if (!(p_dm->support_ability & ODM_BB_PATH_DIV)) { |
| PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Return: Not Support PathDiv\n")); |
| return; |
| } |
| |
| #if RTL8812A_SUPPORT |
| if (p_dm->support_ic_type & ODM_RTL8812) |
| odm_path_diversity_init_8812a(p_dm); |
| else |
| #endif |
| |
| #if RTL8814A_SUPPORT |
| if (p_dm->support_ic_type & ODM_RTL8814A) |
| phydm_dynamic_tx_path_init(p_dm); |
| 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) */ |
