OSDN Git Service

Add rtl8821ce driver version 5.5.2
[android-x86/external-kernel-drivers.git] / rtl8821ce / hal / btc / halbtc8723d2ant.c
diff --git a/rtl8821ce/hal/btc/halbtc8723d2ant.c b/rtl8821ce/hal/btc/halbtc8723d2ant.c
new file mode 100644 (file)
index 0000000..0179d64
--- /dev/null
@@ -0,0 +1,6837 @@
+/* ************************************************************
+ * Description:
+ *
+ * This file is for RTL8723D Co-exist mechanism
+ *
+ * History
+ * 2012/11/15 Cosa first check in.
+ *
+ * ************************************************************ */
+
+/* ************************************************************
+ * include files
+ * ************************************************************ */
+#include "mp_precomp.h"
+
+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1)
+
+#if (RTL8723D_SUPPORT == 1)
+/* ************************************************************
+ * Global variables, these are static variables
+ * ************************************************************ */
+static u8      *trace_buf = &gl_btc_trace_buf[0];
+static struct  coex_dm_8723d_2ant              glcoex_dm_8723d_2ant;
+static struct  coex_dm_8723d_2ant      *coex_dm = &glcoex_dm_8723d_2ant;
+static struct  coex_sta_8723d_2ant             glcoex_sta_8723d_2ant;
+static struct  coex_sta_8723d_2ant     *coex_sta = &glcoex_sta_8723d_2ant;
+static struct  psdscan_sta_8723d_2ant  gl_psd_scan_8723d_2ant;
+static struct  psdscan_sta_8723d_2ant *psd_scan = &gl_psd_scan_8723d_2ant;
+
+const char *const glbt_info_src_8723d_2ant[] = {
+       "BT Info[wifi fw]",
+       "BT Info[bt rsp]",
+       "BT Info[bt auto report]",
+};
+/* ************************************************************
+ * BtCoex Version Format:
+ * 1. date :                   glcoex_ver_date_XXXXX_1ant
+ * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant
+ * 3. BtCoexVersion :  glcoex_ver_btdesired_XXXXX_1ant
+ * 4. others :                 glcoex_ver_XXXXXX_XXXXX_1ant
+ *
+ * Variable should be indicated IC and Antenna numbers !!!
+ * Please strictly follow this order and naming style !!!
+ *
+ * ************************************************************ */
+u32    glcoex_ver_date_8723d_2ant = 20161220;
+u32    glcoex_ver_8723d_2ant = 0x13;
+u32 glcoex_ver_btdesired_8723d_2ant = 0x10;
+
+
+/* ************************************************************
+ * local function proto type if needed
+ * ************************************************************
+ * ************************************************************
+ * local function start with halbtc8723d2ant_
+ * ************************************************************ */
+u8 halbtc8723d2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num,
+                                u8 rssi_thresh, u8 rssi_thresh1)
+{
+       s32                     bt_rssi = 0;
+       u8                      bt_rssi_state = *ppre_bt_rssi_state;
+
+       bt_rssi = coex_sta->bt_rssi;
+
+       if (level_num == 2) {
+               if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) ||
+                   (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) {
+                       if (bt_rssi >= (rssi_thresh +
+                                       BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               bt_rssi_state = BTC_RSSI_STATE_HIGH;
+                       else
+                               bt_rssi_state = BTC_RSSI_STATE_STAY_LOW;
+               } else {
+                       if (bt_rssi < rssi_thresh)
+                               bt_rssi_state = BTC_RSSI_STATE_LOW;
+                       else
+                               bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH;
+               }
+       } else if (level_num == 3) {
+               if (rssi_thresh > rssi_thresh1) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], BT Rssi thresh error!!\n");
+                       BTC_TRACE(trace_buf);
+                       return *ppre_bt_rssi_state;
+               }
+
+               if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) ||
+                   (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) {
+                       if (bt_rssi >= (rssi_thresh +
+                                       BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               bt_rssi_state = BTC_RSSI_STATE_MEDIUM;
+                       else
+                               bt_rssi_state = BTC_RSSI_STATE_STAY_LOW;
+               } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) ||
+                       (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) {
+                       if (bt_rssi >= (rssi_thresh1 +
+                                       BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               bt_rssi_state = BTC_RSSI_STATE_HIGH;
+                       else if (bt_rssi < rssi_thresh)
+                               bt_rssi_state = BTC_RSSI_STATE_LOW;
+                       else
+                               bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM;
+               } else {
+                       if (bt_rssi < rssi_thresh1)
+                               bt_rssi_state = BTC_RSSI_STATE_MEDIUM;
+                       else
+                               bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH;
+               }
+       }
+
+       *ppre_bt_rssi_state = bt_rssi_state;
+
+       return bt_rssi_state;
+}
+
+u8 halbtc8723d2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist,
+          IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh,
+                                  IN u8 rssi_thresh1)
+{
+       s32                     wifi_rssi = 0;
+       u8                      wifi_rssi_state = *pprewifi_rssi_state;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi);
+
+       if (level_num == 2) {
+               if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) ||
+                   (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) {
+                       if (wifi_rssi >= (rssi_thresh +
+                                         BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               wifi_rssi_state = BTC_RSSI_STATE_HIGH;
+                       else
+                               wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW;
+               } else {
+                       if (wifi_rssi < rssi_thresh)
+                               wifi_rssi_state = BTC_RSSI_STATE_LOW;
+                       else
+                               wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH;
+               }
+       } else if (level_num == 3) {
+               if (rssi_thresh > rssi_thresh1) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], wifi RSSI thresh error!!\n");
+                       BTC_TRACE(trace_buf);
+                       return *pprewifi_rssi_state;
+               }
+
+               if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) ||
+                   (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) {
+                       if (wifi_rssi >= (rssi_thresh +
+                                         BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               wifi_rssi_state = BTC_RSSI_STATE_MEDIUM;
+                       else
+                               wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW;
+               } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) ||
+                       (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) {
+                       if (wifi_rssi >= (rssi_thresh1 +
+                                         BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT))
+                               wifi_rssi_state = BTC_RSSI_STATE_HIGH;
+                       else if (wifi_rssi < rssi_thresh)
+                               wifi_rssi_state = BTC_RSSI_STATE_LOW;
+                       else
+                               wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM;
+               } else {
+                       if (wifi_rssi < rssi_thresh1)
+                               wifi_rssi_state = BTC_RSSI_STATE_MEDIUM;
+                       else
+                               wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH;
+               }
+       }
+
+       *pprewifi_rssi_state = wifi_rssi_state;
+
+       return wifi_rssi_state;
+}
+
+void halbtc8723d2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist,
+               IN u8 isolation_measuared)
+{
+       s8      interference_wl_tx = 0, interference_bt_tx = 0;
+
+
+       interference_wl_tx = BT_8723D_2ANT_WIFI_MAX_TX_POWER -
+                            isolation_measuared;
+       interference_bt_tx = BT_8723D_2ANT_BT_MAX_TX_POWER -
+                            isolation_measuared;
+
+
+
+       coex_sta->wifi_coex_thres                = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1;
+       coex_sta->wifi_coex_thres2       = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2;
+
+       coex_sta->bt_coex_thres          = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1;
+       coex_sta->bt_coex_thres2                 = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2;
+
+
+       /*
+               coex_sta->wifi_coex_thres               = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES1;
+               coex_sta->wifi_coex_thres2              = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES2;
+
+               coex_sta->bt_coex_thres         = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES1;
+               coex_sta->bt_coex_thres2                = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES2;
+       */
+
+
+
+
+
+       /*
+               if  ( BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared -
+                                       BT_8723D_2ANT_DEFAULT_ISOLATION) )
+                       coex_sta->wifi_coex_thres        = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1;
+               else
+                       coex_sta->wifi_coex_thres =  BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 -  (isolation_measuared -
+                                       BT_8723D_2ANT_DEFAULT_ISOLATION);
+
+               if  ( BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared -
+                                       BT_8723D_2ANT_DEFAULT_ISOLATION) )
+                       coex_sta->bt_coex_thres  = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1;
+               else
+                       coex_sta->bt_coex_thres =  BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 -  (isolation_measuared -
+                                       BT_8723D_2ANT_DEFAULT_ISOLATION);
+
+       */
+}
+
+
+void halbtc8723d2ant_limited_rx(IN struct btc_coexist *btcoexist,
+                       IN boolean force_exec, IN boolean rej_ap_agg_pkt,
+                       IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size)
+{
+       boolean reject_rx_agg = rej_ap_agg_pkt;
+       boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size;
+       u8      rx_agg_size = agg_buf_size;
+
+       /* ============================================ */
+       /*      Rx Aggregation related setting */
+       /* ============================================ */
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT,
+                          &reject_rx_agg);
+       /* decide BT control aggregation buf size or not */
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE,
+                          &bt_ctrl_rx_agg_size);
+       /* aggregation buf size, only work when BT control Rx aggregation size. */
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size);
+       /* real update aggregation setting */
+       btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);
+}
+
+void halbtc8723d2ant_query_bt_info(IN struct btc_coexist *btcoexist)
+{
+       u8                      h2c_parameter[1] = {0};
+
+
+       h2c_parameter[0] |= BIT(0);     /* trigger */
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter);
+}
+
+void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist)
+{
+       u32                     reg_hp_txrx, reg_lp_txrx, u32tmp;
+       u32                     reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0;
+       static u8               num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0,
+                               cnt_autoslot_hang = 0;
+
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+       reg_hp_txrx = 0x770;
+       reg_lp_txrx = 0x774;
+
+       u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx);
+       reg_hp_tx = u32tmp & MASKLWORD;
+       reg_hp_rx = (u32tmp & MASKHWORD) >> 16;
+
+       u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx);
+       reg_lp_tx = u32tmp & MASKLWORD;
+       reg_lp_rx = (u32tmp & MASKHWORD) >> 16;
+
+       coex_sta->high_priority_tx = reg_hp_tx;
+       coex_sta->high_priority_rx = reg_hp_rx;
+       coex_sta->low_priority_tx = reg_lp_tx;
+       coex_sta->low_priority_rx = reg_lp_rx;
+
+       if (BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE ==
+               coex_dm->bt_status) {
+
+                       if (coex_sta->high_priority_rx >= 15) {
+                                       if (cnt_overhead < 3)
+                                               cnt_overhead++;
+
+                                       if (cnt_overhead == 3)
+                                               coex_sta->is_hiPri_rx_overhead = true;
+                        } else {
+                                       if (cnt_overhead > 0)
+                                               cnt_overhead--;
+
+                                       if (cnt_overhead == 0)
+                                               coex_sta->is_hiPri_rx_overhead = false;
+                       }
+       } else
+               coex_sta->is_hiPri_rx_overhead = false;
+
+       /* reset counter */
+       btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc);
+
+       if ((coex_sta->low_priority_tx > 1050)  &&
+           (!coex_sta->c2h_bt_inquiry_page))
+               coex_sta->pop_event_cnt++;
+
+       if ((coex_sta->low_priority_rx >= 950) &&
+           (coex_sta->low_priority_rx >= coex_sta->low_priority_tx)
+           && (!coex_sta->under_ips)  && (!coex_sta->c2h_bt_inquiry_page) &&
+           (coex_sta->bt_link_exist))  {
+               if (cnt_slave >= 2) {
+                       bt_link_info->slave_role = true;
+                       cnt_slave = 2;
+               } else
+                       cnt_slave++;
+       } else {
+               if (cnt_slave == 0)     {
+                       bt_link_info->slave_role = false;
+                       cnt_slave = 0;
+               } else
+                       cnt_slave--;
+
+       }
+
+       if (coex_sta->is_tdma_btautoslot) {
+               if ((coex_sta->low_priority_tx >= 1300) &&
+                       (coex_sta->low_priority_rx <= 150)) {
+                       if (cnt_autoslot_hang >= 2) {
+                               coex_sta->is_tdma_btautoslot_hang = true;
+                               cnt_autoslot_hang = 2;
+                       } else
+                               cnt_autoslot_hang++;
+               } else {
+                       if (cnt_autoslot_hang == 0)     {
+                               coex_sta->is_tdma_btautoslot_hang = false;
+                               cnt_autoslot_hang = 0;
+                       } else
+                               cnt_autoslot_hang--;
+               }
+       }
+
+       if (coex_sta->sco_exist) {
+               if ((coex_sta->high_priority_tx >= 400) &&
+               (coex_sta->high_priority_rx >= 400))
+                       coex_sta->is_eSCO_mode = false;
+               else
+                       coex_sta->is_eSCO_mode = true;
+       }
+
+       if (!coex_sta->bt_disabled) {
+
+               if ((coex_sta->high_priority_tx == 0) &&
+                   (coex_sta->high_priority_rx == 0) &&
+                   (coex_sta->low_priority_tx == 0) &&
+                   (coex_sta->low_priority_rx == 0)) {
+                       num_of_bt_counter_chk++;
+                       if (num_of_bt_counter_chk >= 3) {
+                               halbtc8723d2ant_query_bt_info(btcoexist);
+                               num_of_bt_counter_chk = 0;
+                       }
+               }
+       }
+
+}
+
+void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist)
+{
+#if 1
+               s32 wifi_rssi = 0;
+               boolean wifi_busy = false, wifi_under_b_mode = false,
+                               wifi_scan = false;
+               boolean bt_idle = false, wl_idle = false;
+               static u8 cck_lock_counter = 0, wl_noisy_count0 = 0,
+                               wl_noisy_count1 = 3, wl_noisy_count2 = 0;
+               u32 total_cnt, reg_val1, reg_val2, cck_cnt;
+
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+               btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi);
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,
+                                  &wifi_under_b_mode);
+
+               coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_OK_CCK);
+               coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_OK_LEGACY);
+               coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_OK_HT);
+               coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_OK_VHT);
+
+               coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_ERROR_CCK);
+               coex_sta->crc_err_11g =  btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY);
+               coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_ERROR_HT);
+               coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter(
+                                                               btcoexist, PHYDM_INFO_CRC32_ERROR_VHT);
+
+               cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck;
+
+               if (cck_cnt > 250) {
+                       if (wl_noisy_count2 < 3)
+                               wl_noisy_count2++;
+
+                       if (wl_noisy_count2 == 3) {
+                               wl_noisy_count0 = 0;
+                               wl_noisy_count1 = 0;
+                       }
+               } else if (cck_cnt < 50) {
+                       if (wl_noisy_count0 < 3)
+                               wl_noisy_count0++;
+
+                       if (wl_noisy_count0 == 3) {
+                               wl_noisy_count1 = 0;
+                               wl_noisy_count2 = 0;
+                       }
+               } else {
+                       if (wl_noisy_count1 < 3)
+                               wl_noisy_count1++;
+
+                       if (wl_noisy_count1 == 3) {
+                               wl_noisy_count0 = 0;
+                               wl_noisy_count2 = 0;
+                       }
+               }
+
+               if (wl_noisy_count2 == 3)
+                       coex_sta->wl_noisy_level = 2;
+               else if (wl_noisy_count1 == 3)
+                       coex_sta->wl_noisy_level = 1;
+               else
+                       coex_sta->wl_noisy_level = 0;
+
+               if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) {
+                       total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g +
+                                       coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht;
+
+                       if ((coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_BUSY) ||
+                               (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY) ||
+                               (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_SCO_BUSY)) {
+                               if (coex_sta->crc_ok_cck > (total_cnt -
+                                                               coex_sta->crc_ok_cck)) {
+                                       if (cck_lock_counter < 3)
+                                               cck_lock_counter++;
+                               } else {
+                                       if (cck_lock_counter > 0)
+                                               cck_lock_counter--;
+                               }
+
+                       } else {
+                               if (cck_lock_counter > 0)
+                                       cck_lock_counter--;
+                       }
+               } else {
+                       if (cck_lock_counter > 0)
+                               cck_lock_counter--;
+               }
+
+               if (!coex_sta->pre_ccklock) {
+
+                       if (cck_lock_counter >= 3)
+                               coex_sta->cck_lock = true;
+                       else
+                               coex_sta->cck_lock = false;
+               } else {
+                       if (cck_lock_counter == 0)
+                               coex_sta->cck_lock = false;
+                       else
+                               coex_sta->cck_lock = true;
+               }
+
+               if (coex_sta->cck_lock)
+                       coex_sta->cck_ever_lock = true;
+
+               coex_sta->pre_ccklock =  coex_sta->cck_lock;
+
+#endif
+}
+
+void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;
+       boolean                 bt_hs_on = false;
+       boolean                 bt_busy = false;
+
+
+       coex_sta->num_of_profile = 0;
+
+       /* set link exist status */
+       if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) {
+               coex_sta->bt_link_exist = false;
+               coex_sta->pan_exist = false;
+               coex_sta->a2dp_exist = false;
+               coex_sta->hid_exist = false;
+               coex_sta->sco_exist = false;
+       } else {        /* connection exists */
+               coex_sta->bt_link_exist = true;
+               if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_FTP) {
+                       coex_sta->pan_exist = true;
+                       coex_sta->num_of_profile++;
+               } else
+                       coex_sta->pan_exist = false;
+
+               if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_A2DP) {
+                       coex_sta->a2dp_exist = true;
+                       coex_sta->num_of_profile++;
+               } else
+                       coex_sta->a2dp_exist = false;
+
+               if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_HID) {
+                       coex_sta->hid_exist = true;
+                       coex_sta->num_of_profile++;
+               } else
+                       coex_sta->hid_exist = false;
+
+               if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) {
+                       coex_sta->sco_exist = true;
+                       coex_sta->num_of_profile++;
+               } else
+                       coex_sta->sco_exist = false;
+
+       }
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);
+
+       bt_link_info->bt_link_exist = coex_sta->bt_link_exist;
+       bt_link_info->sco_exist = coex_sta->sco_exist;
+       bt_link_info->a2dp_exist = coex_sta->a2dp_exist;
+       bt_link_info->pan_exist = coex_sta->pan_exist;
+       bt_link_info->hid_exist = coex_sta->hid_exist;
+       bt_link_info->acl_busy = coex_sta->acl_busy;
+
+       /* work around for HS mode. */
+       if (bt_hs_on) {
+               bt_link_info->pan_exist = true;
+               bt_link_info->bt_link_exist = true;
+       }
+
+       /* check if Sco only */
+       if (bt_link_info->sco_exist &&
+           !bt_link_info->a2dp_exist &&
+           !bt_link_info->pan_exist &&
+           !bt_link_info->hid_exist)
+               bt_link_info->sco_only = true;
+       else
+               bt_link_info->sco_only = false;
+
+       /* check if A2dp only */
+       if (!bt_link_info->sco_exist &&
+           bt_link_info->a2dp_exist &&
+           !bt_link_info->pan_exist &&
+           !bt_link_info->hid_exist)
+               bt_link_info->a2dp_only = true;
+       else
+               bt_link_info->a2dp_only = false;
+
+       /* check if Pan only */
+       if (!bt_link_info->sco_exist &&
+           !bt_link_info->a2dp_exist &&
+           bt_link_info->pan_exist &&
+           !bt_link_info->hid_exist)
+               bt_link_info->pan_only = true;
+       else
+               bt_link_info->pan_only = false;
+
+       /* check if Hid only */
+       if (!bt_link_info->sco_exist &&
+           !bt_link_info->a2dp_exist &&
+           !bt_link_info->pan_exist &&
+           bt_link_info->hid_exist)
+               bt_link_info->hid_only = true;
+       else
+               bt_link_info->hid_only = false;
+
+       if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_INQ_PAGE) {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_INQ_PAGE;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n");
+       } else if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n");
+       } else if (coex_sta->bt_info == BT_INFO_8723D_2ANT_B_CONNECTION) {
+               /* connection exists but no busy */
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n");
+       } else if (((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) ||
+                   (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) &&
+                  (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY)) {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n");
+       } else if ((coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) ||
+                  (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_SCO_BUSY;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n");
+       } else if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY) {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_BUSY;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n");
+       } else {
+               coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_MAX;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n");
+       }
+
+       BTC_TRACE(trace_buf);
+
+       if ((BT_8723D_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) ||
+           (BT_8723D_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||
+           (BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status))
+               bt_busy = true;
+       else
+               bt_busy = false;
+
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy);
+}
+
+void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist,
+               IN u8 type)
+{
+       u8                      h2c_parameter[3] = {0};
+       u32                     wifi_bw;
+       u8                      wifi_central_chnl;
+
+       /* only 2.4G we need to inform bt the chnl mask */
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL,
+                          &wifi_central_chnl);
+       if ((BTC_MEDIA_CONNECT == type) &&
+           (wifi_central_chnl <= 14)) {
+               h2c_parameter[0] =
+                       0x1;  /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */
+               /* h2c_parameter[0] = 0x0; */
+               h2c_parameter[1] = wifi_central_chnl;
+               btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw);
+               if (BTC_WIFI_BW_HT40 == wifi_bw)
+                       h2c_parameter[2] = 0x30;
+               else
+                       h2c_parameter[2] = 0x20;
+       }
+
+       coex_dm->wifi_chnl_info[0] = h2c_parameter[0];
+       coex_dm->wifi_chnl_info[1] = h2c_parameter[1];
+       coex_dm->wifi_chnl_info[2] = h2c_parameter[2];
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter);
+
+}
+
+void halbtc8723d2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist,
+               IN u8 dac_swing_lvl)
+{
+       u8                      h2c_parameter[1] = {0};
+
+       /* There are several type of dacswing */
+       /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */
+       h2c_parameter[0] = dac_swing_lvl;
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter);
+}
+
+void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist,
+                             IN boolean force_exec, IN u8 fw_dac_swing_lvl)
+{
+       coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl;
+
+       if (!force_exec) {
+               if (coex_dm->pre_fw_dac_swing_lvl ==
+                   coex_dm->cur_fw_dac_swing_lvl)
+                       return;
+       }
+
+       halbtc8723d2ant_set_fw_dac_swing_level(btcoexist,
+                                              coex_dm->cur_fw_dac_swing_lvl);
+
+       coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl;
+}
+
+void halbtc8723d2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist,
+                                      IN u8 dec_bt_pwr_lvl)
+{
+       u8                      h2c_parameter[1] = {0};
+
+       h2c_parameter[0] = dec_bt_pwr_lvl;
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter);
+}
+
+void halbtc8723d2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist,
+                               IN boolean force_exec, IN u8 dec_bt_pwr_lvl)
+{
+       coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl;
+
+       if (!force_exec) {
+               if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl)
+                       return;
+       }
+       halbtc8723d2ant_set_fw_dec_bt_pwr(btcoexist,
+                                         coex_dm->cur_bt_dec_pwr_lvl);
+
+       coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl;
+}
+
+void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist
+               *btcoexist, IN boolean low_penalty_ra)
+{
+#if 1
+       u8                      h2c_parameter[6] = {0};
+
+       h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */
+
+       if (low_penalty_ra) {
+               h2c_parameter[1] |= BIT(0);
+               h2c_parameter[2] =
+                       0x00;  /* normal rate except MCS7/6/5, OFDM54/48/36 */
+               h2c_parameter[3] = 0xf7;  /* MCS7 or OFDM54 */
+               h2c_parameter[4] = 0xf8;  /* MCS6 or OFDM48 */
+               h2c_parameter[5] = 0xf9;        /* MCS5 or OFDM36        */
+       }
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter);
+#endif
+}
+
+void halbtc8723d2ant_low_penalty_ra(IN struct btc_coexist *btcoexist,
+                           IN boolean force_exec, IN boolean low_penalty_ra)
+{
+#if 1
+       coex_dm->cur_low_penalty_ra = low_penalty_ra;
+
+       if (!force_exec) {
+               if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra)
+                       return;
+       }
+
+       halbtc8723d2ant_set_fw_low_penalty_ra(btcoexist,
+                                                         coex_dm->cur_low_penalty_ra);
+
+#if 0
+       if (low_penalty_ra)
+               btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15);
+       else
+               btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0);
+#endif
+       coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra;
+
+#endif
+}
+
+void halbtc8723d2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist,
+                                       IN boolean enable_auto_report)
+{
+       u8                      h2c_parameter[1] = {0};
+
+       h2c_parameter[0] = 0;
+
+       if (enable_auto_report)
+               h2c_parameter[0] |= BIT(0);
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter);
+}
+
+void halbtc8723d2ant_bt_auto_report(IN struct btc_coexist *btcoexist,
+                   IN boolean force_exec, IN boolean enable_auto_report)
+{
+       coex_dm->cur_bt_auto_report = enable_auto_report;
+
+       if (!force_exec) {
+               if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report)
+                       return;
+       }
+       halbtc8723d2ant_set_bt_auto_report(btcoexist,
+                                          coex_dm->cur_bt_auto_report);
+
+       coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report;
+}
+
+void halbtc8723d2ant_write_score_board(
+       IN      struct  btc_coexist             *btcoexist,
+       IN      u16                             bitpos,
+       IN      boolean         state
+)
+{
+
+       static u16 originalval = 0x8002;
+
+       if (state)
+               originalval = originalval | bitpos;
+       else
+               originalval = originalval & (~bitpos);
+
+
+       btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval);
+
+}
+
+void halbtc8723d2ant_read_score_board(
+       IN      struct  btc_coexist             *btcoexist,
+       IN   u16                                *score_board_val
+)
+{
+
+       *score_board_val = (btcoexist->btc_read_2byte(btcoexist,
+                           0xaa)) & 0x7fff;
+}
+
+
+void halbtc8723d2ant_post_state_to_bt(
+       IN      struct  btc_coexist             *btcoexist,
+       IN      u16                                             type,
+       IN  boolean                 state
+)
+{
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], halbtc8723d2ant_post_state_to_bt: type = %d, state =%d\n",
+               type, state);
+       BTC_TRACE(trace_buf);
+
+       halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state);
+
+}
+
+boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist
+               *btcoexist)
+{
+
+       static boolean  pre_wifi_busy = false, pre_under_4way = false,
+               pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false;
+       static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0;
+       boolean wifi_busy = false, under_4way = false, bt_hs_on = false;
+       boolean wifi_connected = false;
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
+                          &wifi_connected);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,
+                          &under_4way);
+
+       if (coex_sta->bt_disabled != pre_bt_off) {
+               pre_bt_off = coex_sta->bt_disabled;
+
+               if (coex_sta->bt_disabled)
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], BT is disabled !!\n");
+               else
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], BT is enabled !!\n");
+
+               BTC_TRACE(trace_buf);
+
+               coex_sta->bt_coex_supported_feature = 0;
+               coex_sta->bt_coex_supported_version = 0;
+               coex_sta->bt_ble_scan_type = 0;
+               coex_sta->bt_ble_scan_para[0] = 0;
+               coex_sta->bt_ble_scan_para[1] = 0;
+               coex_sta->bt_ble_scan_para[2] = 0;
+               coex_sta->bt_reg_vendor_ac = 0xffff;
+               coex_sta->bt_reg_vendor_ae = 0xffff;
+               return true;
+       }
+
+       if (wifi_connected) {
+               if (wifi_busy != pre_wifi_busy) {
+                       pre_wifi_busy = wifi_busy;
+
+                       if (wifi_busy)
+                               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true);
+                       else
+                               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false);
+                       return true;
+               }
+               if (under_4way != pre_under_4way) {
+                       pre_under_4way = under_4way;
+                       return true;
+               }
+               if (bt_hs_on != pre_bt_hs_on) {
+                       pre_bt_hs_on = bt_hs_on;
+                       return true;
+               }
+               if (coex_sta->wl_noisy_level != pre_wl_noisy_level) {
+                       pre_wl_noisy_level = coex_sta->wl_noisy_level;
+                       return true;
+               }
+       }
+
+       if (!coex_sta->bt_disabled) {
+               if (coex_sta->hid_busy_num != pre_hid_busy_num) {
+                       pre_hid_busy_num = coex_sta->hid_busy_num;
+                       return true;
+               }
+       }
+
+       if (bt_link_info->slave_role != pre_bt_slave) {
+               pre_bt_slave = bt_link_info->slave_role;
+               return true;
+       }
+
+       return false;
+}
+
+void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist)
+{
+       static u32              bt_disable_cnt = 0;
+       boolean                 bt_active = true, bt_disabled = false;
+       u16                     u16tmp;
+
+       /* This function check if bt is disabled */
+#if 0
+       if (coex_sta->high_priority_tx == 0 &&
+           coex_sta->high_priority_rx == 0 &&
+           coex_sta->low_priority_tx == 0 &&
+           coex_sta->low_priority_rx == 0)
+               bt_active = false;
+       if (coex_sta->high_priority_tx == 0xffff &&
+           coex_sta->high_priority_rx == 0xffff &&
+           coex_sta->low_priority_tx == 0xffff &&
+           coex_sta->low_priority_rx == 0xffff)
+               bt_active = false;
+
+
+#else
+
+       /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */
+       halbtc8723d2ant_read_score_board(btcoexist,     &u16tmp);
+
+       bt_active = u16tmp & BIT(1);
+
+
+#endif
+
+       if (bt_active) {
+               bt_disable_cnt = 0;
+               bt_disabled = false;
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE,
+                                  &bt_disabled);
+       } else {
+
+               bt_disable_cnt++;
+               if (bt_disable_cnt >= 2) {
+                       bt_disabled = true;
+                       bt_disable_cnt = 2;
+               }
+
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE,
+                                  &bt_disabled);
+       }
+
+       if (bt_disabled)
+               halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false);
+       else
+               halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true);
+
+       if (coex_sta->bt_disabled != bt_disabled) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], BT is from %s to %s!!\n",
+                           (coex_sta->bt_disabled ? "disabled" : "enabled"),
+                           (bt_disabled ? "disabled" : "enabled"));
+               BTC_TRACE(trace_buf);
+               coex_sta->bt_disabled = bt_disabled;
+       }
+
+}
+
+
+
+void halbtc8723d2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist,
+                                       boolean isenable)
+{
+#if BT_8723D_2ANT_COEX_DBG
+       if (isenable) {
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1);
+
+               /* enable GNT_BT to GPIO debug */
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0);
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0);
+
+               /* 0x48[20] = 0  for GPIO14 =  GNT_WL*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0);
+               /* 0x40[17] = 0  for GPIO14 =  GNT_WL*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0);
+
+               /* 0x66[9] = 0   for GPIO15 =  GNT_BT*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0);
+               /* 0x66[7] = 0
+               for GPIO15 =  GNT_BT*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0);
+               /* 0x8[8] = 0    for GPIO15 =  GNT_BT*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0);
+
+               /* BT Vendor Reg 0x76[0] = 0  for GPIO15 =  GNT_BT, this is not set here*/
+       } else {
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0);
+
+               /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1);
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1);
+
+               /* 0x48[20] = 0  for GPIO14 =  GNT_WL*/
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1);
+       }
+
+#endif
+}
+
+u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist,
+               IN u16 reg_addr)
+{
+       u32 j = 0, delay_count = 0;
+
+
+       /* wait for ready bit before access 0x7c0                */
+       btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr);
+
+       while (1) {
+               if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) {
+                       delay_ms(50);
+                       delay_count++;
+                       if (delay_count >= 10) {
+                               delay_count = 0;
+                               break;
+                       }
+               } else
+                       break;
+       }
+
+       return btcoexist->btc_read_4byte(btcoexist,
+                                        0x7c8);  /* get read data */
+
+}
+
+void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist
+               *btcoexist,
+               IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value)
+{
+       u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0;
+
+
+       if (bit_mask == 0x0)
+               return;
+       if (bit_mask == 0xffffffff) {
+               btcoexist->btc_write_4byte(btcoexist, 0x7c4,
+                                          reg_value); /* put write data */
+
+               /* wait for ready bit before access 0x7c0 */
+               while (1) {
+               if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) {
+                       delay_ms(50);
+                       delay_count++;
+                       if (delay_count >= 10) {
+                               delay_count = 0;
+                               break;
+                       }
+               } else
+                       break;
+       }
+
+               btcoexist->btc_write_4byte(btcoexist, 0x7c0,
+                                          0xc00F0000 | reg_addr);
+       } else {
+               for (i = 0; i <= 31; i++) {
+                       if (((bit_mask >> i) & 0x1) == 0x1) {
+                               bitpos = i;
+                               break;
+                       }
+               }
+
+               /* read back register value before write */
+               val = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               reg_addr);
+               val = (val & (~bit_mask)) | (reg_value << bitpos);
+
+               btcoexist->btc_write_4byte(btcoexist, 0x7c4,
+                                          val); /* put write data */
+
+               /* wait for ready bit before access 0x7c0                */
+               while (1) {
+               if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) {
+                       delay_ms(50);
+                       delay_count++;
+                       if (delay_count >= 10) {
+                               delay_count = 0;
+                               break;
+                       }
+               } else
+                       break;
+       }
+
+               btcoexist->btc_write_4byte(btcoexist, 0x7c0,
+                                          0xc00F0000 | reg_addr);
+
+       }
+
+}
+
+void halbtc8723d2ant_ltecoex_enable(IN struct btc_coexist *btcoexist,
+                                   IN boolean enable)
+{
+       u8 val;
+
+       val = (enable) ? 1 : 0;
+       halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80,
+                       val);  /* 0x38[7] */
+
+}
+
+void halbtc8723d2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist,
+               IN boolean wifi_control)
+{
+       u8 val;
+
+       val = (wifi_control) ? 1 : 0;
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4,
+                                          val); /* 0x70[26] */
+
+}
+
+void halbtc8723d2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist,
+                       IN u8 control_block, IN boolean sw_control, IN u8 state)
+{
+       u32 val = 0, val_orig = 0;
+
+       if (!sw_control)
+               val = 0x0;
+       else if (state & 0x1)
+               val = 0x3;
+       else
+               val = 0x1;
+
+       val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0x38);
+
+       switch (control_block) {
+       case BT_8723D_2ANT_GNT_BLOCK_RFC_BB:
+       default:
+               val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff);
+               break;
+       case BT_8723D_2ANT_GNT_BLOCK_RFC:
+               val = (val << 14) | (val_orig & 0xffff3fff);
+               break;
+       case BT_8723D_2ANT_GNT_BLOCK_BB:
+               val = (val << 10) | (val_orig & 0xfffff3ff);
+               break;
+       }
+
+       halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
+                               0x38, 0xffffffff, val);
+}
+
+
+void halbtc8723d2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist,
+                       IN u8 control_block, IN boolean sw_control, IN u8 state)
+{
+       u32 val = 0, val_orig = 0;
+
+       if (!sw_control)
+               val = 0x0;
+       else if (state & 0x1)
+               val = 0x3;
+       else
+               val = 0x1;
+
+       val_orig = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0x38);
+
+       switch (control_block) {
+       case BT_8723D_2ANT_GNT_BLOCK_RFC_BB:
+       default:
+               val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff);
+               break;
+       case BT_8723D_2ANT_GNT_BLOCK_RFC:
+               val = (val << 12) | (val_orig & 0xffffcfff);
+               break;
+       case BT_8723D_2ANT_GNT_BLOCK_BB:
+               val = (val << 8) | (val_orig & 0xfffffcff);
+               break;
+       }
+
+       halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
+                               0x38, 0xffffffff, val);
+}
+
+void halbtc8723d2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist,
+               IN u8 table_type, IN u16 table_content)
+{
+       u16 reg_addr = 0x0000;
+
+       switch (table_type) {
+       case BT_8723D_2ANT_CTT_WL_VS_LTE:
+               reg_addr = 0xa0;
+               break;
+       case BT_8723D_2ANT_CTT_BT_VS_LTE:
+               reg_addr = 0xa4;
+               break;
+       }
+
+       if (reg_addr != 0x0000)
+               halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr,
+                       0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */
+
+
+}
+
+
+void halbtc8723d2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist,
+               IN u8 table_type, IN u8 table_content)
+{
+       u16 reg_addr = 0x0000;
+
+       switch (table_type) {
+       case BT_8723D_2ANT_LBTT_WL_BREAK_LTE:
+               reg_addr = 0xa8;
+               break;
+       case BT_8723D_2ANT_LBTT_BT_BREAK_LTE:
+               reg_addr = 0xac;
+               break;
+       case BT_8723D_2ANT_LBTT_LTE_BREAK_WL:
+               reg_addr = 0xb0;
+               break;
+       case BT_8723D_2ANT_LBTT_LTE_BREAK_BT:
+               reg_addr = 0xb4;
+               break;
+       }
+
+       if (reg_addr != 0x0000)
+               halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr,
+                       0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */
+
+
+}
+
+void halbtc8723d2ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist,
+               IN boolean force_exec,  IN u8 interval,
+               IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2,
+               IN u8 val0x6c4_b3)
+{
+       static u8 pre_h2c_parameter[6] = {0};
+       u8      cur_h2c_parameter[6] = {0};
+       u8 i, match_cnt = 0;
+
+       cur_h2c_parameter[0] = 0x7;     /* op_code, 0x7= wlan toggle slot*/
+
+       cur_h2c_parameter[1] = interval;
+       cur_h2c_parameter[2] = val0x6c4_b0;
+       cur_h2c_parameter[3] = val0x6c4_b1;
+       cur_h2c_parameter[4] = val0x6c4_b2;
+       cur_h2c_parameter[5] = val0x6c4_b3;
+
+       if (!force_exec) {
+               for (i = 1; i <= 5; i++) {
+                       if (cur_h2c_parameter[i] != pre_h2c_parameter[i])
+                               break;
+
+                       match_cnt++;
+               }
+
+               if (match_cnt == 5)
+                       return;
+       }
+
+       for (i = 1; i <= 5; i++)
+               pre_h2c_parameter[i] = cur_h2c_parameter[i];
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter);
+}
+
+void halbtc8723d2ant_set_coex_table(IN struct btc_coexist *btcoexist,
+           IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc)
+{
+       btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0);
+
+       btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4);
+
+       btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8);
+
+       btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc);
+}
+
+void halbtc8723d2ant_coex_table(IN struct btc_coexist *btcoexist,
+                       IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4,
+                               IN u32 val0x6c8, IN u8 val0x6cc)
+{
+       coex_dm->cur_val0x6c0 = val0x6c0;
+       coex_dm->cur_val0x6c4 = val0x6c4;
+       coex_dm->cur_val0x6c8 = val0x6c8;
+       coex_dm->cur_val0x6cc = val0x6cc;
+
+       if (!force_exec) {
+               if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) &&
+                   (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) &&
+                   (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) &&
+                   (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc))
+                       return;
+       }
+       halbtc8723d2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8,
+                                      val0x6cc);
+
+       coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0;
+       coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4;
+       coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8;
+       coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc;
+}
+
+void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist,
+               IN boolean force_exec, IN u8 type)
+{
+       u32     break_table;
+       u8      select_table;
+
+       coex_sta->coex_table_type = type;
+
+       if (coex_sta->concurrent_rx_mode_on == true) {
+               break_table = 0xf0ffffff;  /* set WL hi-pri can break BT */
+               select_table =
+                       0xb;            /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */
+       } else {
+               break_table = 0xffffff;
+               select_table = 0x3;
+       }
+
+               switch (type) {
+               case 0:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0xffffffff, 0xffffffff, break_table, select_table);
+                       break;
+               case 1:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0x55555555, 0x5a5a5a5a, break_table, select_table);
+                       break;
+               case 2:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table);
+                       break;
+               case 3:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0xaa555555, 0xaa5a5a5a, break_table, select_table);
+                       break;
+               case 4:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0x55555555, 0x5a5a5a5a, break_table, select_table);
+                       break;
+               case 5:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0x55555555, 0x55555555, break_table, select_table);
+                       break;
+               case 6:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0xa5555555, 0xfafafafa, break_table, select_table);
+                       break;
+               case 7:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0xa5555555, 0xaa5a5a5a, break_table, select_table);
+                       break;
+               case 8:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0xa5555555, 0xfafafafa, break_table, select_table);
+                       break;
+               case 9:
+                       halbtc8723d2ant_coex_table(btcoexist, force_exec,
+                                  0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table);
+                       break;
+               default:
+                       break;
+               }
+}
+
+void halbtc8723d2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist,
+               IN boolean enable)
+{
+       u8                      h2c_parameter[1] = {0};
+
+       if (enable) {
+               h2c_parameter[0] |= BIT(0);             /* function enable */
+       }
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter);
+}
+
+void halbtc8723d2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist,
+                                    IN boolean force_exec, IN boolean enable)
+{
+       coex_dm->cur_ignore_wlan_act = enable;
+
+       if (!force_exec) {
+               if (coex_dm->pre_ignore_wlan_act ==
+                   coex_dm->cur_ignore_wlan_act)
+                       return;
+       }
+       halbtc8723d2ant_set_fw_ignore_wlan_act(btcoexist, enable);
+
+       coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act;
+}
+
+void halbtc8723d2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist,
+                                 IN u8 lps_val, IN u8 rpwm_val)
+{
+       u8      lps = lps_val;
+       u8      rpwm = rpwm_val;
+
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps);
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm);
+}
+
+void halbtc8723d2ant_lps_rpwm(IN struct btc_coexist *btcoexist,
+                     IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val)
+{
+       coex_dm->cur_lps = lps_val;
+       coex_dm->cur_rpwm = rpwm_val;
+
+       if (!force_exec) {
+               if ((coex_dm->pre_lps == coex_dm->cur_lps) &&
+                   (coex_dm->pre_rpwm == coex_dm->cur_rpwm))
+                       return;
+       }
+       halbtc8723d2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val);
+
+       coex_dm->pre_lps = coex_dm->cur_lps;
+       coex_dm->pre_rpwm = coex_dm->cur_rpwm;
+}
+
+void halbtc8723d2ant_ps_tdma_check_for_power_save_state(
+       IN struct btc_coexist *btcoexist, IN boolean new_ps_state)
+{
+       u8      lps_mode = 0x0;
+       u8      h2c_parameter[5] = {0, 0, 0, 0x40, 0};
+
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode);
+
+       if (lps_mode) { /* already under LPS state */
+               if (new_ps_state) {
+                       /* keep state under LPS, do nothing. */
+               } else {
+                       /* will leave LPS state, turn off psTdma first */
+                       /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false,
+                                               8); */
+                       btcoexist->btc_fill_h2c(btcoexist, 0x60, 5,
+                                               h2c_parameter);
+               }
+       } else {                                        /* NO PS state */
+               if (new_ps_state) {
+                       /* will enter LPS state, turn off psTdma first */
+                       /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false,
+                                               8);*/
+                       btcoexist->btc_fill_h2c(btcoexist, 0x60, 5,
+                                               h2c_parameter);
+               } else {
+                       /* keep state under NO PS state, do nothing. */
+               }
+       }
+}
+
+void halbtc8723d2ant_power_save_state(IN struct btc_coexist *btcoexist,
+                             IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val)
+{
+       boolean         low_pwr_disable = false;
+
+       switch (ps_type) {
+       case BTC_PS_WIFI_NATIVE:
+               /* recover to original 32k low power setting */
+               low_pwr_disable = false;
+               btcoexist->btc_set(btcoexist,
+                                  BTC_SET_ACT_DISABLE_LOW_POWER,
+                                  &low_pwr_disable);
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS,
+                                  NULL);
+               coex_sta->force_lps_on = false;
+               break;
+       case BTC_PS_LPS_ON:
+               halbtc8723d2ant_ps_tdma_check_for_power_save_state(
+                       btcoexist, true);
+               halbtc8723d2ant_lps_rpwm(btcoexist, NORMAL_EXEC,
+                                        lps_val, rpwm_val);
+               /* when coex force to enter LPS, do not enter 32k low power. */
+               low_pwr_disable = true;
+               btcoexist->btc_set(btcoexist,
+                                  BTC_SET_ACT_DISABLE_LOW_POWER,
+                                  &low_pwr_disable);
+               /* power save must executed before psTdma.                       */
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS,
+                                  NULL);
+               coex_sta->force_lps_on = true;
+               break;
+       case BTC_PS_LPS_OFF:
+               halbtc8723d2ant_ps_tdma_check_for_power_save_state(
+                       btcoexist, false);
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS,
+                                  NULL);
+               coex_sta->force_lps_on = false;
+               break;
+       default:
+               break;
+       }
+}
+
+
+
+void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist,
+          IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5)
+{
+       u8                      h2c_parameter[5] = {0};
+       u8                      real_byte1 = byte1, real_byte5 = byte5;
+       boolean                 ap_enable = false;
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+       if (byte5 & BIT(2))
+               coex_sta->is_tdma_btautoslot = true;
+       else
+               coex_sta->is_tdma_btautoslot = false;
+
+       /* release bt-auto slot for auto-slot hang is detected!! */
+       if (coex_sta->is_tdma_btautoslot)
+               if ((coex_sta->is_tdma_btautoslot_hang) ||
+                       (bt_link_info->slave_role))
+                       byte5 = byte5 & 0xfb;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE,
+                          &ap_enable);
+
+       if (ap_enable) {
+               if (byte1 & BIT(4) && !(byte1 & BIT(5))) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], FW for AP mode\n");
+                       BTC_TRACE(trace_buf);
+                       real_byte1 &= ~BIT(4);
+                       real_byte1 |= BIT(5);
+
+                       real_byte5 |= BIT(5);
+                       real_byte5 &= ~BIT(6);
+
+                       halbtc8723d2ant_power_save_state(btcoexist,
+                                                BTC_PS_WIFI_NATIVE, 0x0,
+                                                        0x0);
+               }
+       } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) {
+
+               halbtc8723d2ant_power_save_state(
+                       btcoexist, BTC_PS_LPS_ON, 0x50,
+                       0x4);
+       } else {
+               halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,
+                                                0x0,
+                                                0x0);
+       }
+
+
+       h2c_parameter[0] = real_byte1;
+       h2c_parameter[1] = byte2;
+       h2c_parameter[2] = byte3;
+       h2c_parameter[3] = byte4;
+       h2c_parameter[4] = real_byte5;
+
+       coex_dm->ps_tdma_para[0] = real_byte1;
+       coex_dm->ps_tdma_para[1] = byte2;
+       coex_dm->ps_tdma_para[2] = byte3;
+       coex_dm->ps_tdma_para[3] = byte4;
+       coex_dm->ps_tdma_para[4] = real_byte5;
+
+       btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter);
+}
+
+void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist,
+                    IN boolean force_exec, IN boolean turn_on, IN u8 type)
+{
+
+       static u8                       psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0;
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+
+       coex_dm->cur_ps_tdma_on = turn_on;
+       coex_dm->cur_ps_tdma = type;
+
+       /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */
+       if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist))
+               psTdmaByte4Modify = 0x1;
+       else
+               psTdmaByte4Modify = 0x0;
+
+       if (pre_psTdmaByte4Modify != psTdmaByte4Modify) {
+
+               force_exec = true;
+               pre_psTdmaByte4Modify = psTdmaByte4Modify;
+       }
+
+       if (!force_exec) {
+               if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) &&
+                   (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma))
+                       return;
+       }
+
+       if (coex_dm->cur_ps_tdma_on) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], ********** TDMA(on, %d) **********\n",
+                           coex_dm->cur_ps_tdma);
+               BTC_TRACE(trace_buf);
+
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8,
+                                          0x1);  /* enable TBTT nterrupt */
+       } else {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], ********** TDMA(off, %d) **********\n",
+                           coex_dm->cur_ps_tdma);
+               BTC_TRACE(trace_buf);
+       }
+
+
+       if (turn_on) {
+               switch (type) {
+               case 1:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x03, 0x91,
+                                                               0x54 | psTdmaByte4Modify);
+                       break;
+               case 2:
+               default:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x35, 0x03, 0x11,
+                                                               0x11 | psTdmaByte4Modify);
+                       break;
+               case 3:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x3a, 0x3, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 4:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x21, 0x3, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 5:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x25, 0x3, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 6:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x3, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 7:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x20, 0x3, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 8:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x15, 0x03, 0x11,
+                                                               0x11);
+                       break;
+               case 10:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x30, 0x03, 0x11,
+                                                               0x10);
+                       break;
+               case 11:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x35, 0x03, 0x11,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 12:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x35, 0x03, 0x11, 0x11);
+                       break;
+               case 13:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x1c, 0x03, 0x11,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 14:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x20, 0x03, 0x11,
+                                                               0x11);
+                       break;
+               case 15:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x03, 0x11,
+                                                               0x14);
+                       break;
+               case 16:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x03, 0x11,
+                                                               0x15);
+                       break;
+               case 21:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x30, 0x03, 0x11,
+                                                               0x10);
+                       break;
+               case 22:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x25, 0x03, 0x11,
+                                                               0x10);
+                       break;
+               case 23:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x03, 0x11,
+                                                               0x10);
+                       break;
+               case 51:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x10, 0x03, 0x91,
+                                                               0x10 | psTdmaByte4Modify);
+                       break;
+               case 101:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x10, 0x03, 0x10,
+                                                               0x54 | psTdmaByte4Modify);
+                       break;
+               case 102:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61,
+                                                               0x35, 0x03, 0x11,
+                                                               0x11 | psTdmaByte4Modify);
+                       break;
+               case 103:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x3a, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 104:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x21, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 105:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x25, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 106:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x10, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 107:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x20, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 108:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x30, 0x3, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 109:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55,
+                                                               0x10, 0x03, 0x10,
+                                                               0x54 | psTdmaByte4Modify);
+                       break;
+               case 110:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55,
+                                                               0x30, 0x03, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               case 111:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x65,
+                                                               0x25, 0x03, 0x11,
+                                                               0x11 | psTdmaByte4Modify);
+                       break;
+               case 151:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51,
+                                                               0x10, 0x03, 0x10,
+                                                               0x50 | psTdmaByte4Modify);
+                       break;
+               }
+       } else {
+               /* disable PS tdma */
+               switch (type) {
+               case 0:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
+                                                     0x0, 0x0, 0x40, 0x0);
+                       break;
+               case 1:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
+                                                     0x0, 0x0, 0x48, 0x0);
+                       break;
+               default:
+                       halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
+                                                     0x0, 0x0, 0x40, 0x0);
+                       break;
+               }
+       }
+
+       /* update pre state */
+       coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on;
+       coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma;
+}
+
+void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist,
+                                 IN u8 ant_pos_type, IN boolean force_exec,
+                                 IN u8 phase)
+{
+       struct  btc_board_info *board_info = &btcoexist->board_info;
+       u32                     u32tmp = 0;
+       boolean                 pg_ext_switch = false,  is_hw_ant_div_on = false;
+       u8                      h2c_parameter[2] = {0};
+       u32                     cnt_bt_cal_chk = 0;
+       u8                      u8tmp0 = 0, u8tmp1 = 0;
+       boolean                 is_in_mp_mode = false;
+       u32                             u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0;
+       u16                             u16tmp0 = 0,  u16tmp1 = 0;
+
+
+       u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                       0x38);
+
+     /* To avoid indirect access fail   */
+       if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) {
+               force_exec = true;
+               coex_sta->gnt_error_cnt++;
+       }
+
+
+#if BT_8723D_2ANT_COEX_DBG
+       u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
+       u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa);
+       u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948);
+       u8tmp1  = btcoexist->btc_read_1byte(btcoexist, 0x73);
+       u8tmp0 =  btcoexist->btc_read_1byte(btcoexist, 0x67);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n",
+                   u8tmp0, u16tmp1, u8tmp1);
+       BTC_TRACE(trace_buf);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x (Before Set Ant Path)\n",
+                   u32tmp1, u32tmp2, u16tmp0);
+       BTC_TRACE(trace_buf);
+#endif
+
+       coex_dm->cur_ant_pos_type = ant_pos_type;
+
+       if (!force_exec) {
+               if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) {
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n");
+                       BTC_TRACE(trace_buf);
+                       return;
+               }
+       }
+
+       coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type;
+
+       switch (phase) {
+       case BT_8723D_2ANT_PHASE_COEX_POWERON:
+               /* Set Path control to WL */
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67,
+                                                  0x80, 0x0);
+
+               /* set Path control owner to WL at initial step */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist,
+                               BT_8723D_2ANT_PCO_BTSIDE);
+
+               /* set GNT_BT to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+               /* Set GNT_WL to SW low */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type)
+                       ant_pos_type = BTC_ANT_PATH_WIFI;
+
+               coex_sta->run_time_state = false;
+
+               break;
+       case BT_8723D_2ANT_PHASE_COEX_INIT:
+               /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
+
+               /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_set_coex_table(
+                       btcoexist,
+                       BT_8723D_2ANT_CTT_WL_VS_LTE,
+                       0xffff);
+
+               /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_set_coex_table(
+                       btcoexist,
+                       BT_8723D_2ANT_CTT_BT_VS_LTE,
+                       0xffff);
+
+               /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */
+               while (cnt_bt_cal_chk <= 20) {
+                       u8tmp0 = btcoexist->btc_read_1byte(
+                                        btcoexist,
+                                        0x49d);
+                       cnt_bt_cal_chk++;
+                       if (u8tmp0 & BIT(0)) {
+                               BTC_SPRINTF(
+                                       trace_buf,
+                                       BT_TMP_BUF_SIZE,
+                                       "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n",
+                                       cnt_bt_cal_chk);
+                               BTC_TRACE(
+                                       trace_buf);
+                               delay_ms(50);
+                       } else {
+                               BTC_SPRINTF(
+                                       trace_buf,
+                                       BT_TMP_BUF_SIZE,
+                                       "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n",
+                                       cnt_bt_cal_chk);
+                               BTC_TRACE(
+                                       trace_buf);
+                               break;
+                       }
+               }
+
+
+               /* Set Path control to WL */
+               btcoexist->btc_write_1byte_bitmask(btcoexist,
+                                                  0x67, 0x80, 0x1);
+
+               /* set Path control owner to WL at initial step */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(
+                       btcoexist,
+                       BT_8723D_2ANT_PCO_WLSIDE);
+
+               /* set GNT_BT to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+               /* Set GNT_WL to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               coex_sta->run_time_state = false;
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type) {
+                       if (board_info->btdm_ant_pos ==
+                           BTC_ANTENNA_AT_MAIN_PORT)
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_MAIN;
+                       else
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_AUX;
+               }
+
+               break;
+       case BT_8723D_2ANT_PHASE_WLANONLY_INIT:
+               /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
+
+               /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_set_coex_table(
+                       btcoexist,
+                       BT_8723D_2ANT_CTT_WL_VS_LTE,
+                       0xffff);
+
+               /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */
+               halbtc8723d2ant_ltecoex_set_coex_table(
+                       btcoexist,
+                       BT_8723D_2ANT_CTT_BT_VS_LTE,
+                       0xffff);
+
+               /* Set Path control to WL */
+               btcoexist->btc_write_1byte_bitmask(btcoexist,
+                                                  0x67, 0x80, 0x1);
+
+               /* set Path control owner to WL at initial step */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(
+                       btcoexist,
+                       BT_8723D_2ANT_PCO_WLSIDE);
+
+               /* set GNT_BT to SW Low */
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_LOW);
+               /* Set GNT_WL to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               coex_sta->run_time_state = false;
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type) {
+                       if (board_info->btdm_ant_pos ==
+                           BTC_ANTENNA_AT_MAIN_PORT)
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_MAIN;
+                       else
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_AUX;
+               }
+
+               break;
+       case BT_8723D_2ANT_PHASE_WLAN_OFF:
+               /* Disable LTE Coex Function in WiFi side */
+               halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
+
+               /* Set Path control to BT */
+               btcoexist->btc_write_1byte_bitmask(btcoexist,
+                                                  0x67, 0x80, 0x0);
+
+               /* set Path control owner to BT */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(
+                       btcoexist,
+                       BT_8723D_2ANT_PCO_BTSIDE);
+
+               coex_sta->run_time_state = false;
+               break;
+       case BT_8723D_2ANT_PHASE_2G_RUNTIME:
+
+               /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */
+               while (cnt_bt_cal_chk <= 20) {
+                       u8tmp0 = btcoexist->btc_read_1byte(
+                                        btcoexist,
+                                        0x1e6);
+
+                       u8tmp1 = btcoexist->btc_read_1byte(
+                                        btcoexist,
+                                        0x49d);
+
+                       cnt_bt_cal_chk++;
+                       if ((u8tmp0 & BIT(0)) ||
+                           (u8tmp1 & BIT(0))) {
+                               BTC_SPRINTF(trace_buf,
+                                           BT_TMP_BUF_SIZE,
+                                       "[BTCoex], ########### WL or BT is IQK (wait cnt=%d)\n",
+                                           cnt_bt_cal_chk);
+                               BTC_TRACE(trace_buf);
+                               delay_ms(50);
+                       } else {
+                               BTC_SPRINTF(trace_buf,
+                                           BT_TMP_BUF_SIZE,
+                                       "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n",
+                                           cnt_bt_cal_chk);
+                               BTC_TRACE(trace_buf);
+                               break;
+                       }
+               }
+
+               /* Set Path control to WL */
+               /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);*/
+
+               /* set Path control owner to WL at runtime step */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(
+                       btcoexist,
+                       BT_8723D_2ANT_PCO_WLSIDE);
+
+
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               /* Set GNT_WL to PTA */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA,
+                                          BT_8723D_2ANT_SIG_STA_SET_BY_HW);
+
+               coex_sta->run_time_state = true;
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type) {
+                       if (board_info->btdm_ant_pos ==
+                           BTC_ANTENNA_AT_MAIN_PORT)
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_MAIN;
+                       else
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_AUX;
+               }
+
+               break;
+       case BT_8723D_2ANT_PHASE_BTMPMODE:
+               /* Disable LTE Coex Function in WiFi side */
+               halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
+
+               /* Set Path control to WL */
+               btcoexist->btc_write_1byte_bitmask(btcoexist,
+                                                  0x67, 0x80, 0x1);
+
+               /* set Path control owner to WL */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(
+                       btcoexist,
+                       BT_8723D_2ANT_PCO_WLSIDE);
+
+               /* set GNT_BT to SW Hi */
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               /* Set GNT_WL to SW Lo */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_LOW);
+
+               coex_sta->run_time_state = false;
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type) {
+                       if (board_info->btdm_ant_pos ==
+                           BTC_ANTENNA_AT_MAIN_PORT)
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_MAIN;
+                       else
+                               ant_pos_type =
+                                       BTC_ANT_WIFI_AT_AUX;
+               }
+
+               break;
+       case BT_8723D_2ANT_PHASE_ANTENNA_DET:
+
+               /* Set Path control to WL */
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67,
+                                                  0x80, 0x1);
+
+               /* set Path control owner to WL */
+               halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist,
+                               BT_8723D_2ANT_PCO_WLSIDE);
+
+               /* Set Antenna Path,  both GNT_WL/GNT_BT = 1, and control by SW */
+               /* set GNT_BT to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               /* Set GNT_WL to SW high */
+               halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
+                                          BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
+                                          BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
+                                          BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
+
+               if (BTC_ANT_PATH_AUTO == ant_pos_type)
+                       ant_pos_type = BTC_ANT_WIFI_AT_AUX;
+
+               coex_sta->run_time_state = false;
+
+               break;
+       }
+
+       is_hw_ant_div_on = board_info->ant_div_cfg;
+
+       if ((is_hw_ant_div_on) && (phase != BT_8723D_2ANT_PHASE_ANTENNA_DET))
+               btcoexist->btc_write_2byte(btcoexist, 0x948, 0x140);
+       else if ((is_hw_ant_div_on == false) &&
+                (phase != BT_8723D_2ANT_PHASE_WLAN_OFF)) {
+
+               switch (ant_pos_type) {
+               case BTC_ANT_WIFI_AT_MAIN:
+
+                       btcoexist->btc_write_2byte(btcoexist,
+                                                  0x948, 0x0);
+                       break;
+               case BTC_ANT_WIFI_AT_AUX:
+
+                       btcoexist->btc_write_2byte(btcoexist,
+                                                  0x948, 0x280);
+                       break;
+               }
+       }
+
+
+#if BT_8723D_2ANT_COEX_DBG
+       u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
+       u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
+       u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa);
+       u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948);
+       u8tmp1  = btcoexist->btc_read_1byte(btcoexist, 0x73);
+       u8tmp0 =  btcoexist->btc_read_1byte(btcoexist, 0x67);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n",
+                   u8tmp0, u16tmp1, u8tmp1);
+       BTC_TRACE(trace_buf);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa= 0x%x (After Set Ant Path)\n",
+                   u32tmp1, u32tmp2, u16tmp0);
+       BTC_TRACE(trace_buf);
+#endif
+
+}
+
+u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;
+       boolean                         bt_hs_on = false;
+       u8                              algorithm = BT_8723D_2ANT_COEX_ALGO_UNDEFINED;
+       u8                              num_of_diff_profile = 0;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);
+
+       if (!bt_link_info->bt_link_exist) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], No BT link exists!!!\n");
+               BTC_TRACE(trace_buf);
+               return algorithm;
+       }
+
+       if (bt_link_info->sco_exist)
+               num_of_diff_profile++;
+       if (bt_link_info->hid_exist)
+               num_of_diff_profile++;
+       if (bt_link_info->pan_exist)
+               num_of_diff_profile++;
+       if (bt_link_info->a2dp_exist)
+               num_of_diff_profile++;
+
+       if (num_of_diff_profile == 0) {
+
+               if (bt_link_info->acl_busy) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], No-Profile busy\n");
+                       BTC_TRACE(trace_buf);
+                       algorithm = BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY;
+               }
+       } else if (num_of_diff_profile == 1) {
+               if (bt_link_info->sco_exist) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "[BTCoex], SCO only\n");
+                       BTC_TRACE(trace_buf);
+                       algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
+               } else {
+                       if (bt_link_info->hid_exist) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "[BTCoex], HID only\n");
+                               BTC_TRACE(trace_buf);
+                               algorithm = BT_8723D_2ANT_COEX_ALGO_HID;
+                       } else if (bt_link_info->a2dp_exist) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "[BTCoex], A2DP only\n");
+                               BTC_TRACE(trace_buf);
+                               algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP;
+                       } else if (bt_link_info->pan_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                                   "[BTCoex], PAN(HS) only\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANHS;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], PAN(EDR) only\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR;
+                               }
+                       }
+               }
+       } else if (num_of_diff_profile == 2) {
+               if (bt_link_info->sco_exist) {
+                       if (bt_link_info->hid_exist) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "[BTCoex], SCO + HID\n");
+                               BTC_TRACE(trace_buf);
+                               algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
+                       } else if (bt_link_info->a2dp_exist) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "[BTCoex], SCO + A2DP ==> A2DP\n");
+                               BTC_TRACE(trace_buf);
+                               algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP;
+                       } else if (bt_link_info->pan_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + PAN(EDR)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR;
+                               }
+                       }
+               } else {
+                       if (bt_link_info->hid_exist &&
+                           bt_link_info->a2dp_exist) {
+                               {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                                   "[BTCoex], HID + A2DP\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_HID_A2DP;
+                               }
+                       } else if (bt_link_info->hid_exist &&
+                                  bt_link_info->pan_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], HID + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm = BT_8723D_2ANT_COEX_ALGO_HID;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], HID + PAN(EDR)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
+                               }
+                       } else if (bt_link_info->pan_exist &&
+                                  bt_link_info->a2dp_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], A2DP + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], A2DP + PAN(EDR)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP;
+                               }
+                       }
+               }
+       } else if (num_of_diff_profile == 3) {
+               if (bt_link_info->sco_exist) {
+                       if (bt_link_info->hid_exist &&
+                           bt_link_info->a2dp_exist) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n");
+                               BTC_TRACE(trace_buf);
+                               algorithm = BT_8723D_2ANT_COEX_ALGO_HID_A2DP;
+                       } else if (bt_link_info->hid_exist &&
+                                  bt_link_info->pan_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + HID + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + HID + PAN(EDR)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
+                               }
+                       } else if (bt_link_info->pan_exist &&
+                                  bt_link_info->a2dp_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + A2DP + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP;
+                               }
+                       }
+               } else {
+                       if (bt_link_info->hid_exist &&
+                           bt_link_info->pan_exist &&
+                           bt_link_info->a2dp_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], HID + A2DP + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], HID + A2DP + PAN(EDR)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
+                               }
+                       }
+               }
+       } else if (num_of_diff_profile >= 3) {
+               if (bt_link_info->sco_exist) {
+                       if (bt_link_info->hid_exist &&
+                           bt_link_info->pan_exist &&
+                           bt_link_info->a2dp_exist) {
+                               if (bt_hs_on) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
+                               } else {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n");
+                                       BTC_TRACE(trace_buf);
+                                       algorithm =
+                                               BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
+                               }
+                       }
+               }
+       }
+
+       return algorithm;
+}
+
+
+
+void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist)
+{
+
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+       /* fw all off */
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+}
+
+void halbtc8723d2ant_action_bt_whql_test(IN struct btc_coexist *btcoexist)
+{
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+}
+
+void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false, wifi_turbo = false;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                          &coex_sta->scan_ap_num);
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  scan_ap_num = %d, wl_noisy = %d\n",
+                       coex_sta->scan_ap_num, coex_sta->wl_noisy_level);
+       BTC_TRACE(trace_buf);
+
+#if 1
+       if ((wifi_busy) && (coex_sta->wl_noisy_level == 0))
+               wifi_turbo = true;
+#endif
+
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+
+
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       }
+
+}
+
+
+void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist)
+{
+
+       boolean wifi_connected = false;
+       boolean wifi_scan = false, wifi_link = false, wifi_roam = false;
+       boolean wifi_busy = false;
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
+                          &wifi_connected);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam);
+
+       if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam)
+               || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                        8);
+
+               if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist))
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               15);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               11);
+       }  else if ((!wifi_connected) && (!wifi_scan)) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (bt_link_info->pan_exist) {
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+
+       } else if (bt_link_info->a2dp_exist) {
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+       } else {
+
+               if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy)
+                       || (coex_sta->wifi_is_high_pri_task))
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+       }
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+}
+
+
+void halbtc8723d2ant_action_bt_relink(IN struct btc_coexist *btcoexist)
+{
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8);
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1);
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+       coex_sta->bt_relink_downcount = 2;
+}
+
+void halbtc8723d2ant_action_bt_idle(IN struct btc_coexist *btcoexist)
+{
+       boolean wifi_busy = false;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       if (!wifi_busy) {
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                    NORMAL_EXEC, 8);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14);
+       } else {  /* if wl busy */
+
+               if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE ==
+                       coex_dm->bt_status) {
+
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 0);
+
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+          } else {
+
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                       NORMAL_EXEC, 8);
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       12);
+               }
+       }
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+}
+
+
+
+/* SCO only or SCO+PAN(HS) */
+void halbtc8723d2ant_action_sco(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8      wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8      wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false;
+       u32  wifi_bw = 1;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW,
+                          &wifi_bw);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       }  else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               if (coex_sta->is_eSCO_mode)
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1);
+               else  /* 2-Ant free run if eSCO mode */
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8);
+       }
+
+}
+
+
+void halbtc8723d2ant_action_hid(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false;
+       u32  wifi_bw = 1;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW,  &wifi_bw);
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       }  else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               /*for 4/18 hid */
+               if (coex_sta->hid_busy_num >= 2) {
+                       if (wifi_bw == 0) {   /* if 11bg mode */
+
+                                halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 8);
+                                halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x1, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                                halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       111);
+                       } else {
+
+                         if (wifi_busy) {
+                                         halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                        NORMAL_EXEC, 8);
+                                         halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                                        NORMAL_EXEC,
+                                                                        0x2, 0xaa,
+                                                                        0x5a, 0xaa,
+                                                                        0xaa);
+                                         halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                                        111);
+                               } else {
+
+                                         halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                3);
+                                         halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14);
+                               }
+                       }
+               } else {
+
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                3);
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14);
+               }
+       }
+
+}
+
+
+/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */
+void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false, wifi_turbo = false;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                          &coex_sta->scan_ap_num);
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  scan_ap_num = %d, wl_noisy = %d\n",
+                       coex_sta->scan_ap_num, coex_sta->wl_noisy_level);
+       BTC_TRACE(trace_buf);
+
+#if 1
+       if ((wifi_busy) && (coex_sta->wl_noisy_level == 0))
+               wifi_turbo = true;
+#endif
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy)
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 1);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               16);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if ((coex_sta->bt_relink_downcount != 0)
+                       && (wifi_busy)) {
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "############# [BTCoex],  BT Re-Link + A2DP + WL busy\n");
+                       BTC_TRACE(trace_buf);
+
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5);
+
+               } else {
+
+                       if (wifi_turbo)
+                               halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                        NORMAL_EXEC, 6);
+                       else
+                               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                        7);
+
+                       if (wifi_busy)
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                               true, 101);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       16);
+                               /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       102);*/
+               }
+
+       }
+
+}
+
+
+void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false, wifi_turbo = false;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                          &coex_sta->scan_ap_num);
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  scan_ap_num = %d, wl_noisy = %d\n",
+                       coex_sta->scan_ap_num, coex_sta->wl_noisy_level);
+       BTC_TRACE(trace_buf);
+
+#if 1
+       if ((wifi_busy) && (coex_sta->wl_noisy_level == 0))
+               wifi_turbo = true;
+#endif
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+#if 0
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+       coex_dm->is_switch_to_1dot5_ant = false;
+
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+#endif
+
+
+#if 1
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy)
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               3);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               4);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if (wifi_turbo)
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 6);
+               else
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                7);
+
+               if (wifi_busy)
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               103);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               104);
+
+       }
+
+#endif
+
+}
+
+void halbtc8723d2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false;
+       u32 wifi_bw = 1;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW,
+                          &wifi_bw);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy)
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 1);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               16);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if ((coex_sta->bt_relink_downcount != 0)
+                       && (wifi_busy)) {
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "############# [BTCoex],  BT Re-Link + A2DP + WL busy\n");
+                       BTC_TRACE(trace_buf);
+
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5);
+               } else if (wifi_busy) {
+                       if (coex_sta->hid_busy_num >= 2) {
+                               halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 8);
+                               if (wifi_bw == 0)  /*11bg mode */
+                                       halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x1, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                               else
+                                       halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x2, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       109);
+                       } else {
+                               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1);
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 101);
+                       }
+               } else {
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                1);
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               16);
+               }
+
+       }
+
+}
+
+
+void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false, wifi_turbo = false;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                          &coex_sta->scan_ap_num);
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  scan_ap_num = %d, wl_noisy = %d\n",
+                       coex_sta->scan_ap_num, coex_sta->wl_noisy_level);
+       BTC_TRACE(trace_buf);
+
+#if 1
+       if ((wifi_busy) && (coex_sta->wl_noisy_level == 0))
+               wifi_turbo = true;
+#endif
+
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy) {
+
+                       if ((coex_sta->a2dp_bit_pool > 40) &&
+                               (coex_sta->a2dp_bit_pool < 255))
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 7);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 5);
+               } else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               6);
+
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if (wifi_turbo)
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 6);
+               else
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                7);
+
+               if (wifi_busy) {
+
+                       if ((coex_sta->a2dp_bit_pool > 40) &&
+                               (coex_sta->a2dp_bit_pool < 255))
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 107);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 105);
+               } else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               106);
+
+       }
+
+}
+
+
+/* PAN(EDR)+A2DP */
+void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false, wifi_turbo = false;
+
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                          &coex_sta->scan_ap_num);
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  scan_ap_num = %d, wl_noisy = %d\n",
+                       coex_sta->scan_ap_num, coex_sta->wl_noisy_level);
+       BTC_TRACE(trace_buf);
+
+#if 1
+       if ((wifi_busy) && (coex_sta->wl_noisy_level == 0))
+               wifi_turbo = true;
+#endif
+
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy) {
+
+                       if (((coex_sta->a2dp_bit_pool > 40) &&
+                                (coex_sta->a2dp_bit_pool < 255)) ||
+                               (!coex_sta->is_A2DP_3M))
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 7);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 5);
+               } else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               6);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if (wifi_turbo)
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                                NORMAL_EXEC, 6);
+               else
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
+                                                                7);
+
+               if (wifi_busy) {
+
+                       if ((coex_sta->a2dp_bit_pool > 40) &&
+                               (coex_sta->a2dp_bit_pool < 255))
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 107);
+                       else if (wifi_turbo)
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 108);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 105);
+               } else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               106);
+
+       }
+
+}
+
+
+void halbtc8723d2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8              wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8      wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false;
+       u32 wifi_bw = 1;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW,
+                          &wifi_bw);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy)
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               3);
+               else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               4);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if (coex_sta->hid_busy_num >= 2) {
+
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                        NORMAL_EXEC, 8);
+                       if (wifi_bw == 0)  /*11bg mode */
+                               halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x1, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                       else
+                               halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x2, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               110);
+               } else {
+
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1);
+
+                       if (wifi_busy)
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       103);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       104);
+               }
+
+       }
+
+}
+
+
+/* HID+A2DP+PAN(EDR) */
+void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist)
+{
+       static u8       prewifi_rssi_state = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state = BTC_RSSI_STATE_LOW;
+       u8      wifi_rssi_state, bt_rssi_state;
+
+       static u8       prewifi_rssi_state2 = BTC_RSSI_STATE_LOW;
+       static u8       pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW;
+       u8      wifi_rssi_state2, bt_rssi_state2;
+       boolean wifi_busy = false;
+       u32 wifi_bw = 1;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW,
+                          &wifi_bw);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+       wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                         &prewifi_rssi_state, 2,
+                         coex_sta->wifi_coex_thres , 0);
+
+       wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
+                          &prewifi_rssi_state2, 2,
+                          coex_sta->wifi_coex_thres2 , 0);
+
+       bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
+                       coex_sta->bt_coex_thres , 0);
+
+       bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
+                        coex_sta->bt_coex_thres2 , 0);
+
+
+       if (BTC_RSSI_HIGH(wifi_rssi_state) &&
+               BTC_RSSI_HIGH(bt_rssi_state)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+       } else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
+                  BTC_RSSI_HIGH(bt_rssi_state2)) {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
+
+               coex_dm->is_switch_to_1dot5_ant = false;
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
+
+               if (wifi_busy) {
+
+                       if (((coex_sta->a2dp_bit_pool > 40) &&
+                                (coex_sta->a2dp_bit_pool < 255)) ||
+                               (!coex_sta->is_A2DP_3M))
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 7);
+                       else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                       true, 5);
+               } else
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               6);
+       } else {
+
+               halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+               halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+               coex_dm->is_switch_to_1dot5_ant = true;
+
+               if (coex_sta->hid_busy_num >= 2) {
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                        NORMAL_EXEC, 8);
+                       if (wifi_bw == 0)  /*11bg mode */
+                               halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x1, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                       else
+                               halbtc8723d2ant_set_wltoggle_coex_table(btcoexist,
+                                                               NORMAL_EXEC,
+                                                               0x2, 0xaa,
+                                                               0x5a, 0xaa,
+                                                               0xaa);
+                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                               110);
+               } else {
+                       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1);
+
+                       if (wifi_busy) {
+
+                               if ((coex_sta->a2dp_bit_pool > 40) &&
+                                       (coex_sta->a2dp_bit_pool < 255))
+                                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                               true, 107);
+                               else
+                                       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC,
+                                                               true, 105);
+                       } else
+                               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true,
+                                                       106);
+               }
+       }
+
+}
+
+
+void halbtc8723d2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist)
+{
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+       /* hw all off */
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+}
+
+void halbtc8723d2ant_action_wifi_linkscan_process(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+
+       if (bt_link_info->pan_exist) {
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+
+       } else if (bt_link_info->a2dp_exist) {
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+       } else {
+
+               halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21);
+
+               halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8);
+       }
+
+}
+
+void halbtc8723d2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist)
+{
+       halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
+
+       /* fw all off */
+       halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+}
+
+void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist)
+{
+       switch (coex_dm->cur_algorithm) {
+
+       case BT_8723D_2ANT_COEX_ALGO_SCO:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = SCO.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_sco(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_HID:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = HID.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_hid(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_A2DP:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = A2DP.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_a2dp(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_a2dp_pan_hs(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_PANEDR:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_pan_edr(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_pan_edr_a2dp(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_PANEDR_HID:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_pan_edr_hid(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_hid_a2dp_pan_edr(
+                       btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_HID_A2DP:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_hid_a2dp(btcoexist);
+               break;
+       case BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_bt_idle(btcoexist);
+               break;
+       default:
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_coex_all_off(btcoexist);
+               break;
+               }
+
+        coex_dm->pre_algorithm = coex_dm->cur_algorithm;
+
+}
+
+
+void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist)
+{
+       u8      algorithm = 0;
+       u32     num_of_wifi_link = 0;
+       u32     wifi_link_status = 0;
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
+       boolean miracast_plus_bt = false;
+       boolean scan = false, link = false, roam = false,
+                       under_4way = false,
+                       wifi_connected = false, wifi_under_5g = false,
+                       bt_hs_on = false;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,
+                          &under_4way);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], RunCoexistMechanism()===>\n");
+       BTC_TRACE(trace_buf);
+
+       if (btcoexist->manual_control) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       if (btcoexist->stop_coex_dm) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       if (coex_sta->under_ips) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], wifi is under IPS !!!\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       if (!coex_sta->run_time_state) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], return for run_time_state = false !!!\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       if (coex_sta->freeze_coexrun_by_btinfo) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       if (coex_sta->bt_whck_test) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], BT is under WHCK TEST!!!\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_bt_whql_test(btcoexist);
+               return;
+       }
+
+       if (coex_sta->bt_disabled) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                "[BTCoex], BT is disabled!!!\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_coex_all_off(btcoexist);
+               return;
+       }
+
+       if (coex_sta->c2h_bt_inquiry_page) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], BT is under inquiry/page scan !!\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_bt_inquiry(btcoexist);
+               return;
+       }
+
+       if (coex_sta->is_setupLink) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                "[BTCoex], BT is re-link !!!\n");
+               halbtc8723d2ant_action_bt_relink(btcoexist);
+               return;
+       }
+
+       /* for P2P */
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,
+                          &wifi_link_status);
+       num_of_wifi_link = wifi_link_status >> 16;
+
+       if ((num_of_wifi_link >= 2) ||
+               (wifi_link_status & WIFI_P2P_GO_CONNECTED)) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "############# [BTCoex],  Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n",
+                               num_of_wifi_link, wifi_link_status);
+               BTC_TRACE(trace_buf);
+
+               if (bt_link_info->bt_link_exist)
+                       miracast_plus_bt = true;
+               else
+                       miracast_plus_bt = false;
+
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,
+                                  &miracast_plus_bt);
+
+               if (scan || link || roam || under_4way) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n",
+                                   scan, link, roam, under_4way);
+                       BTC_TRACE(trace_buf);
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], wifi is under linkscan process + Multi-Port !!\n");
+                       BTC_TRACE(trace_buf);
+
+                       halbtc8723d2ant_action_wifi_linkscan_process(btcoexist);
+               } else
+
+                       halbtc8723d2ant_action_wifi_multi_port(btcoexist);
+
+               return;
+       } else {
+               miracast_plus_bt = false;
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,
+                                  &miracast_plus_bt);
+       }
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);
+
+       if (bt_hs_on) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "############# [BTCoex],  BT Is hs\n");
+                       BTC_TRACE(trace_buf);
+                       halbtc8723d2ant_action_bt_hs(btcoexist);
+                       return;
+       }
+
+       if ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE ==
+                       coex_dm->bt_status) ||
+                  (BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE ==
+                       coex_dm->bt_status)) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], Action 2-Ant, bt idle!!.\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_action_bt_idle(btcoexist);
+               return;
+       }
+
+       algorithm = halbtc8723d2ant_action_algorithm(btcoexist);
+       coex_dm->cur_algorithm = algorithm;
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n",
+                       coex_dm->cur_algorithm);
+       BTC_TRACE(trace_buf);
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
+                          &wifi_connected);
+
+       if (scan || link || roam || under_4way) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], WiFi is under Link Process !!\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_wifi_linkscan_process(btcoexist);
+       } else if (wifi_connected) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], Action 2-Ant, wifi connected!!.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_wifi_connected(btcoexist);
+
+       } else {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], Action 2-Ant, wifi not-connected!!.\n");
+               BTC_TRACE(trace_buf);
+               halbtc8723d2ant_action_wifi_not_connected(btcoexist);
+       }
+}
+
+
+void halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist)
+{
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "[BTCoex], Coex Mechanism Init!!\n");
+       BTC_TRACE(trace_buf);
+
+       halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
+       halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
+
+       /* sw all off */
+       halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false);
+
+       coex_sta->pop_event_cnt = 0;
+       coex_sta->cnt_RemoteNameReq = 0;
+       coex_sta->cnt_ReInit = 0;
+       coex_sta->cnt_setupLink = 0;
+       coex_sta->cnt_IgnWlanAct = 0;
+       coex_sta->cnt_Page = 0;
+
+       halbtc8723d2ant_query_bt_info(btcoexist);
+}
+
+
+void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist,
+                                   IN boolean wifi_only)
+{
+       u8      u8tmp0 = 0, u8tmp1 = 0;
+       u32     vendor;
+       u32     u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0;
+       u16 u16tmp1 = 0;
+       u8 i = 0;
+
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "[BTCoex], 2Ant Init HW Config!!\n");
+       BTC_TRACE(trace_buf);
+
+#if BT_8723D_2ANT_COEX_DBG
+       u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                       0x38);
+       u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                       0x54);
+       u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948);
+       u8tmp1  = btcoexist->btc_read_1byte(btcoexist, 0x73);
+       u8tmp0 =  btcoexist->btc_read_1byte(btcoexist, 0x67);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n",
+                   u8tmp0, u16tmp1, u8tmp1);
+       BTC_TRACE(trace_buf);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n",
+                   u32tmp1, u32tmp2);
+       BTC_TRACE(trace_buf);
+#endif
+
+
+       coex_sta->bt_coex_supported_feature = 0;
+       coex_sta->bt_coex_supported_version = 0;
+       coex_sta->bt_ble_scan_type = 0;
+       coex_sta->bt_ble_scan_para[0] = 0;
+       coex_sta->bt_ble_scan_para[1] = 0;
+       coex_sta->bt_ble_scan_para[2] = 0;
+       coex_sta->bt_reg_vendor_ac = 0xffff;
+       coex_sta->bt_reg_vendor_ae = 0xffff;
+       coex_sta->gnt_error_cnt = 0;
+       coex_sta->bt_relink_downcount = 0;
+
+       for (i = 0; i <= 9; i++)
+               coex_sta->bt_afh_map[i] = 0;
+
+#if 0
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor);
+       if (vendor == BTC_VENDOR_LENOVO)
+               coex_dm->switch_thres_offset = 0;
+       else
+               coex_dm->switch_thres_offset = 20;
+#endif
+       /* 0xf0[15:12] --> Chip Cut information */
+       coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist,
+                                0xf1) & 0xf0) >> 4;
+
+       coex_sta->dis_ver_info_cnt = 0;
+
+       /* default isolation = 15dB */
+       coex_sta->isolation_btween_wb = BT_8723D_2ANT_DEFAULT_ISOLATION;
+       halbtc8723d2ant_coex_switch_threshold(btcoexist,
+                                             coex_sta->isolation_btween_wb);
+
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8,
+                                          0x1);  /* enable TBTT nterrupt */
+
+       /* BT report packet sample rate  */
+       btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5);
+
+       /* Init 0x778 = 0x1 for 2-Ant */
+       btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1);
+
+       /* Enable PTA (3-wire function form BT side) */
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1);
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1);
+
+       /* Enable PTA (tx/rx signal form WiFi side) */
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1);
+
+       halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true);
+
+#if 0
+       /* check if WL firmware download ok */
+       if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ONOFF, true);
+#endif
+
+       /* Enable counter statistics */
+       btcoexist->btc_write_1byte(btcoexist, 0x76e,
+                          0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */
+
+       /* WLAN_Tx by GNT_WL  0x950[29] = 0 */
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0);
+
+       halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0);
+
+       halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0);
+
+       psd_scan->ant_det_is_ant_det_available = true;
+
+       if (wifi_only) {
+               coex_sta->concurrent_rx_mode_on = false;
+               /* Path config   */
+               /* Set Antenna Path */
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_WLANONLY_INIT);
+
+               btcoexist->stop_coex_dm = true;
+       } else {
+               /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1);
+
+               coex_sta->concurrent_rx_mode_on = true;
+               /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */
+
+               /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0);
+
+               /* Path config   */
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_COEX_INIT);
+
+               btcoexist->stop_coex_dm = false;
+       }
+
+
+}
+
+u32 halbtc8723d2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val)
+{
+       u8      j;
+       u32     tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0;
+       u32     result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200,
+                                  174, 151, 132, 115, 100, 86, 74, 62, 51, 42,
+                                                          32, 23, 15, 7, 0
+                                                             };
+
+       if (val == 0)
+               return 0;
+
+       tmp = val;
+
+       while (1) {
+               if (tmp == 1)
+                       break;
+               else {
+                       tmp = (tmp >> 1);
+                       shiftcount++;
+               }
+       }
+
+
+       val_integerd_b = shiftcount + 1;
+
+       tmp2 = 1;
+       for (j = 1; j <= val_integerd_b; j++)
+               tmp2 = tmp2 * 2;
+
+       tmp = (val * 100) / tmp2;
+       tindex = tmp / 5;
+
+       if (tindex > 20)
+               tindex = 20;
+
+       val_fractiond_b = table_fraction[tindex];
+
+       result = val_integerd_b * 100 - val_fractiond_b;
+
+       return result;
+
+
+}
+
+void halbtc8723d2ant_psd_show_antenna_detect_result(IN struct btc_coexist
+               *btcoexist)
+{
+       u8              *cli_buf = btcoexist->cli_buf;
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n============[Antenna Detection info]  ============\n");
+       CL_PRINTF(cli_buf);
+
+       if (psd_scan->ant_det_result == 12) { /* Get Ant Det from BT  */
+
+               if (board_info->btdm_ant_num_by_ant_det == 1)
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                  "\r\n %-35s = %s (%d~%d)",
+                                  "Ant Det Result", "1-Antenna",
+                                  BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT,
+                               BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION);
+               else {
+
+                       if (psd_scan->ant_det_psd_scan_peak_val >
+                           (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)
+                           * 100)
+                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                          "\r\n %-35s = %s (>%d)",
+                                       "Ant Det Result", "2-Antenna (Bad-Isolation)",
+                                       BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
+                       else
+                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                          "\r\n %-35s = %s (%d~%d)",
+                                       "Ant Det Result", "2-Antenna (Good-Isolation)",
+                                       BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
+                                          + psd_scan->ant_det_thres_offset,
+                                       BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
+               }
+
+       } else if (psd_scan->ant_det_result == 1)
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)",
+                          "Ant Det Result", "2-Antenna (Bad-Isolation)",
+                          BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
+       else if (psd_scan->ant_det_result == 2)
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",
+                          "Ant Det Result", "2-Antenna (Good-Isolation)",
+                          BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
+                          + psd_scan->ant_det_thres_offset,
+                          BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
+       else
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",
+                          "Ant Det Result", "1-Antenna",
+                          BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT,
+                          BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
+                          + psd_scan->ant_det_thres_offset);
+
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ",
+                  "Antenna Detection Finish",
+                  (board_info->btdm_ant_det_finish
+                   ? "Yes" : "No"));
+       CL_PRINTF(cli_buf);
+
+       switch (psd_scan->ant_det_result) {
+       case 0:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is not available)");
+               break;
+       case 1:  /* 2-Ant bad-isolation */
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is available)");
+               break;
+       case 2:  /* 2-Ant good-isolation */
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is available)");
+               break;
+       case 3:  /* 1-Ant */
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is available)");
+               break;
+       case 4:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(Uncertainty result)");
+               break;
+       case 5:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)");
+               break;
+       case 6:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(WiFi is Scanning)");
+               break;
+       case 7:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is not idle)");
+               break;
+       case 8:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(Abort by WiFi Scanning)");
+               break;
+       case 9:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(Antenna Init is not ready)");
+               break;
+       case 10:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is Inquiry or page)");
+               break;
+       case 11:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is Disabled)");
+       case 12:
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "(BT is available, result from BT");
+               break;
+       }
+       CL_PRINTF(cli_buf);
+
+       if (psd_scan->ant_det_result == 12) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB",
+                          "PSD Scan Peak Value",
+                          psd_scan->ant_det_psd_scan_peak_val / 100);
+               CL_PRINTF(cli_buf);
+               return;
+       }
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
+                  "Ant Detect Total Count", psd_scan->ant_det_try_count);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
+                  "Ant Detect Fail Count", psd_scan->ant_det_fail_count);
+       CL_PRINTF(cli_buf);
+
+       if ((!board_info->btdm_ant_det_finish) &&
+           (psd_scan->ant_det_result != 5))
+               return;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response",
+                  (psd_scan->ant_det_result ? "ok" : "fail"));
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time",
+                  psd_scan->ant_det_bt_tx_time);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch",
+                  psd_scan->ant_det_bt_le_channel);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d",
+                  "WiFi PSD Cent-Ch/Offset/Span",
+                  psd_scan->real_cent_freq, psd_scan->real_offset,
+                  psd_scan->real_span);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB",
+                  "PSD Pre-Scan Peak Value",
+                  psd_scan->ant_det_pre_psdscan_peak_val / 100);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)",
+                  "PSD Pre-Scan result",
+                  (psd_scan->ant_det_result != 5 ? "ok" : "fail"),
+                  BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
+                  + psd_scan->ant_det_thres_offset);
+       CL_PRINTF(cli_buf);
+
+       if (psd_scan->ant_det_result == 5)
+               return;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB",
+                  "PSD Scan Peak Value", psd_scan->ant_det_peak_val);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz",
+                  "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq);
+       CL_PRINTF(cli_buf);
+
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package",
+                  (board_info->tfbga_package) ?  "Yes" : "No");
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
+                  "PSD Threshold Offset", psd_scan->ant_det_thres_offset);
+       CL_PRINTF(cli_buf);
+
+}
+
+void halbtc8723d2ant_psd_showdata(IN struct btc_coexist *btcoexist)
+{
+       u8              *cli_buf = btcoexist->cli_buf;
+       u32             delta_freq_per_point;
+       u32             freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2;
+
+       if (psd_scan->ant_det_result == 12)
+               return;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n\n============[PSD info]  (%d)============\n",
+                  psd_scan->psd_gen_count);
+       CL_PRINTF(cli_buf);
+
+       if (psd_scan->psd_gen_count == 0) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n");
+               CL_PRINTF(cli_buf);
+               return;
+       }
+
+       if (psd_scan->psd_point == 0)
+               delta_freq_per_point = 0;
+       else
+               delta_freq_per_point = psd_scan->psd_band_width /
+                                      psd_scan->psd_point;
+
+       /* if (psd_scan->is_psd_show_max_only) */
+       if (0) {
+               psd_rep1 = psd_scan->psd_max_value / 100;
+               psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100;
+
+               freq = ((psd_scan->real_cent_freq - 20) * 1000000 +
+                       psd_scan->psd_max_value_point * delta_freq_per_point);
+               freq1 = freq / 1000000;
+               freq2 = freq / 1000 - freq1 * 1000;
+
+               if (freq2 < 100)
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                  "\r\n Freq = %d.0%d MHz",
+                                  freq1, freq2);
+               else
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                  "\r\n Freq = %d.%d MHz",
+                                  freq1, freq2);
+
+               if (psd_rep2 < 10)
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                  ", Value = %d.0%d dB, (%d)\n",
+                                  psd_rep1, psd_rep2, psd_scan->psd_max_value);
+               else
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                  ", Value = %d.%d dB, (%d)\n",
+                                  psd_rep1, psd_rep2, psd_scan->psd_max_value);
+
+               CL_PRINTF(cli_buf);
+       } else {
+               m = psd_scan->psd_start_point;
+               n = psd_scan->psd_start_point;
+               i = 1;
+               j = 1;
+
+               while (1) {
+                       do {
+                               freq = ((psd_scan->real_cent_freq - 20) *
+                                       1000000 + m *
+                                       delta_freq_per_point);
+                               freq1 = freq / 1000000;
+                               freq2 = freq / 1000 - freq1 * 1000;
+
+                               if (i == 1) {
+                                       if (freq2 == 0)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "\r\n Freq%6d.000",
+                                                          freq1);
+                                       else if (freq2 < 100)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "\r\n Freq%6d.0%2d",
+                                                          freq1,
+                                                          freq2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "\r\n Freq%6d.%3d",
+                                                          freq1,
+                                                          freq2);
+                               } else if ((i % 8 == 0) ||
+                                          (m == psd_scan->psd_stop_point)) {
+                                       if (freq2 == 0)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.000\n", freq1);
+                                       else if (freq2 < 100)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.0%2d\n", freq1,
+                                                          freq2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.%3d\n", freq1,
+                                                          freq2);
+                               } else {
+                                       if (freq2 == 0)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.000", freq1);
+                                       else if (freq2 < 100)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.0%2d", freq1,
+                                                          freq2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%6d.%3d", freq1,
+                                                          freq2);
+                               }
+
+                               i++;
+                               m++;
+                               CL_PRINTF(cli_buf);
+
+                       } while ((i <= 8) && (m <= psd_scan->psd_stop_point));
+
+
+                       do {
+                               psd_rep1 = psd_scan->psd_report_max_hold[n] /
+                                          100;
+                               psd_rep2 = psd_scan->psd_report_max_hold[n] -
+                                          psd_rep1 *
+                                          100;
+
+                               if (j == 1) {
+                                       if (psd_rep2 < 10)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "\r\n Val %7d.0%d",
+                                                          psd_rep1,
+                                                          psd_rep2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "\r\n Val %7d.%d",
+                                                          psd_rep1,
+                                                          psd_rep2);
+                               } else if ((j % 8 == 0)  ||
+                                          (n == psd_scan->psd_stop_point)) {
+                                       if (psd_rep2 < 10)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                       "%7d.0%d\n", psd_rep1,
+                                                          psd_rep2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%7d.%d\n", psd_rep1,
+                                                          psd_rep2);
+                               } else {
+                                       if (psd_rep2 < 10)
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%7d.0%d", psd_rep1,
+                                                          psd_rep2);
+                                       else
+                                               CL_SPRINTF(cli_buf,
+                                                          BT_TMP_BUF_SIZE,
+                                                          "%7d.%d", psd_rep1,
+                                                          psd_rep2);
+                               }
+
+                               j++;
+                               n++;
+                               CL_PRINTF(cli_buf);
+
+                       } while ((j <= 8) && (n <= psd_scan->psd_stop_point));
+
+                       if ((m > psd_scan->psd_stop_point) ||
+                           (n > psd_scan->psd_stop_point))
+                               break;
+                       else {
+                               i = 1;
+                               j = 1;
+                       }
+
+               }
+       }
+
+
+}
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+void halbtc8723d2ant_psd_maxholddata(IN struct btc_coexist *btcoexist,
+                                    IN u32 gen_count)
+{
+       u32 i = 0;
+       u32 loop_i_max = 0, loop_val_max = 0;
+
+       if (gen_count == 1) {
+               memcpy(psd_scan->psd_report_max_hold,
+                      psd_scan->psd_report,
+                      BT_8723D_2ANT_ANTDET_PSD_POINTS * sizeof(u32));
+       }
+
+       for (i = psd_scan->psd_start_point;
+            i <= psd_scan->psd_stop_point; i++) {
+
+               /* update max-hold value at each freq point */
+               if (psd_scan->psd_report[i] > psd_scan->psd_report_max_hold[i])
+                       psd_scan->psd_report_max_hold[i] =
+                               psd_scan->psd_report[i];
+
+               /*      search the max value in this seep */
+               if (psd_scan->psd_report[i] > loop_val_max) {
+                       loop_val_max = psd_scan->psd_report[i];
+                       loop_i_max = i;
+               }
+       }
+
+       if (gen_count <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)
+               psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max;
+
+}
+
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+u32 halbtc8723d2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point)
+{
+       /* reg 0x808[9:0]: FFT data x */
+       /* reg 0x808[22]: 0-->1 to get 1 FFT data y */
+       /* reg 0x8b4[15:0]: FFT data y report */
+
+       u32 val = 0, psd_report = 0;
+       int k = 0;
+
+       val = btcoexist->btc_read_4byte(btcoexist, 0x808);
+
+       val &= 0xffbffc00;
+       val |= point;
+
+       btcoexist->btc_write_4byte(btcoexist, 0x808, val);
+
+       val |= 0x00400000;
+       btcoexist->btc_write_4byte(btcoexist, 0x808, val);
+
+       while (1) {
+               if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY)
+                       break;
+       }
+
+       val = btcoexist->btc_read_4byte(btcoexist, 0x8b4);
+
+       psd_report = val & 0x0000ffff;
+
+       return psd_report;
+}
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist,
+               IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points,
+                                       IN u32 avgnum, IN u32 loopcnt)
+{
+       u32      i = 0, val = 0, n = 0, k = 0, j, point_index = 0;
+       u32     points1 = 0, psd_report = 0;
+       u32     start_p = 0, stop_p = 0, delta_freq_per_point = 156250;
+       u32    psd_center_freq = 20 * 10 ^ 6;
+       boolean outloop = false, scan , roam, is_sweep_ok = true;
+       u8       flag = 0;
+       u32     tmp = 0, u32tmp1 = 0;
+       u32     wifi_original_channel = 1;
+       u32 psd_sum = 0, avg_cnt = 0;
+       u32     i_max = 0, val_max = 0, val_max2 = 0;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n");
+       BTC_TRACE(trace_buf);
+
+       do {
+               switch (flag) {
+               case 0:  /* Get PSD parameters */
+               default:
+
+                       psd_scan->psd_band_width = 40 * 1000000;
+                       psd_scan->psd_point = points;
+                       psd_scan->psd_start_base = points / 2;
+                       psd_scan->psd_avg_num = avgnum;
+                       psd_scan->real_cent_freq = cent_freq;
+                       psd_scan->real_offset = offset;
+                       psd_scan->real_span = span;
+
+
+                       points1 = psd_scan->psd_point;
+                       delta_freq_per_point = psd_scan->psd_band_width /
+                                              psd_scan->psd_point;
+
+                       /* PSD point setup */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x808);
+                       val &= 0xffff0fff;
+
+                       switch (psd_scan->psd_point) {
+                       case 128:
+                               val |= 0x0;
+                               break;
+                       case 256:
+                       default:
+                               val |= 0x00004000;
+                               break;
+                       case 512:
+                               val |= 0x00008000;
+                               break;
+                       case 1024:
+                               val |= 0x0000c000;
+                               break;
+                       }
+
+                       switch (psd_scan->psd_avg_num) {
+                       case 1:
+                               val |= 0x0;
+                               break;
+                       case 8:
+                               val |= 0x00001000;
+                               break;
+                       case 16:
+                               val |= 0x00002000;
+                               break;
+                       case 32:
+                       default:
+                               val |= 0x00003000;
+                               break;
+                       }
+                       btcoexist->btc_write_4byte(btcoexist, 0x808, val);
+
+                       flag = 1;
+                       break;
+               case 1:   /* calculate the PSD point index from freq/offset/span */
+                       psd_center_freq = psd_scan->psd_band_width / 2 +
+                                         offset * (1000000);
+
+                       start_p = psd_scan->psd_start_base + (psd_center_freq -
+                               span * (1000000) / 2) / delta_freq_per_point;
+                       psd_scan->psd_start_point = start_p -
+                                                   psd_scan->psd_start_base;
+
+                       stop_p = psd_scan->psd_start_base + (psd_center_freq +
+                               span * (1000000) / 2) / delta_freq_per_point;
+                       psd_scan->psd_stop_point = stop_p -
+                                                  psd_scan->psd_start_base - 1;
+
+                       flag = 2;
+                       break;
+               case 2:  /* set RF channel/BW/Mode */
+
+                       /* set 3-wire off */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x88c);
+                       val |= 0x00300000;
+                       btcoexist->btc_write_4byte(btcoexist, 0x88c, val);
+
+                       /* CCK off */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x800);
+                       val &= 0xfeffffff;
+                       btcoexist->btc_write_4byte(btcoexist, 0x800, val);
+
+                       /* Tx-pause on */
+                       btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f);
+
+                       /* store WiFi original channel */
+                       wifi_original_channel = btcoexist->btc_get_rf_reg(
+                                       btcoexist, BTC_RF_A, 0x18, 0x3ff);
+
+                       /* Set RF channel */
+                       if (cent_freq == 2484)
+                               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,
+                                                         0x18, 0x3ff, 0xe);
+                       else
+                               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,
+                                         0x18, 0x3ff, (cent_freq - 2412) / 5 +
+                                                 1); /* WiFi TRx Mask on */
+
+                       /* save original RCK value */
+                       u32tmp1 =  btcoexist->btc_get_rf_reg(
+                                          btcoexist, BTC_RF_A, 0x1d, 0xfffff);
+
+                       /* Enter debug mode */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde,
+                                                 0x2, 0x1);
+
+                       /* Set RF Rx filter corner */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d,
+                                                 0xfffff, 0x2e);
+
+
+                       /* Set  RF mode = Rx, RF Gain = 0x320a0 */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0,
+                                                 0xfffff, 0x320a0);
+
+                       while (1) {
+                               if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY)
+                                       break;
+                       }
+                       flag = 3;
+                       break;
+               case 3:
+                       psd_scan->psd_gen_count = 0;
+                       for (j = 1; j <= loopcnt; j++) {
+
+                               btcoexist->btc_get(btcoexist,
+                                                  BTC_GET_BL_WIFI_SCAN, &scan);
+                               btcoexist->btc_get(btcoexist,
+                                                  BTC_GET_BL_WIFI_ROAM, &roam);
+
+                               if (scan || roam) {
+                                       is_sweep_ok = false;
+                                       break;
+                               }
+                               memset(psd_scan->psd_report, 0,
+                                      psd_scan->psd_point * sizeof(u32));
+                               start_p = psd_scan->psd_start_point +
+                                         psd_scan->psd_start_base;
+                               stop_p = psd_scan->psd_stop_point +
+                                        psd_scan->psd_start_base + 1;
+
+                               i = start_p;
+                               point_index = 0;
+
+                               while (i < stop_p) {
+                                       if (i >= points1)
+                                               psd_report =
+                                                       halbtc8723d2ant_psd_getdata(
+                                                       btcoexist, i - points1);
+                                       else
+                                               psd_report =
+                                                       halbtc8723d2ant_psd_getdata(
+                                                               btcoexist, i);
+
+                                       if (psd_report == 0)
+                                               tmp = 0;
+                                       else
+                                               /* tmp =  20*log10((double)psd_report); */
+                                               /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */
+                                               tmp = 6 * halbtc8723d2ant_psd_log2base(
+                                                       btcoexist, psd_report);
+
+                                       n = i - psd_scan->psd_start_base;
+                                       psd_scan->psd_report[n] =  tmp;
+
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "Point=%d, psd_dB_data = %d\n",
+                                                   i, psd_scan->psd_report[n]);
+                                       BTC_TRACE(trace_buf);
+
+                                       i++;
+
+                               }
+
+                               halbtc8723d2ant_psd_maxholddata(btcoexist, j);
+
+                               psd_scan->psd_gen_count = j;
+
+                               /*Accumulate Max PSD value in this loop if the value > threshold */
+                               if (psd_scan->psd_loop_max_value[j - 1] >=
+                                   4000) {
+                                       psd_sum = psd_sum +
+                                               psd_scan->psd_loop_max_value[j -
+                                                                      1];
+                                       avg_cnt++;
+                               }
+
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "Loop=%d, Max_dB_data = %d\n",
+                                           j, psd_scan->psd_loop_max_value[j
+                                                           - 1]);
+                               BTC_TRACE(trace_buf);
+
+                       }
+
+                       if (loopcnt == BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) {
+
+                               /* search the Max Value between each-freq-point-max-hold value of all sweep*/
+                               for (i = 1;
+                                    i <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT;
+                                    i++) {
+
+                                       if (i == 1) {
+                                               i_max = i;
+                                               val_max = psd_scan->psd_loop_max_value[i
+                                                                      - 1];
+                                               val_max2 =
+                                                       psd_scan->psd_loop_max_value[i
+                                                                    - 1];
+                                       } else if (
+                                               psd_scan->psd_loop_max_value[i -
+                                                            1] > val_max) {
+                                               val_max2 = val_max;
+                                               i_max = i;
+                                               val_max = psd_scan->psd_loop_max_value[i
+                                                                      - 1];
+                                       } else if (
+                                               psd_scan->psd_loop_max_value[i -
+                                                            1] > val_max2)
+                                               val_max2 =
+                                                       psd_scan->psd_loop_max_value[i
+                                                                    - 1];
+
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n",
+                                               i, psd_scan->psd_loop_max_value[i
+                                                                   - 1],
+                                                   val_max, val_max2);
+
+                                       BTC_TRACE(trace_buf);
+                               }
+
+                               psd_scan->psd_max_value_point = i_max;
+                               psd_scan->psd_max_value = val_max;
+                               psd_scan->psd_max_value2 = val_max2;
+
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           "val_max = %d, val_max2 = %d\n",
+                                           psd_scan->psd_max_value,
+                                           psd_scan->psd_max_value2);
+                               BTC_TRACE(trace_buf);
+                       }
+
+                       if (avg_cnt != 0) {
+                               psd_scan->psd_avg_value = (psd_sum / avg_cnt);
+                               if ((psd_sum % avg_cnt) >= (avg_cnt / 2))
+                                       psd_scan->psd_avg_value++;
+                       } else
+                               psd_scan->psd_avg_value = 0;
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                   "AvgLoop=%d, Avg_dB_data = %d\n",
+                                   avg_cnt, psd_scan->psd_avg_value);
+                       BTC_TRACE(trace_buf);
+
+                       flag = 100;
+                       break;
+               case 99:        /* error */
+
+                       outloop = true;
+                       break;
+               case 100: /* recovery */
+
+                       /* set 3-wire on */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x88c);
+                       val &= 0xffcfffff;
+                       btcoexist->btc_write_4byte(btcoexist, 0x88c, val);
+
+                       /* CCK on */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x800);
+                       val |= 0x01000000;
+                       btcoexist->btc_write_4byte(btcoexist, 0x800, val);
+
+                       /* Tx-pause off */
+                       btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0);
+
+                       /* PSD off */
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x808);
+                       val &= 0xffbfffff;
+                       btcoexist->btc_write_4byte(btcoexist, 0x808, val);
+
+                       /* restore RF Rx filter corner */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d,
+                                                 0xfffff, u32tmp1);
+
+                       /* Exit debug mode */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde,
+                                                 0x2, 0x0);
+
+                       /* restore WiFi original channel */
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18,
+                                                 0x3ff, wifi_original_channel);
+
+                       outloop = true;
+                       break;
+
+               }
+
+       } while (!outloop);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n");
+       BTC_TRACE(trace_buf);
+       return is_sweep_ok;
+
+}
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist
+               *btcoexist)
+{
+       u32     i = 0;
+       u32     wlpsd_cent_freq = 2484, wlpsd_span = 2;
+       s32     wlpsd_offset = -4;
+       u32 bt_tx_time, bt_le_channel;
+       u8      bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33};
+
+       u8      h2c_parameter[3] = {0}, u8tmpa, u8tmpb;
+
+       u8      state = 0;
+       boolean         outloop = false, bt_resp = false, ant_det_finish = false;
+       u32             freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point,
+                       u32tmp, u32tmp0, u32tmp1, u32tmp2 ;
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+
+       memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8));
+       memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8));
+
+       psd_scan->ant_det_bt_tx_time =
+               BT_8723D_2ANT_ANTDET_BTTXTIME;     /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */
+       psd_scan->ant_det_bt_le_channel = BT_8723D_2ANT_ANTDET_BTTXCHANNEL;
+
+       bt_tx_time = psd_scan->ant_det_bt_tx_time;
+       bt_le_channel = psd_scan->ant_det_bt_le_channel;
+
+       if (board_info->tfbga_package) /* for TFBGA */
+               psd_scan->ant_det_thres_offset = 5;
+       else
+               psd_scan->ant_det_thres_offset = 0;
+
+       do {
+               switch (state) {
+               case 0:
+                       if (bt_le_channel == 39)
+                               wlpsd_cent_freq = 2484;
+                       else {
+                               for (i = 1; i <= 13; i++) {
+                                       if (bt_le_ch[i - 1] ==
+                                           bt_le_channel) {
+                                               wlpsd_cent_freq = 2412
+                                                                 + (i - 1) * 5;
+                                               break;
+                                       }
+                               }
+
+                               if (i == 14) {
+
+                                       BTC_SPRINTF(trace_buf,
+                                                   BT_TMP_BUF_SIZE,
+                                               "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ",
+                                                   bt_le_channel);
+                                       BTC_TRACE(trace_buf);
+                                       outloop = true;
+                                       break;
+                               }
+                       }
+#if 0
+                       wlpsd_sweep_count = bt_tx_time * 238 /
+                                           100; /* bt_tx_time/0.42                                                              */
+                       wlpsd_sweep_count = wlpsd_sweep_count / 5;
+
+                       if (wlpsd_sweep_count % 5 != 0)
+                               wlpsd_sweep_count = (wlpsd_sweep_count /
+                                                    5 + 1) * 5;
+#endif
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d,  BT_LECh = %d\n",
+                                   bt_tx_time, bt_le_channel);
+                       BTC_TRACE(trace_buf);
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d,  wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n",
+                                   wlpsd_cent_freq,
+                                   wlpsd_offset,
+                                   wlpsd_span,
+                                   BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT);
+                       BTC_TRACE(trace_buf);
+
+                       state = 1;
+                       break;
+               case 1: /* stop coex DM & set antenna path */
+                       /* Stop Coex DM */
+                       btcoexist->stop_coex_dm = true;
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n");
+                       BTC_TRACE(trace_buf);
+
+                       /* Set TDMA off,                                 */
+                       halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC,
+                                               false, 0);
+
+                       /* Set coex table */
+                       halbtc8723d2ant_coex_table_with_type(btcoexist,
+                                                            FORCE_EXEC, 0);
+
+                       if (board_info->btdm_ant_pos ==
+                           BTC_ANTENNA_AT_MAIN_PORT) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n");
+                               BTC_TRACE(trace_buf);
+                       } else {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n");
+                               BTC_TRACE(trace_buf);
+                       }
+
+                       /* Set Antenna path, switch WiFi to un-certain antenna port */
+                       /* Set Antenna Path,  both GNT_WL/GNT_BT = 1, and control by SW */
+                       halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT,
+                                                    FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_ANTENNA_DET);
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n");
+                       BTC_TRACE(trace_buf);
+
+                       /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */
+                       h2c_parameter[0] = 0x1;
+                       h2c_parameter[1] = 0xd;
+                       h2c_parameter[2] = 0x14;
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",
+                                   h2c_parameter[1],
+                                   h2c_parameter[2]);
+                       BTC_TRACE(trace_buf);
+
+                       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,
+                                               h2c_parameter);
+
+                       u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948);
+                       u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70);
+                       u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(
+                                         btcoexist, 0x38);
+                       u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(
+                                         btcoexist, 0x54);
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det)\n",
+                                   u32tmp, u32tmp0, u32tmp1, u32tmp2);
+                       BTC_TRACE(trace_buf);
+
+                       state = 2;
+                       break;
+               case 2: /* Pre-sweep background psd */
+                       if (!halbtc8723d2ant_psd_sweep_point(btcoexist,
+                                    wlpsd_cent_freq, wlpsd_offset, wlpsd_span,
+                                            BT_8723D_2ANT_ANTDET_PSD_POINTS,
+                                    BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) {
+                               ant_det_finish = false;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               psd_scan->ant_det_result = 8;
+                               state = 99;
+                               break;
+                       }
+
+                       psd_scan->ant_det_pre_psdscan_peak_val =
+                               psd_scan->psd_max_value;
+
+                       if (psd_scan->ant_det_pre_psdscan_peak_val >
+                           (BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
+                            + psd_scan->ant_det_thres_offset) * 100) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n",
+                                       psd_scan->ant_det_pre_psdscan_peak_val /
+                                           100,
+                                       BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
+                                           + psd_scan->ant_det_thres_offset);
+                               BTC_TRACE(trace_buf);
+                               ant_det_finish = false;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               psd_scan->ant_det_result = 5;
+                               state = 99;
+                       } else {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n",
+                                       psd_scan->ant_det_pre_psdscan_peak_val /
+                                           100,
+                                       BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
+                                           + psd_scan->ant_det_thres_offset);
+                               BTC_TRACE(trace_buf);
+                               state = 3;
+                       }
+                       break;
+               case 3:
+                       bt_resp = btcoexist->btc_set_bt_ant_detection(
+                                         btcoexist, (u8)(bt_tx_time & 0xff),
+                                         (u8)(bt_le_channel & 0xff));
+
+                       /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */
+                       delay_ms(20);
+
+                       if (!halbtc8723d2ant_psd_sweep_point(btcoexist,
+                                            wlpsd_cent_freq, wlpsd_offset,
+                                                            wlpsd_span,
+                                            BT_8723D_2ANT_ANTDET_PSD_POINTS,
+                                            BT_8723D_2ANT_ANTDET_PSD_AVGNUM,
+                                    BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)) {
+                               ant_det_finish = false;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               psd_scan->ant_det_result = 8;
+                               state = 99;
+                               break;
+                       }
+
+#if 1
+                       psd_scan->ant_det_psd_scan_peak_val =
+                               psd_scan->psd_max_value;
+#endif
+#if 0
+                       psd_scan->ant_det_psd_scan_peak_val =
+                               ((psd_scan->psd_max_value - psd_scan->psd_avg_value) <
+                                800) ?
+                               psd_scan->psd_max_value : ((
+                                               psd_scan->psd_max_value -
+                                       psd_scan->psd_max_value2 <= 300) ?
+                                                  psd_scan->psd_avg_value :
+                                                  psd_scan->psd_max_value2);
+#endif
+                       psd_scan->ant_det_psd_scan_peak_freq =
+                               psd_scan->psd_max_value_point;
+                       state = 4;
+                       break;
+               case 4:
+
+                       if (psd_scan->psd_point == 0)
+                               delta_freq_per_point = 0;
+                       else
+                               delta_freq_per_point =
+                                       psd_scan->psd_band_width /
+                                       psd_scan->psd_point;
+
+                       psd_rep1 = psd_scan->ant_det_psd_scan_peak_val / 100;
+                       psd_rep2 = psd_scan->ant_det_psd_scan_peak_val -
+                                  psd_rep1 *
+                                  100;
+
+                       freq = ((psd_scan->real_cent_freq - 20) *
+                               1000000 + psd_scan->psd_max_value_point
+                               * delta_freq_per_point);
+                       freq1 = freq / 1000000;
+                       freq2 = freq / 1000 - freq1 * 1000;
+
+                       if (freq2 < 100) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz",
+                                           freq1, freq2);
+                               BTC_TRACE(trace_buf);
+                               CL_SPRINTF(psd_scan->ant_det_peak_freq,
+                                          BT_8723D_2ANT_ANTDET_BUF_LEN,
+                                          "%d.0%d", freq1, freq2);
+                       } else {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz",
+                                           freq1, freq2);
+                               BTC_TRACE(trace_buf);
+                               CL_SPRINTF(psd_scan->ant_det_peak_freq,
+                                          BT_8723D_2ANT_ANTDET_BUF_LEN,
+                                          "%d.%d", freq1, freq2);
+                       }
+
+                       if (psd_rep2 < 10) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           ", Value = %d.0%d dB\n",
+                                           psd_rep1, psd_rep2);
+                               BTC_TRACE(trace_buf);
+                               CL_SPRINTF(psd_scan->ant_det_peak_val,
+                                          BT_8723D_2ANT_ANTDET_BUF_LEN,
+                                          "%d.0%d", psd_rep1, psd_rep2);
+                       } else {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                           ", Value = %d.%d dB\n",
+                                           psd_rep1, psd_rep2);
+                               BTC_TRACE(trace_buf);
+                               CL_SPRINTF(psd_scan->ant_det_peak_val,
+                                          BT_8723D_2ANT_ANTDET_BUF_LEN,
+                                          "%d.%d", psd_rep1, psd_rep2);
+                       }
+
+                       psd_scan->ant_det_is_btreply_available = true;
+
+                       if (bt_resp == false) {
+                               psd_scan->ant_det_is_btreply_available =
+                                       false;
+                               psd_scan->ant_det_result = 0;
+                               ant_det_finish = false;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n ");
+                               BTC_TRACE(trace_buf);
+                       } else if (psd_scan->ant_det_psd_scan_peak_val >
+                               (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)
+                                  * 100) {
+                               psd_scan->ant_det_result = 1;
+                               ant_det_finish = true;
+                               board_info->btdm_ant_num_by_ant_det = 2;
+                               coex_sta->isolation_btween_wb = (u8)(85 -
+                                       psd_scan->ant_det_psd_scan_peak_val /
+                                                            100) & 0xff;
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n");
+                               BTC_TRACE(trace_buf);
+                       } else if (psd_scan->ant_det_psd_scan_peak_val >
+                               (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
+                                   + psd_scan->ant_det_thres_offset) * 100) {
+                               psd_scan->ant_det_result = 2;
+                               ant_det_finish = true;
+                               board_info->btdm_ant_num_by_ant_det = 2;
+                               coex_sta->isolation_btween_wb = (u8)(85 -
+                                       psd_scan->ant_det_psd_scan_peak_val /
+                                                            100) & 0xff;
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n");
+                               BTC_TRACE(trace_buf);
+                       } else if (psd_scan->ant_det_psd_scan_peak_val >
+                                  (BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) *
+                                  100) {
+                               psd_scan->ant_det_result = 3;
+                               ant_det_finish = true;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               coex_sta->isolation_btween_wb = (u8)(85 -
+                                       psd_scan->ant_det_psd_scan_peak_val /
+                                                            100) & 0xff;
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n");
+                               BTC_TRACE(trace_buf);
+                       } else {
+                               psd_scan->ant_det_result = 4;
+                               ant_det_finish = false;
+                               board_info->btdm_ant_num_by_ant_det = 1;
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n");
+                               BTC_TRACE(trace_buf);
+                       }
+
+                       state = 99;
+                       break;
+               case 99:  /* restore setup */
+
+                       /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */
+                       h2c_parameter[0] = 0x0;
+                       h2c_parameter[1] = 0x0;
+                       h2c_parameter[2] = 0x0;
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",
+                                   h2c_parameter[1], h2c_parameter[2]);
+                       BTC_TRACE(trace_buf);
+
+                       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,
+                                               h2c_parameter);
+
+                       /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */
+                       /* Set Antenna path, switch WiFi to certain antenna port */
+                       halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO, FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!");
+                       BTC_TRACE(trace_buf);
+
+                       btcoexist->stop_coex_dm = false;
+
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!");
+                       BTC_TRACE(trace_buf);
+
+                       outloop = true;
+                       break;
+               }
+
+       } while (!outloop);
+
+       return ant_det_finish;
+
+}
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist
+               *btcoexist)
+{
+       static u32 ant_det_count = 0, ant_det_fail_count = 0;
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+
+       boolean scan, roam, ant_det_finish = false;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
+
+       ant_det_count++;
+
+       psd_scan->ant_det_try_count = ant_det_count;
+
+       if (scan || roam) {
+               ant_det_finish = false;
+               psd_scan->ant_det_result = 6;
+       } else if (coex_sta->bt_disabled) {
+               ant_det_finish = false;
+               psd_scan->ant_det_result = 11;
+       } else if (coex_sta->num_of_profile >= 1) {
+               ant_det_finish = false;
+               psd_scan->ant_det_result = 7;
+       } else if (
+               !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */
+               ant_det_finish = false;
+               psd_scan->ant_det_result = 9;
+       } else if (coex_sta->c2h_bt_inquiry_page) {
+               ant_det_finish = false;
+               psd_scan->ant_det_result = 10;
+       } else {
+
+               ant_det_finish = halbtc8723d2ant_psd_antenna_detection(
+                                        btcoexist);
+
+               delay_ms(psd_scan->ant_det_bt_tx_time);
+       }
+
+
+       if (!ant_det_finish)
+               ant_det_fail_count++;
+
+       psd_scan->ant_det_fail_count = ant_det_fail_count;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n",
+                   psd_scan->ant_det_result,
+                   psd_scan->ant_det_fail_count,
+                   ant_det_finish == true ? "Yes" : "No");
+       BTC_TRACE(trace_buf);
+
+       return ant_det_finish;
+
+}
+
+
+/* ************************************************************
+ * work around function start with wa_halbtc8723d2ant_
+ * ************************************************************
+ * ************************************************************
+ * extern function start with ex_halbtc8723d2ant_
+ * ************************************************************ */
+void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+       u8 u8tmp = 0x0;
+       u16 u16tmp = 0x0;
+       u32     value = 0;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "xxxxxxxxxxxxxxxx Execute 8723d 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n");
+       BTC_TRACE(trace_buf);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "Ant Det Finish = %s, Ant Det Number  = %d\n",
+                   (board_info->btdm_ant_det_finish ? "Yes" : "No"),
+                   board_info->btdm_ant_num_by_ant_det);
+       BTC_TRACE(trace_buf);
+
+
+       btcoexist->stop_coex_dm = true;
+       psd_scan->ant_det_is_ant_det_available = false;
+
+       /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */
+       u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2);
+       btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1));
+
+
+       /* Local setting bit define */
+       /*      BIT0: "0" for no antenna inverse; "1" for antenna inverse  */
+       /*      BIT1: "0" for internal switch; "1" for external switch */
+       /*      BIT2: "0" for one antenna; "1" for two antenna */
+       /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */
+
+       /* Set path control to WL */
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);
+       btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0);
+
+       /* Check efuse 0xc3[6] for Single Antenna Path */
+       if (board_info->single_ant_path == 0) {
+               /* set to S1 */
+               board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT;
+               u8tmp = 4;
+               value = 1;
+       } else if (board_info->single_ant_path == 1) {
+               /* set to S0 */
+               board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT;
+               u8tmp = 5;
+               value = 0;
+       }
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], ********** (Power On) single_ant_path  = %d, btdm_ant_pos = %d **********\n",
+                   board_info->single_ant_path , board_info->btdm_ant_pos);
+       BTC_TRACE(trace_buf);
+
+       /* Set Antenna Path to BT side */
+       halbtc8723d2ant_set_ant_path(btcoexist,
+                                    BTC_ANT_PATH_AUTO,
+                                    FORCE_EXEC,
+                                    BT_8723D_1ANT_PHASE_COEX_POWERON);
+
+       /* Write Single Antenna Position to Registry to tell BT for 872db. This line can be removed
+       since BT EFuse also add "single antenna position" in EFuse for 8723d*/
+       btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL,
+                          &value);
+
+       /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at  power on */
+       if (btcoexist->chip_interface == BTC_INTF_PCI)
+               btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp);
+       else if (btcoexist->chip_interface == BTC_INTF_USB)
+               btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp);
+       else if (btcoexist->chip_interface == BTC_INTF_SDIO)
+               btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp);
+
+       /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */
+       halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], **********  LTE coex Reg 0x38 (Power-On) = 0x%x**********\n",
+                   halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38));
+       BTC_TRACE(trace_buf);
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+               "[BTCoex], **********  MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n",
+                   btcoexist->btc_read_4byte(btcoexist, 0x70),
+                   btcoexist->btc_read_2byte(btcoexist, 0x948));
+       BTC_TRACE(trace_buf);
+}
+
+void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+       u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */
+
+       /* */
+       /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */
+       /* Local setting bit define */
+       /*      BIT0: "0" for no antenna inverse; "1" for antenna inverse  */
+       /*      BIT1: "0" for internal switch; "1" for external switch */
+       /*      BIT2: "0" for one antenna; "1" for two antenna */
+       /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */
+       if (btcoexist->chip_interface == BTC_INTF_USB) {
+               /* fixed at S0 for USB interface */
+               u8tmp |= 0x1;   /* antenna inverse */
+               btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp);
+       } else {
+               /* for PCIE and SDIO interface, we check efuse 0xc3[6] */
+               if (board_info->single_ant_path == 0) {
+               } else if (board_info->single_ant_path == 1) {
+                       /* set to S0 */
+                       u8tmp |= 0x1;   /* antenna inverse */
+               }
+
+               if (btcoexist->chip_interface == BTC_INTF_PCI)
+                       btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0,
+                                                            u8tmp);
+               else if (btcoexist->chip_interface == BTC_INTF_SDIO)
+                       btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60,
+                                                            u8tmp);
+       }
+}
+
+
+void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist,
+                                      IN boolean wifi_only)
+{
+       halbtc8723d2ant_init_hw_config(btcoexist, wifi_only);
+}
+
+void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist)
+{
+
+       halbtc8723d2ant_init_coex_dm(btcoexist);
+}
+
+void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_board_info          *board_info = &btcoexist->board_info;
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;
+       u8                              *cli_buf = btcoexist->cli_buf;
+       u8                              u8tmp[4], i, ps_tdma_case = 0;
+       u32                             u32tmp[4];
+       u16                             u16tmp[4];
+       u32                             fa_ofdm, fa_cck, cca_ofdm, cca_cck, bt_coex_ver = 0;
+       u32                             fw_ver = 0, bt_patch_ver = 0;
+       static u8                       pop_report_in_10s = 0, cnt = 0;
+       u32                     phyver = 0;
+       boolean                 lte_coex_on = false;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n ============[BT Coexist info]============");
+       CL_PRINTF(cli_buf);
+
+       if (btcoexist->manual_control) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                       "\r\n ============[Under Manual Control]============");
+               CL_PRINTF(cli_buf);
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n ==========================================");
+               CL_PRINTF(cli_buf);
+       }
+
+       if (!coex_sta->bt_disabled) {
+
+               if (coex_sta->bt_coex_supported_feature == 0)
+                       btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE,
+                                               &coex_sta->bt_coex_supported_feature);
+
+               if ((coex_sta->bt_coex_supported_version == 0) ||
+                        (coex_sta->bt_coex_supported_version == 0xffff))
+                       btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION,
+                                               &coex_sta->bt_coex_supported_version);
+
+               if (coex_sta->bt_reg_vendor_ac == 0xffff)
+                       coex_sta->bt_reg_vendor_ac = (u16)(
+                                               btcoexist->btc_get_bt_reg(btcoexist, 3,
+                                               0xac) & 0xffff);
+
+               if (coex_sta->bt_reg_vendor_ae == 0xffff)
+                       coex_sta->bt_reg_vendor_ae = (u16)(
+                                               btcoexist->btc_get_bt_reg(btcoexist, 3,
+                                               0xae) & 0xffff);
+
+               btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER,
+                                               &bt_patch_ver);
+               btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver;
+
+               if (coex_sta->num_of_profile > 0) {
+                       cnt++;
+
+                       if (cnt >= 3) {
+                               btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0,
+                                       &coex_sta->bt_afh_map[0]);
+                               cnt = 0;
+                       }
+               }
+       }
+
+       if (psd_scan->ant_det_try_count == 0) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s",
+                          "Ant PG Num/ Mech/ Pos",
+                          board_info->pg_ant_num, board_info->btdm_ant_num,
+                          (board_info->btdm_ant_pos == 1 ? "S1" : "S0"));
+               CL_PRINTF(cli_buf);
+       } else {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                       "\r\n %-35s = %d/ %d/ %s  (retry=%d/fail=%d/result=%d)",
+                          "Ant PG Num/ Mech(Ant_Det)/ Pos",
+                          board_info->pg_ant_num,
+                          board_info->btdm_ant_num_by_ant_det,
+                          (board_info->btdm_ant_pos == 1 ? "S1" : "S0"),
+                          psd_scan->ant_det_try_count,
+                          psd_scan->ant_det_fail_count,
+                          psd_scan->ant_det_result);
+               CL_PRINTF(cli_buf);
+
+               if (board_info->btdm_ant_det_finish) {
+
+                       if (psd_scan->ant_det_result != 12)
+                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                          "\r\n %-35s = %s",
+                                          "Ant Det PSD Value",
+                                          psd_scan->ant_det_peak_val);
+                       else
+                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                                          "\r\n %-35s = %d",
+                                          "Ant Det PSD Value",
+                                          psd_scan->ant_det_psd_scan_peak_val
+                                          / 100);
+                       CL_PRINTF(cli_buf);
+               }
+       }
+
+       if (board_info->ant_det_result_five_complete) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = %d/ %d",
+                          "AntDet(Registry) Num/PSD Value",
+                          board_info->btdm_ant_num_by_ant_det,
+                          (board_info->antdetval & 0x7f));
+               CL_PRINTF(cli_buf);
+       }
+
+
+       bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver;
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver);
+       phyver = btcoexist->btc_get_bt_phydm_version(btcoexist);
+
+       bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                               "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)",
+                               "CoexVer WL/  BT_Desired/ BT_Report",
+                               glcoex_ver_date_8723d_2ant, glcoex_ver_8723d_2ant,
+                               glcoex_ver_btdesired_8723d_2ant,
+                               bt_coex_ver,
+                               (bt_coex_ver == 0xff ? "Unknown" :
+                               (coex_sta->bt_disabled ? "BT-disable" :
+                               (bt_coex_ver >= glcoex_ver_btdesired_8723d_2ant ?
+                               "Match" : "Mis-Match"))));
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c",
+                  "W_FW/ B_FW/ Phy/ Kt",
+                  fw_ver, bt_patch_ver, phyver,
+                  coex_sta->cut_version + 65);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ",
+                  "Wifi channel informed to BT",
+                  coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1],
+                  coex_dm->wifi_chnl_info[2]);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ",
+                  "Isolation/WL_Thres/BT_Thres",
+                  coex_sta->isolation_btween_wb,
+                  coex_sta->wifi_coex_thres,
+                  coex_sta->bt_coex_thres);
+       CL_PRINTF(cli_buf);
+
+       /* wifi status */
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
+                  "============[Wifi Status]============");
+       CL_PRINTF(cli_buf);
+       btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
+                  "============[BT Status]============");
+       CL_PRINTF(cli_buf);
+
+       pop_report_in_10s++;
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ",
+                  "BT [status/ rssi/ retryCnt/ popCnt]",
+                  ((coex_sta->bt_disabled) ? ("disabled") :    ((
+                          coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page")
+                          : ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE ==
+                              coex_dm->bt_status) ? "non-connected idle" :
+               ((BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)
+                                      ? "connected-idle" : "busy")))),
+                  coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt,
+                  coex_sta->pop_event_cnt);
+       CL_PRINTF(cli_buf);
+
+       if (pop_report_in_10s >= 5) {
+               coex_sta->pop_event_cnt = 0;
+               pop_report_in_10s = 0;
+       }
+
+
+       if (coex_sta->num_of_profile != 0)
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = %s%s%s%s%s",
+                          "Profiles",
+                          ((bt_link_info->a2dp_exist) ? "A2DP," : ""),
+                          ((bt_link_info->sco_exist) ?  "SCO," : ""),
+                          ((bt_link_info->hid_exist) ?
+                           ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," :
+                            "HID(2/18),") : ""),
+                          ((bt_link_info->pan_exist) ?  "PAN," : ""),
+                          ((coex_sta->voice_over_HOGP) ? "Voice" : ""));
+       else
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = None",
+                          "Profiles");
+
+       CL_PRINTF(cli_buf);
+
+
+       if (bt_link_info->a2dp_exist) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s",
+                          "A2DP Rate/Bitpool/Auto_Slot",
+                          ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"),
+                          coex_sta->a2dp_bit_pool,
+                          ((coex_sta->is_autoslot) ? "On" : "Off")
+                         );
+               CL_PRINTF(cli_buf);
+       }
+
+       if (bt_link_info->hid_exist) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",
+                          "HID PairNum/Forbid_Slot",
+                          coex_sta->hid_pair_cnt,
+                          coex_sta->forbidden_slot
+                         );
+               CL_PRINTF(cli_buf);
+       }
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ 0x%x/ 0x%x",
+                       "Role/IgnWlanAct/Feature/BLEScan",
+                       ((bt_link_info->slave_role) ? "Slave" : "Master"),
+                       ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"),
+                       coex_sta->bt_coex_supported_feature,
+                       coex_sta->bt_ble_scan_type);
+       CL_PRINTF(cli_buf);
+
+       if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                       "\r\n %-35s = 0x%08x/ 0x%08x/ 0x%08x",
+                       "BLEScan Intv-Win TV/Init/Ble",
+                       (coex_sta->bt_ble_scan_type & 0x1 ?
+                       coex_sta->bt_ble_scan_para[0] : 0x0),
+                       (coex_sta->bt_ble_scan_type & 0x2 ?
+                       coex_sta->bt_ble_scan_para[1] : 0x0),
+                       (coex_sta->bt_ble_scan_type & 0x4 ?
+                       coex_sta->bt_ble_scan_para[2] : 0x0));
+
+               CL_PRINTF(cli_buf);
+       }
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d",
+                  "ReInit/ReLink/IgnWlact/Page/NameReq",
+                  coex_sta->cnt_ReInit,
+                  coex_sta->cnt_setupLink,
+                  coex_sta->cnt_IgnWlanAct,
+                  coex_sta->cnt_Page,
+                  coex_sta->cnt_RemoteNameReq
+                 );
+       CL_PRINTF(cli_buf);
+
+       halbtc8723d2ant_read_score_board(btcoexist,     &u16tmp[0]);
+
+       if ((coex_sta->bt_reg_vendor_ae == 0xffff) ||
+           (coex_sta->bt_reg_vendor_ac == 0xffff))
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x",
+                          "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]);
+       else
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = 0x%x/ 0x%x/ %04x",
+                          "0xae[4]/0xac[1:0]/Scoreboard",
+                          ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4),
+                          coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]);
+       CL_PRINTF(cli_buf);
+
+       if (coex_sta->num_of_profile > 0) {
+
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                       "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
+                       "AFH MAP",
+                       coex_sta->bt_afh_map[0],
+                       coex_sta->bt_afh_map[1],
+                       coex_sta->bt_afh_map[2],
+                       coex_sta->bt_afh_map[3],
+                       coex_sta->bt_afh_map[4],
+                       coex_sta->bt_afh_map[5],
+                       coex_sta->bt_afh_map[6],
+                       coex_sta->bt_afh_map[7],
+                       coex_sta->bt_afh_map[8],
+                       coex_sta->bt_afh_map[9]
+                          );
+               CL_PRINTF(cli_buf);
+       }
+
+       for (i = 0; i < BT_INFO_SRC_8723D_2ANT_MAX; i++) {
+               if (coex_sta->bt_info_c2h_cnt[i]) {
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                               "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x (%d)",
+                                  glbt_info_src_8723d_2ant[i],
+                                  coex_sta->bt_info_c2h[i][0],
+                                  coex_sta->bt_info_c2h[i][1],
+                                  coex_sta->bt_info_c2h[i][2],
+                                  coex_sta->bt_info_c2h[i][3],
+                                  coex_sta->bt_info_c2h[i][4],
+                                  coex_sta->bt_info_c2h[i][5],
+                                  coex_sta->bt_info_c2h[i][6],
+                                  coex_sta->bt_info_c2h_cnt[i]);
+                       CL_PRINTF(cli_buf);
+               }
+       }
+
+       /* Sw mechanism  */
+       if (btcoexist->manual_control)
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
+                       "============[mechanism] (before Manual)============");
+       else
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
+                          "============[Mechanism]============");
+
+       CL_PRINTF(cli_buf);
+
+
+       ps_tdma_case = coex_dm->cur_ps_tdma;
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s, %s)",
+                  "TDMA",
+                  coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1],
+                  coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3],
+                  coex_dm->ps_tdma_para[4], ps_tdma_case,
+                  (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off"),
+                  (coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant"));
+       CL_PRINTF(cli_buf);
+
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0);
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4);
+       u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8);
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x",
+                  "Table/0x6c0/0x6c4/0x6c8",
+                  coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]);
+       CL_PRINTF(cli_buf);
+
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778);
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc);
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = 0x%x/ 0x%x",
+                  "0x778/0x6cc",
+                  u8tmp[0], u32tmp[0]);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s",
+                  "AntDiv/ ForceLPS",
+                  ((board_info->ant_div_cfg) ? "On" : "Off"),
+                  ((coex_sta->force_lps_on) ? "On" : "Off"));
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",
+                  "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl,
+                  coex_dm->cur_bt_dec_pwr_lvl);
+       CL_PRINTF(cli_buf);
+
+       u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
+       lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ?  true : false;
+
+       if (lte_coex_on) {
+
+               u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xa0);
+               u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xa4);
+
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",
+                          "LTE Coex  Table W_L/B_L",
+                          u32tmp[0] & 0xffff, u32tmp[1] & 0xffff);
+               CL_PRINTF(cli_buf);
+
+               u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xa8);
+               u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xac);
+               u32tmp[2] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xb0);
+               u32tmp[3] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
+                               0xb4);
+
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",
+                          "LTE Break Table W_L/B_L/L_W/L_B",
+                          u32tmp[0] & 0xffff, u32tmp[1] & 0xffff,
+                          u32tmp[2] & 0xffff, u32tmp[3] & 0xffff);
+               CL_PRINTF(cli_buf);
+
+       }
+
+       /* Hw setting            */
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
+                  "============[Hw setting]============");
+       CL_PRINTF(cli_buf);
+       /*
+               u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430);
+               u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434);
+               u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a);
+               u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456);
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x",
+                          "0x430/0x434/0x42a/0x456",
+                          u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]);
+               CL_PRINTF(cli_buf);
+       */
+       u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
+       u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s",
+                  "LTE Coex/Path Owner",
+                  ((lte_coex_on) ? "On" : "Off") ,
+                  ((u8tmp[0] & BIT(2)) ? "WL" : "BT"));
+       CL_PRINTF(cli_buf);
+
+       if (lte_coex_on) {
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = %d/ %d/ %d/ %d",
+                          "LTE 3Wire/OPMode/UART/UARTMode",
+                          (int)((u32tmp[0] & BIT(6)) >> 6),
+                          (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4),
+                          (int)((u32tmp[0] & BIT(3)) >> 3),
+                          (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0))));
+               CL_PRINTF(cli_buf);
+
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",
+                          "LTE_Busy/UART_Busy",
+                       (int)((u32tmp[1] & BIT(1)) >> 1), (int)(u32tmp[1] & BIT(0)));
+               CL_PRINTF(cli_buf);
+       }
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                          "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d",
+                          "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg",
+                          ((u32tmp[0] & BIT(12)) ? "SW" : "HW"),
+                          ((u32tmp[0] & BIT(8)) ?      "SW" : "HW"),
+                          ((u32tmp[0] & BIT(14)) ? "SW" : "HW"),
+                          ((u32tmp[0] & BIT(10)) ?  "SW" : "HW"),
+                          ((u8tmp[0] & BIT(3)) ? "On" : "Off"),
+                          coex_sta->gnt_error_cnt);
+               CL_PRINTF(cli_buf);
+
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",
+                  "GNT_WL/GNT_BT",
+                  (int)((u32tmp[1] & BIT(2)) >> 2),
+                  (int)((u32tmp[1] & BIT(3)) >> 3));
+       CL_PRINTF(cli_buf);
+
+       u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948);
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",
+                  "0x948/0x67[7]",
+                  u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7));
+       CL_PRINTF(cli_buf);
+
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964);
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864);
+       u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7);
+       u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",
+                  "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]",
+                  (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))),
+                  (int)((u8tmp[2] & BIT(3)) >> 3),
+                  (int)((u8tmp[3] & BIT(7)) >> 7));
+       CL_PRINTF(cli_buf);
+
+
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6);
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40);
+       u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",
+                  "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)",
+                  (int)((u8tmp[0] & BIT(4)) >> 4),
+                  (int)((u8tmp[1] & BIT(5)) >> 5),
+                  (int)((u8tmp[2] & BIT(3)) >> 3));
+       CL_PRINTF(cli_buf);
+
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550);
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522);
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953);
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s",
+                  "0x550/0x522/4-RxAGC",
+                  u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off");
+       CL_PRINTF(cli_buf);
+
+       fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM);
+       fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK);
+       cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM);
+       cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
+                  "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",
+                  "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA",
+                  cca_cck, fa_cck, cca_ofdm, fa_ofdm);
+       CL_PRINTF(cli_buf);
+
+#if 1
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
+                  "CRC_OK CCK/11g/11n/11n-agg",
+                  coex_sta->crc_ok_cck, coex_sta->crc_ok_11g,
+                  coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
+                  "CRC_Err CCK/11g/11n/11n-agg",
+                  coex_sta->crc_err_cck, coex_sta->crc_err_11g,
+                  coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht);
+       CL_PRINTF(cli_buf);
+#endif
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d",
+                  "WlHiPri/ Locking/ Locked/ Noisy",
+                  (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"),
+                  (coex_sta->cck_lock ? "Yes" : "No"),
+                  (coex_sta->cck_ever_lock ? "Yes" : "No"),
+                  coex_sta->wl_noisy_level);
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s",
+                  "0x770(Hi-pri rx/tx)",
+                  coex_sta->high_priority_rx, coex_sta->high_priority_tx,
+                  (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : ""));
+       CL_PRINTF(cli_buf);
+
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s",
+                  "0x774(Lo-pri rx/tx)",
+                  coex_sta->low_priority_rx, coex_sta->low_priority_tx,
+                  (bt_link_info->slave_role ? "(Slave!!)" : (
+                  coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : "")));
+       CL_PRINTF(cli_buf);
+
+       btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS);
+}
+
+
+void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type)
+{
+       if (btcoexist->manual_control ||        btcoexist->stop_coex_dm)
+               return;
+
+       if (BTC_IPS_ENTER == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], IPS ENTER notify\n");
+               BTC_TRACE(trace_buf);
+               coex_sta->under_ips = true;
+               coex_sta->under_lps = false;
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                               BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                               BT_8723D_2ANT_SCOREBOARD_ONOFF |
+                               BT_8723D_2ANT_SCOREBOARD_SCAN |
+                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST,
+                               false);
+
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_WLAN_OFF);
+
+               halbtc8723d2ant_action_coex_all_off(btcoexist);
+       } else if (BTC_IPS_LEAVE == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], IPS LEAVE notify\n");
+               BTC_TRACE(trace_buf);
+               coex_sta->under_ips = false;
+#if 0
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                       BT_8723D_2ANT_SCOREBOARD_ONOFF, true);
+#endif
+               halbtc8723d2ant_init_hw_config(btcoexist, false);
+               halbtc8723d2ant_init_coex_dm(btcoexist);
+               halbtc8723d2ant_query_bt_info(btcoexist);
+       }
+}
+
+void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type)
+{
+       if (btcoexist->manual_control || btcoexist->stop_coex_dm)
+               return;
+
+       if (BTC_LPS_ENABLE == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], LPS ENABLE notify\n");
+               BTC_TRACE(trace_buf);
+               coex_sta->under_lps = true;
+               coex_sta->under_ips = false;
+
+               if (coex_sta->force_lps_on == true) { /* LPS No-32K */
+                       /* Write WL "Active" in Score-board for PS-TDMA */
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+
+               } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */
+                       /* Write WL "Non-Active" in Score-board for Native-PS */
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                BT_8723D_2ANT_SCOREBOARD_ACTIVE, false);
+               }
+
+
+       } else if (BTC_LPS_DISABLE == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], LPS DISABLE notify\n");
+               BTC_TRACE(trace_buf);
+               coex_sta->under_lps = false;
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+       }
+}
+
+void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist,
+                                   IN u8 type)
+{
+       u32     u32tmp;
+       u8      u8tmpa, u8tmpb;
+       boolean wifi_connected = false;
+
+
+       if (btcoexist->manual_control ||
+           btcoexist->stop_coex_dm)
+               return;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
+                          &wifi_connected);
+
+       /*  this can't be removed for RF off_on event, or BT would dis-connect */
+       halbtc8723d2ant_query_bt_info(btcoexist);
+
+       if (BTC_SCAN_START == type) {
+
+               if (!wifi_connected)
+                       coex_sta->wifi_is_high_pri_task = true;
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], SCAN START notify\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                       BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                                       BT_8723D_2ANT_SCOREBOARD_SCAN |
+                                       BT_8723D_2ANT_SCOREBOARD_ONOFF,
+                                       true);
+
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+
+       } else if (BTC_SCAN_FINISH == type) {
+
+               coex_sta->wifi_is_high_pri_task = false;
+
+               btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
+                                  &coex_sta->scan_ap_num);
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], SCAN FINISH notify  (Scan-AP = %d)\n",
+                           coex_sta->scan_ap_num);
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_SCAN, false);
+
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+       }
+
+}
+
+void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist,
+                                      IN u8 type)
+{
+       if (btcoexist->manual_control ||
+           btcoexist->stop_coex_dm)
+               return;
+
+       if (BTC_ASSOCIATE_START == type) {
+
+               coex_sta->wifi_is_high_pri_task = true;
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], CONNECT START notify\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                                        BT_8723D_2ANT_SCOREBOARD_SCAN |
+                                        BT_8723D_2ANT_SCOREBOARD_ONOFF,
+                                        true);
+
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+               /* To keep TDMA case during connect process,
+               to avoid changed by Btinfo and runcoexmechanism */
+               coex_sta->freeze_coexrun_by_btinfo = true;
+
+               coex_dm->arp_cnt = 0;
+
+       } else if (BTC_ASSOCIATE_FINISH == type) {
+
+               coex_sta->wifi_is_high_pri_task = false;
+               coex_sta->freeze_coexrun_by_btinfo = false;
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], CONNECT FINISH notify\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+       }
+}
+
+void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist,
+               IN u8 type)
+{
+       u8                      h2c_parameter[3] = {0};
+       u32                     wifi_bw;
+       u8                      wifi_central_chnl;
+       u8                      ap_num = 0;
+       boolean         wifi_under_b_mode = false;
+
+       if (btcoexist->manual_control ||
+           btcoexist->stop_coex_dm)
+               return;
+
+       if (BTC_MEDIA_CONNECT == type) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], MEDIA connect notify\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                                        BT_8723D_2ANT_SCOREBOARD_ONOFF,
+                                        true);
+
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,
+                                  &wifi_under_b_mode);
+
+               /* Set CCK Tx/Rx high Pri except 11b mode */
+               if (wifi_under_b_mode) {
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cd,
+                                                  0x00); /* CCK Tx */
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cf,
+                                                  0x00); /* CCK Rx */
+               } else {
+
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cd,
+                                                  0x00); /* CCK Tx */
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cf,
+                                                  0x10); /* CCK Rx */
+               }
+
+       } else {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], MEDIA disconnect notify\n");
+               BTC_TRACE(trace_buf);
+
+               btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */
+               btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                BT_8723D_2ANT_SCOREBOARD_ACTIVE, false);
+       }
+
+
+       halbtc8723d2ant_update_wifi_channel_info(btcoexist, type);
+}
+
+void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist,
+               IN u8 type)
+{
+       boolean under_4way = false;
+
+       if (btcoexist->manual_control ||
+           btcoexist->stop_coex_dm)
+               return;
+
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,
+                          &under_4way);
+
+       if (under_4way) {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], specific Packet ---- under_4way!!\n");
+               BTC_TRACE(trace_buf);
+
+               coex_sta->wifi_is_high_pri_task = true;
+               coex_sta->specific_pkt_period_cnt = 2;
+
+       } else if (BTC_PACKET_ARP == type) {
+
+               coex_dm->arp_cnt++;
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], specific Packet ARP notify -cnt = %d\n",
+                           coex_dm->arp_cnt);
+               BTC_TRACE(trace_buf);
+
+       } else {
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n",
+                           type);
+               BTC_TRACE(trace_buf);
+
+               coex_sta->wifi_is_high_pri_task = true;
+               coex_sta->specific_pkt_period_cnt = 2;
+       }
+
+       if (coex_sta->wifi_is_high_pri_task) {
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+       }
+
+}
+
+void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist,
+                                      IN u8 *tmp_buf, IN u8 length)
+{
+       u8                      i, rsp_source = 0;
+       boolean         wifi_connected = false;
+       boolean wifi_scan = false, wifi_link = false, wifi_roam = false,
+                   wifi_busy = false;
+       static boolean is_scoreboard_scan = false;
+
+       if (psd_scan->is_AntDet_running == true) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], bt_info_notify return for AntDet is running\n");
+               BTC_TRACE(trace_buf);
+               return;
+       }
+
+       rsp_source = tmp_buf[0] & 0xf;
+       if (rsp_source >= BT_INFO_SRC_8723D_2ANT_MAX)
+               rsp_source = BT_INFO_SRC_8723D_2ANT_WIFI_FW;
+       coex_sta->bt_info_c2h_cnt[rsp_source]++;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source,
+                   length);
+       BTC_TRACE(trace_buf);
+
+       for (i = 0; i < length; i++) {
+               coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i];
+
+               if (i == length - 1) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n",
+                                   tmp_buf[i]);
+                       BTC_TRACE(trace_buf);
+               } else {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ",
+                                   tmp_buf[i]);
+                       BTC_TRACE(trace_buf);
+               }
+       }
+
+       coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1];
+       coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4];
+       coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5];
+
+       if (BT_INFO_SRC_8723D_2ANT_WIFI_FW != rsp_source) {
+
+               /* if 0xff, it means BT is under WHCK test */
+               coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true :
+                                         false);
+
+               coex_sta->bt_create_connection = ((
+                       coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true :
+                                                 false);
+
+               /* unit: %, value-100 to translate to unit: dBm */
+               coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 +
+                                   10;
+
+               coex_sta->c2h_bt_remote_name_req = ((
+                       coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true :
+                                                   false);
+
+               coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] &
+                                        0x10) ? true : false);
+
+               coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] &
+                                      0x9) ? true : false);
+
+               coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ?
+                                            true : false);
+
+               coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info &
+                         BT_INFO_8723D_2ANT_B_INQ_PAGE) ? true : false);
+
+               coex_sta->a2dp_bit_pool = (((
+                       coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ?
+                                  coex_sta->bt_info_c2h[rsp_source][6] : 0);
+
+               coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] &
+                                        0xf;
+
+               coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8;
+
+               coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7;
+
+               coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4;
+
+               coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6;
+
+               if (coex_sta->bt_retry_cnt >= 1)
+                       coex_sta->pop_event_cnt++;
+
+               if (coex_sta->c2h_bt_remote_name_req)
+                       coex_sta->cnt_RemoteNameReq++;
+
+               if (coex_sta->bt_info_ext & BIT(1))
+                       coex_sta->cnt_ReInit++;
+
+               if (coex_sta->bt_info_ext & BIT(2)) {
+                       coex_sta->cnt_setupLink++;
+                       coex_sta->is_setupLink = true;
+               } else
+                       coex_sta->is_setupLink = false;
+
+               if (coex_sta->bt_info_ext & BIT(3))
+                       coex_sta->cnt_IgnWlanAct++;
+
+               if (coex_sta->bt_create_connection) {
+                       coex_sta->cnt_Page++;
+
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY,
+                                          &wifi_busy);
+
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan);
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link);
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam);
+
+                       if ((wifi_link) || (wifi_roam) || (wifi_scan) ||
+                           (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) {
+
+                               is_scoreboard_scan = true;
+                               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_SCAN, true);
+
+                       } else
+                               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_SCAN, false);
+
+               } else {
+                               if (is_scoreboard_scan) {
+                                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                                BT_8723D_2ANT_SCOREBOARD_SCAN, false);
+                                       is_scoreboard_scan = false;
+                               }
+               }
+
+               /* Here we need to resend some wifi info to BT */
+               /* because bt is reset and loss of the info. */
+
+               if ((!btcoexist->manual_control) &&
+                   (!btcoexist->stop_coex_dm)) {
+
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
+                                          &wifi_connected);
+
+                       /*  Re-Init */
+                       if ((coex_sta->bt_info_ext & BIT(1))) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n");
+                               BTC_TRACE(trace_buf);
+                               if (wifi_connected)
+                                       halbtc8723d2ant_update_wifi_channel_info(
+                                               btcoexist, BTC_MEDIA_CONNECT);
+                               else
+                                       halbtc8723d2ant_update_wifi_channel_info(
+                                               btcoexist,
+                                               BTC_MEDIA_DISCONNECT);
+                       }
+
+
+                       /*  If Ignore_WLanAct && not SetUp_Link or Role_Switch */
+                       if ((coex_sta->bt_info_ext & BIT(3)) &&
+                               (!(coex_sta->bt_info_ext & BIT(2))) &&
+                               (!(coex_sta->bt_info_ext & BIT(6)))) {
+
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n");
+                               BTC_TRACE(trace_buf);
+                               halbtc8723d2ant_ignore_wlan_act(btcoexist,
+                                                       FORCE_EXEC, false);
+                       } else {
+                               if (coex_sta->bt_info_ext & BIT(2)) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], BT ignore Wlan active because Re-link!!\n");
+                                       BTC_TRACE(trace_buf);
+                               } else if (coex_sta->bt_info_ext & BIT(6)) {
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], BT ignore Wlan active because Role-Switch!!\n");
+                                       BTC_TRACE(trace_buf);
+                               }
+                       }
+               }
+
+       }
+
+       if ((coex_sta->bt_info_ext & BIT(5))) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n");
+               BTC_TRACE(trace_buf);
+               coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist);
+
+               if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1)
+                       coex_sta->bt_ble_scan_para[0]  = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1);
+               if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2)
+                       coex_sta->bt_ble_scan_para[1]  = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2);
+               if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4)
+                       coex_sta->bt_ble_scan_para[2]  = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4);
+       }
+
+       halbtc8723d2ant_update_bt_link_info(btcoexist);
+
+       halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+}
+
+void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist,
+               IN u8 type)
+{
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n");
+       BTC_TRACE(trace_buf);
+
+       if (BTC_RF_ON == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], RF is turned ON!!\n");
+               BTC_TRACE(trace_buf);
+
+               btcoexist->stop_coex_dm = false;
+#if 0
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                        BT_8723D_2ANT_SCOREBOARD_ONOFF, true);
+#endif
+       } else if (BTC_RF_OFF == type) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], RF is turned OFF!!\n");
+               BTC_TRACE(trace_buf);
+
+               halbtc8723d2ant_set_ant_path(btcoexist,
+                                            BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_WLAN_OFF);
+
+               halbtc8723d2ant_action_coex_all_off(btcoexist);
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                               BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                               BT_8723D_2ANT_SCOREBOARD_ONOFF |
+                               BT_8723D_2ANT_SCOREBOARD_SCAN |
+                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST,
+                               false);
+
+               btcoexist->stop_coex_dm = true;
+
+       }
+}
+
+void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist)
+{
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n");
+       BTC_TRACE(trace_buf);
+
+       halbtc8723d2ant_set_ant_path(btcoexist,
+                                    BTC_ANT_PATH_AUTO,
+                                    FORCE_EXEC,
+                                    BT_8723D_2ANT_PHASE_WLAN_OFF);
+
+       ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT);
+
+       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                               BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                               BT_8723D_2ANT_SCOREBOARD_ONOFF |
+                               BT_8723D_2ANT_SCOREBOARD_SCAN |
+                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST,
+                               false);
+}
+
+void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist,
+                                  IN u8 pnp_state)
+{
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n");
+       BTC_TRACE(trace_buf);
+
+       if ((BTC_WIFI_PNP_SLEEP == pnp_state) ||
+           (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], Pnp notify to SLEEP\n");
+               BTC_TRACE(trace_buf);
+
+               /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */
+               /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */
+               /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */
+               coex_sta->under_ips = false;
+               coex_sta->under_lps = false;
+
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                               BT_8723D_2ANT_SCOREBOARD_ACTIVE |
+                               BT_8723D_2ANT_SCOREBOARD_ONOFF |
+                               BT_8723D_2ANT_SCOREBOARD_SCAN |
+                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST,
+                               false);
+
+               if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) {
+
+                       halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO,
+                                                    FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+               } else {
+
+                       halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO,
+                                                    FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_WLAN_OFF);
+               }
+
+
+       } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) {
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                           "[BTCoex], Pnp notify to WAKE UP\n");
+               BTC_TRACE(trace_buf);
+#if 0
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                       BT_8723D_2ANT_SCOREBOARD_ACTIVE, true);
+               halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                       BT_8723D_2ANT_SCOREBOARD_ONOFF, true);
+#endif
+       }
+}
+
+void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist)
+{
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+       boolean wifi_busy = false;
+       u32     bt_patch_ver;
+       static u8 cnt = 0;
+       boolean bt_relink_finish = false;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "[BTCoex], ************* Periodical *************\n");
+       BTC_TRACE(trace_buf);
+
+#if (BT_AUTO_REPORT_ONLY_8723D_2ANT == 0)
+       halbtc8723d2ant_query_bt_info(btcoexist);
+#endif
+
+       halbtc8723d2ant_monitor_bt_ctr(btcoexist);
+       halbtc8723d2ant_monitor_wifi_ctr(btcoexist);
+       halbtc8723d2ant_monitor_bt_enable_disable(btcoexist);
+
+#if 0
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
+
+               /* halbtc8723d2ant_read_score_board(btcoexist, &bt_scoreboard_val); */
+
+               if (wifi_busy) {
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                       BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true);
+                       /*
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                                BT_8723D_2ANT_SCOREBOARD_WLBUSY, true);
+
+                       if (bt_scoreboard_val & BIT(6))
+                               halbtc8723d2ant_query_bt_info(btcoexist); */
+               } else {
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                               BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false);
+                       /*
+                       halbtc8723d2ant_post_state_to_bt(btcoexist,
+                                               BT_8723D_2ANT_SCOREBOARD_WLBUSY,
+                                               false);  */
+               }
+#endif
+
+       if (coex_sta->bt_relink_downcount != 0) {
+               coex_sta->bt_relink_downcount--;
+
+               if (coex_sta->bt_relink_downcount == 0)
+                       bt_relink_finish = true;
+       }
+
+       /* for 4-way, DHCP, EAPOL packet */
+       if (coex_sta->specific_pkt_period_cnt > 0) {
+
+               coex_sta->specific_pkt_period_cnt--;
+
+               if ((coex_sta->specific_pkt_period_cnt == 0) &&
+                   (coex_sta->wifi_is_high_pri_task))
+                       coex_sta->wifi_is_high_pri_task = false;
+
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                       "[BTCoex], ***************** Hi-Pri Task = %s*****************\n",
+                           (coex_sta->wifi_is_high_pri_task ? "Yes" :
+                            "No"));
+               BTC_TRACE(trace_buf);
+
+       }
+
+       if (!coex_sta->bt_disabled) {
+
+#if BT_8723D_2ANT_ANTDET_ENABLE
+
+               if (board_info->btdm_ant_det_finish) {
+                       if ((psd_scan->ant_det_result == 12) &&
+                           (psd_scan->ant_det_psd_scan_peak_val == 0)
+                           && (!psd_scan->is_AntDet_running))
+                               psd_scan->ant_det_psd_scan_peak_val =
+                                       btcoexist->btc_get_ant_det_val_from_bt(
+                                               btcoexist) * 100;
+               }
+
+#endif
+       }
+
+
+       if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist))
+               halbtc8723d2ant_run_coexist_mechanism(btcoexist);
+}
+
+void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist,
+               IN u8 type)
+{
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+
+       if (btcoexist->manual_control || btcoexist->stop_coex_dm)
+               return;
+
+       if (type == 2) { /* two antenna */
+               board_info->ant_div_cfg = true;
+
+               halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+       } else { /* one antenna */
+
+               halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO,
+                                            FORCE_EXEC,
+                                            BT_8723D_2ANT_PHASE_2G_RUNTIME);
+
+       }
+}
+
+#ifdef PLATFORM_WINDOWS
+#pragma optimize("", off)
+#endif
+void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist,
+               IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds)
+{
+
+       static u32 ant_det_count = 0, ant_det_fail_count = 0;
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+       u16             u16tmp;
+       u8                      AntDetval = 0;
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n");
+       BTC_TRACE(trace_buf);
+
+#if BT_8723D_2ANT_ANTDET_ENABLE
+
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                   "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n");
+       BTC_TRACE(trace_buf);
+
+       if (seconds == 0) {
+               psd_scan->ant_det_try_count     = 0;
+               psd_scan->ant_det_fail_count    = 0;
+               ant_det_count = 0;
+               ant_det_fail_count = 0;
+               board_info->btdm_ant_det_finish = false;
+               board_info->btdm_ant_num_by_ant_det = 1;
+               return;
+       }
+
+       if (!board_info->btdm_ant_det_finish) {
+               psd_scan->ant_det_inteval_count =
+                       psd_scan->ant_det_inteval_count + 2;
+
+               if (psd_scan->ant_det_inteval_count >=
+                   BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n");
+                       BTC_TRACE(trace_buf);
+
+                       psd_scan->is_AntDet_running = true;
+
+                       halbtc8723d2ant_read_score_board(btcoexist,     &u16tmp);
+
+                       if (u16tmp & BIT(
+                               2)) { /* Antenna detection is already done before last WL power on   */
+                               board_info->btdm_ant_det_finish = true;
+                               psd_scan->ant_det_try_count = 1;
+                               psd_scan->ant_det_fail_count = 0;
+                               board_info->btdm_ant_num_by_ant_det = (u16tmp &
+                                                              BIT(3)) ? 1 : 2;
+                               psd_scan->ant_det_result = 12;
+
+                               psd_scan->ant_det_psd_scan_peak_val =
+                                       btcoexist->btc_get_ant_det_val_from_bt(
+                                               btcoexist) * 100;
+
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n",
+                                       board_info->btdm_ant_num_by_ant_det);
+                               BTC_TRACE(trace_buf);
+                       } else
+                               board_info->btdm_ant_det_finish =
+                                       halbtc8723d2ant_psd_antenna_detection_check(
+                                               btcoexist);
+
+                       btcoexist->bdontenterLPS = false;
+
+                       if (board_info->btdm_ant_det_finish) {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n");
+                               BTC_TRACE(trace_buf);
+
+                               /*for 8723d, btc_set_bt_trx_mask is just used to
+                                       notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask  */
+                               if (psd_scan->ant_det_result != 12) {
+
+                                       AntDetval = (u8)(
+                                               psd_scan->ant_det_psd_scan_peak_val
+                                                           / 100) & 0x7f;
+
+                                       AntDetval =
+                                               (board_info->btdm_ant_num_by_ant_det
+                                                == 1) ? (AntDetval | 0x80) :
+                                               AntDetval;
+
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                               "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n",
+                                                   ((AntDetval &
+                                                     0x80) ? 1
+                                                    : 2), AntDetval
+                                                   & 0x7f);
+                                       BTC_TRACE(trace_buf);
+
+                                       if (btcoexist->btc_set_bt_trx_mask(
+                                                   btcoexist, AntDetval))
+                                               BTC_SPRINTF(trace_buf,
+                                                           BT_TMP_BUF_SIZE,
+                                                       "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n");
+                                       else
+                                               BTC_SPRINTF(trace_buf,
+                                                           BT_TMP_BUF_SIZE,
+                                                       "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n");
+
+                                       BTC_TRACE(trace_buf);
+                               } else
+                                       board_info->antdetval =
+                                               psd_scan->ant_det_psd_scan_peak_val/100;
+
+                               board_info->btdm_ant_det_complete_fail = false;
+
+                       } else {
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n");
+                               BTC_TRACE(trace_buf);
+                       }
+
+                       psd_scan->ant_det_inteval_count = 0;
+                       psd_scan->is_AntDet_running = false;
+
+                       /* stimulate coex running */
+                       halbtc8723d2ant_run_coexist_mechanism(
+                               btcoexist);
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!");
+                       BTC_TRACE(trace_buf);
+               } else {
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n",
+                                   psd_scan->ant_det_inteval_count);
+                       BTC_TRACE(trace_buf);
+
+                       if (psd_scan->ant_det_inteval_count == 8)
+                               btcoexist->bdontenterLPS = true;
+                       else
+                               btcoexist->bdontenterLPS = false;
+               }
+
+       }
+#endif
+
+
+}
+
+
+void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist)
+{
+
+#if BT_8723D_2ANT_ANTDET_ENABLE
+       struct  btc_board_info  *board_info = &btcoexist->board_info;
+
+       if (psd_scan->ant_det_try_count != 0)   {
+               halbtc8723d2ant_psd_show_antenna_detect_result(btcoexist);
+
+               if (board_info->btdm_ant_det_finish)
+                       halbtc8723d2ant_psd_showdata(btcoexist);
+       }
+#endif
+
+}
+
+
+#endif
+
+#endif /*  #if (RTL8723D_SUPPORT == 1) */