--- /dev/null
+/******************************************************************************
+ *
+ * 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;
+ 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_dm_odm->hub_usb_mode == 2) ? 1 : 0 ;
+ ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("[WIN USB] is_u3_mode = (( %d ))\n", p_dm_path_div->is_u3_mode));
+#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"));
+
+ 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) */