net: wireless: rockchip: add rtl8822be pcie wifi driver
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8822be / hal / btc / halbtc8723b1ant.c
diff --git a/drivers/net/wireless/rockchip_wlan/rtl8822be/hal/btc/halbtc8723b1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8822be/hal/btc/halbtc8723b1ant.c
new file mode 100644 (file)
index 0000000..565b3bb
--- /dev/null
@@ -0,0 +1,4845 @@
+/* ************************************************************\r
+ * Description:\r
+ *\r
+ * This file is for RTL8723B Co-exist mechanism\r
+ *\r
+ * History\r
+ * 2012/11/15 Cosa first check in.\r
+ *\r
+ * ************************************************************ */\r
+\r
+/* ************************************************************\r
+ * include files\r
+ * ************************************************************ */\r
+#include "Mp_Precomp.h"\r
+\r
+#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1)\r
+\r
+#if (RTL8723B_SUPPORT == 1)\r
+/* ************************************************************\r
+ * Global variables, these are static variables\r
+ * ************************************************************ */\r
+static u8       *trace_buf = &gl_btc_trace_buf[0];\r
+static struct  coex_dm_8723b_1ant              glcoex_dm_8723b_1ant;\r
+static struct  coex_dm_8723b_1ant      *coex_dm = &glcoex_dm_8723b_1ant;\r
+static struct  coex_sta_8723b_1ant             glcoex_sta_8723b_1ant;\r
+static struct  coex_sta_8723b_1ant     *coex_sta = &glcoex_sta_8723b_1ant;\r
+static struct  psdscan_sta_8723b_1ant  gl_psd_scan_8723b_1ant;\r
+static struct  psdscan_sta_8723b_1ant *psd_scan = &gl_psd_scan_8723b_1ant;\r
+\r
+\r
+const char *const glbt_info_src_8723b_1ant[]={\r
+       "BT Info[wifi fw]",\r
+       "BT Info[bt rsp]",\r
+       "BT Info[bt auto report]",\r
+};\r
+\r
+u32    glcoex_ver_date_8723b_1ant = 20151015;\r
+u32    glcoex_ver_8723b_1ant = 0x63;\r
+\r
+/* ************************************************************\r
+ * local function proto type if needed\r
+ * ************************************************************\r
+ * ************************************************************\r
+ * local function start with halbtc8723b1ant_\r
+ * ************************************************************ */\r
+\r
+void halbtc8723b1ant_update_ra_mask(IN struct btc_coexist *btcoexist,\r
+                                   IN boolean force_exec, IN u32 dis_rate_mask)\r
+{\r
+       coex_dm->cur_ra_mask = dis_rate_mask;\r
+       \r
+       if( force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask))\r
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK,\r
+                                  &coex_dm->cur_ra_mask);\r
+       coex_dm->pre_ra_mask = coex_dm->cur_ra_mask;\r
+}\r
+\r
+void halbtc8723b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist,\r
+               IN boolean force_exec, IN u8 type)\r
+{\r
+       boolean wifi_under_b_mode = false;\r
+\r
+       coex_dm->cur_arfr_type = type;\r
+\r
+       if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) {\r
+               switch (coex_dm->cur_arfr_type) {\r
+               case 0: /* normal mode */\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x430,\r
+                                                  coex_dm->backup_arfr_cnt1);\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x434,\r
+                                                  coex_dm->backup_arfr_cnt2);\r
+                       break;\r
+               case 1:\r
+                       btcoexist->btc_get(btcoexist,\r
+                                          BTC_GET_BL_WIFI_UNDER_B_MODE,\r
+                                          &wifi_under_b_mode);\r
+                       if (wifi_under_b_mode) {\r
+                               btcoexist->btc_write_4byte(btcoexist,\r
+                                                          0x430, 0x0);\r
+                               btcoexist->btc_write_4byte(btcoexist,\r
+                                                          0x434, 0x01010101);\r
+                       } else {\r
+                               btcoexist->btc_write_4byte(btcoexist,\r
+                                                          0x430, 0x0);\r
+                               btcoexist->btc_write_4byte(btcoexist,\r
+                                                          0x434, 0x04030201);\r
+                       }\r
+                       break;\r
+               default:\r
+                       break;\r
+               }\r
+       }\r
+\r
+       coex_dm->pre_arfr_type = coex_dm->cur_arfr_type;\r
+}\r
+\r
+void halbtc8723b1ant_retry_limit(IN struct btc_coexist *btcoexist,\r
+                                IN boolean force_exec, IN u8 type)\r
+{\r
+       coex_dm->cur_retry_limit_type = type;\r
+\r
+       if (force_exec ||\r
+           (coex_dm->pre_retry_limit_type !=\r
+            coex_dm->cur_retry_limit_type)) {\r
+               switch (coex_dm->cur_retry_limit_type) {\r
+               case 0: /* normal mode */\r
+                       btcoexist->btc_write_2byte(btcoexist, 0x42a,\r
+                                                  coex_dm->backup_retry_limit);\r
+                               break;\r
+               case 1: /* retry limit=8 */\r
+                       btcoexist->btc_write_2byte(btcoexist, 0x42a,\r
+                                                  0x0808);\r
+                               break;\r
+                       default:\r
+                               break;\r
+               }\r
+       }\r
+\r
+       coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type;\r
+}\r
+\r
+void halbtc8723b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist,\r
+                                   IN boolean force_exec, IN u8 type)\r
+{\r
+       coex_dm->cur_ampdu_time_type = type;\r
+\r
+       if (force_exec ||\r
+           (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) {\r
+               switch (coex_dm->cur_ampdu_time_type) {\r
+               case 0: /* normal mode */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x456,\r
+                                          coex_dm->backup_ampdu_max_time);\r
+                       break;\r
+               case 1: /* AMPDU timw = 0x38 * 32us */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x456,\r
+                                                  0x38);\r
+                       break;\r
+               default:\r
+                       break;\r
+               }\r
+       }\r
+\r
+       coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type;\r
+}\r
+\r
+void halbtc8723b1ant_limited_tx(IN struct btc_coexist *btcoexist,\r
+               IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type,\r
+                               IN u8 retry_limit_type, IN u8 ampdu_time_type)\r
+{\r
+       switch (ra_mask_type) {\r
+       case 0: /* normal mode */\r
+               halbtc8723b1ant_update_ra_mask(btcoexist, force_exec,\r
+                                              0x0);\r
+               break;\r
+       case 1: /* disable cck 1/2 */\r
+               halbtc8723b1ant_update_ra_mask(btcoexist, force_exec,\r
+                                              0x00000003);\r
+               break;\r
+       case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */\r
+               halbtc8723b1ant_update_ra_mask(btcoexist, force_exec,\r
+                                              0x0001f1f7);\r
+               break;\r
+       default:\r
+               break;\r
+       }\r
+\r
+       halbtc8723b1ant_auto_rate_fallback_retry(btcoexist, force_exec,\r
+                       arfr_type);\r
+       halbtc8723b1ant_retry_limit(btcoexist, force_exec, retry_limit_type);\r
+       halbtc8723b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type);\r
+}\r
+\r
+void halbtc8723b1ant_limited_rx(IN struct btc_coexist *btcoexist,\r
+                       IN boolean force_exec, IN boolean rej_ap_agg_pkt,\r
+                       IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size)\r
+{\r
+       boolean reject_rx_agg = rej_ap_agg_pkt;\r
+       boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size;\r
+       u8      rx_agg_size = agg_buf_size;\r
+\r
+       /* ============================================ */\r
+       /*      Rx Aggregation related setting */\r
+       /* ============================================ */\r
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT,\r
+                          &reject_rx_agg);\r
+       /* decide BT control aggregation buf size or not */\r
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE,\r
+                          &bt_ctrl_rx_agg_size);\r
+       /* aggregation buf size, only work when BT control Rx aggregation size. */\r
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size);\r
+       /* real update aggregation setting */\r
+       btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);\r
+\r
+\r
+}\r
+\r
+void halbtc8723b1ant_query_bt_info(IN struct btc_coexist *btcoexist)\r
+{\r
+       u8                      h2c_parameter[1] = {0};\r
+\r
+       coex_sta->c2h_bt_info_req_sent = true;\r
+\r
+       h2c_parameter[0] |= BIT(0);     /* trigger */\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter);\r
+}\r
+\r
+void halbtc8723b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist)\r
+{\r
+       u32                     reg_hp_txrx, reg_lp_txrx, u32tmp;\r
+       u32                     reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0;\r
+       static u32              num_of_bt_counter_chk = 0;\r
+\r
+       reg_hp_txrx = 0x770;\r
+       reg_lp_txrx = 0x774;\r
+\r
+       u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx);\r
+       reg_hp_tx = u32tmp & MASKLWORD;\r
+       reg_hp_rx = (u32tmp & MASKHWORD) >> 16;\r
+\r
+       u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx);\r
+       reg_lp_tx = u32tmp & MASKLWORD;\r
+       reg_lp_rx = (u32tmp & MASKHWORD) >> 16;\r
+\r
+       coex_sta->high_priority_tx = reg_hp_tx;\r
+       coex_sta->high_priority_rx = reg_hp_rx;\r
+       coex_sta->low_priority_tx = reg_lp_tx;\r
+       coex_sta->low_priority_rx = reg_lp_rx;\r
+\r
+       if ((coex_sta->low_priority_tx > 1050)  &&\r
+           (!coex_sta->c2h_bt_inquiry_page))\r
+               coex_sta->pop_event_cnt++;\r
+\r
+       /* reset counter */\r
+       btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc);\r
+\r
+       /* This part is for wifi FW and driver to update BT's status as disabled. */\r
+       /* The flow is as the following */\r
+       /* 1. disable BT */\r
+       /* 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info */\r
+       /* 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled */\r
+       /* 4. FW will rsp c2h for BT that driver will know BT is disabled. */\r
+       if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) &&\r
+           (reg_lp_rx == 0)) {\r
+               num_of_bt_counter_chk++;\r
+               if (num_of_bt_counter_chk == 3)\r
+                       halbtc8723b1ant_query_bt_info(btcoexist);\r
+       } else\r
+               num_of_bt_counter_chk = 0;\r
+}\r
+\r
+\r
+void halbtc8723b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist)\r
+{\r
+       s32     wifi_rssi = 0;\r
+       boolean wifi_busy = false, wifi_under_b_mode = false;\r
+       static u8 cck_lock_counter = 0;\r
+       u32     total_cnt;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,\r
+                          &wifi_under_b_mode);\r
+\r
+       if (coex_sta->under_ips) {\r
+               coex_sta->crc_ok_cck = 0;\r
+               coex_sta->crc_ok_11g = 0;\r
+               coex_sta->crc_ok_11n = 0;\r
+               coex_sta->crc_ok_11n_agg = 0;\r
+\r
+               coex_sta->crc_err_cck = 0;\r
+               coex_sta->crc_err_11g = 0;\r
+               coex_sta->crc_err_11n = 0;\r
+               coex_sta->crc_err_11n_agg = 0;  \r
+       } else {\r
+               coex_sta->crc_ok_cck    = btcoexist->btc_read_4byte(btcoexist,\r
+                                         0xf88);\r
+               coex_sta->crc_ok_11g    = btcoexist->btc_read_2byte(btcoexist,\r
+                                         0xf94);\r
+               coex_sta->crc_ok_11n    = btcoexist->btc_read_2byte(btcoexist,\r
+                                         0xf90);\r
+               coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist,\r
+                                          0xfb8);\r
+\r
+               coex_sta->crc_err_cck    = btcoexist->btc_read_4byte(btcoexist,\r
+                                          0xf84);\r
+               coex_sta->crc_err_11g    = btcoexist->btc_read_2byte(btcoexist,\r
+                                          0xf96);\r
+               coex_sta->crc_err_11n    = btcoexist->btc_read_2byte(btcoexist,\r
+                                          0xf92);\r
+               coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist,\r
+                                           0xfba);\r
+       }\r
+\r
+\r
+       /* reset counter */\r
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1);\r
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0);\r
+\r
+       if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) {\r
+               total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g +\r
+                           coex_sta->crc_ok_11n +\r
+                               coex_sta->crc_ok_11n_agg;\r
+       \r
+               if ( (coex_dm->bt_status == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) ||\r
+                   (coex_dm->bt_status ==\r
+                    BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) ||\r
+                   (coex_dm->bt_status ==\r
+                    BT_8723B_1ANT_BT_STATUS_SCO_BUSY)) {\r
+                       if (coex_sta->crc_ok_cck > (total_cnt -\r
+coex_sta->crc_ok_cck))                         {\r
+                               if (cck_lock_counter < 3)\r
+                                       cck_lock_counter++;\r
+                       } else {\r
+                               if (cck_lock_counter > 0)\r
+                                       cck_lock_counter--;\r
+                       }\r
+\r
+               } else {\r
+                       if (cck_lock_counter > 0)\r
+                               cck_lock_counter--;\r
+               }\r
+       } else {\r
+               if (cck_lock_counter > 0)\r
+                       cck_lock_counter--;\r
+       }\r
+\r
+       if (!coex_sta->pre_ccklock) {\r
+\r
+               if (cck_lock_counter >= 3)\r
+                       coex_sta->cck_lock = true;\r
+               else\r
+                       coex_sta->cck_lock = false;\r
+       } else {\r
+               if (cck_lock_counter == 0)\r
+                       coex_sta->cck_lock = false;\r
+               else\r
+                       coex_sta->cck_lock = true;\r
+       }\r
+\r
+       if (coex_sta->cck_lock)\r
+               coex_sta->cck_ever_lock = true;\r
+\r
+       coex_sta->pre_ccklock =  coex_sta->cck_lock;\r
+\r
+\r
+}\r
+\r
+boolean halbtc8723b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist)\r
+{\r
+       static boolean  pre_wifi_busy = false, pre_under_4way = false,\r
+                       pre_bt_hs_on = false;\r
+       boolean wifi_busy = false, under_4way = false, bt_hs_on = false;\r
+       boolean wifi_connected = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                          &wifi_connected);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,\r
+                          &under_4way);\r
+\r
+       if (wifi_connected) {\r
+               if (wifi_busy != pre_wifi_busy) {\r
+                       pre_wifi_busy = wifi_busy;\r
+                       return true;\r
+               }\r
+               if (under_4way != pre_under_4way) {\r
+                       pre_under_4way = under_4way;\r
+                       return true;\r
+               }\r
+               if (bt_hs_on != pre_bt_hs_on) {\r
+                       pre_bt_hs_on = bt_hs_on;\r
+                       return true;\r
+               }\r
+\r
+\r
+       }\r
+\r
+       return false;\r
+}\r
+\r
+void halbtc8723b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean                         bt_hs_on = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+\r
+       bt_link_info->bt_link_exist = coex_sta->bt_link_exist;\r
+       bt_link_info->sco_exist = coex_sta->sco_exist;\r
+       bt_link_info->a2dp_exist = coex_sta->a2dp_exist;\r
+       bt_link_info->pan_exist = coex_sta->pan_exist;\r
+       bt_link_info->hid_exist = coex_sta->hid_exist;\r
+       bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist;\r
+\r
+       /* work around for HS mode. */\r
+       if (bt_hs_on) {\r
+               bt_link_info->pan_exist = true;\r
+               bt_link_info->bt_link_exist = true;\r
+       }\r
+\r
+       /* check if Sco only */\r
+       if( bt_link_info->sco_exist &&\r
+               !bt_link_info->a2dp_exist &&\r
+               !bt_link_info->pan_exist &&\r
+               !bt_link_info->hid_exist )\r
+               bt_link_info->sco_only = true;\r
+       else\r
+               bt_link_info->sco_only = false;\r
+\r
+       /* check if A2dp only */\r
+       if( !bt_link_info->sco_exist &&\r
+               bt_link_info->a2dp_exist &&\r
+               !bt_link_info->pan_exist &&\r
+               !bt_link_info->hid_exist )\r
+               bt_link_info->a2dp_only = true;\r
+       else\r
+               bt_link_info->a2dp_only = false;\r
+\r
+       /* check if Pan only */\r
+       if( !bt_link_info->sco_exist &&\r
+               !bt_link_info->a2dp_exist &&\r
+               bt_link_info->pan_exist &&\r
+               !bt_link_info->hid_exist )\r
+               bt_link_info->pan_only = true;\r
+       else\r
+               bt_link_info->pan_only = false;\r
+       \r
+       /* check if Hid only */\r
+       if( !bt_link_info->sco_exist &&\r
+               !bt_link_info->a2dp_exist &&\r
+               !bt_link_info->pan_exist &&\r
+               bt_link_info->hid_exist )\r
+               bt_link_info->hid_only = true;\r
+       else\r
+               bt_link_info->hid_only = false;\r
+}\r
+\r
+void halbtc8723b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist,\r
+                                       IN boolean enable_auto_report)\r
+{\r
+       u8                      h2c_parameter[1] = {0};\r
+\r
+       h2c_parameter[0] = 0;\r
+\r
+       if (enable_auto_report)\r
+               h2c_parameter[0] |= BIT(0);\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter);\r
+}\r
+\r
+void halbtc8723b1ant_bt_auto_report(IN struct btc_coexist *btcoexist,\r
+                   IN boolean force_exec, IN boolean enable_auto_report)\r
+{\r
+       coex_dm->cur_bt_auto_report = enable_auto_report;\r
+\r
+       if (!force_exec) {\r
+               if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report)\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_set_bt_auto_report(btcoexist,\r
+                                          coex_dm->cur_bt_auto_report);\r
+\r
+       coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report;\r
+}\r
+\r
+void halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist\r
+               *btcoexist, IN boolean low_penalty_ra)\r
+{\r
+       u8                      h2c_parameter[6] = {0};\r
+\r
+       h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */\r
+\r
+       if (low_penalty_ra) {\r
+               h2c_parameter[1] |= BIT(0);\r
+               h2c_parameter[2] =\r
+                       0x00;  /* normal rate except MCS7/6/5, OFDM54/48/36 */\r
+               h2c_parameter[3] = 0xf7;  /* MCS7 or OFDM54 */\r
+               h2c_parameter[4] = 0xf8;  /* MCS6 or OFDM48 */\r
+               h2c_parameter[5] = 0xf9;        /* MCS5 or OFDM36        */\r
+       }\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter);\r
+}\r
+\r
+void halbtc8723b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist,\r
+                           IN boolean force_exec, IN boolean low_penalty_ra)\r
+{\r
+       coex_dm->cur_low_penalty_ra = low_penalty_ra;\r
+\r
+       if (!force_exec) {\r
+               if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra)\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist,\r
+                       coex_dm->cur_low_penalty_ra);\r
+\r
+       coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra;\r
+}\r
+\r
+void halbtc8723b1ant_set_coex_table(IN struct btc_coexist *btcoexist,\r
+           IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc)\r
+{\r
+       btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0);\r
+\r
+       btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4);\r
+\r
+       btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8);\r
+\r
+       btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc);\r
+}\r
+\r
+void halbtc8723b1ant_coex_table(IN struct btc_coexist *btcoexist,\r
+                       IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4,\r
+                               IN u32 val0x6c8, IN u8 val0x6cc)\r
+{\r
+       coex_dm->cur_val0x6c0 = val0x6c0;\r
+       coex_dm->cur_val0x6c4 = val0x6c4;\r
+       coex_dm->cur_val0x6c8 = val0x6c8;\r
+       coex_dm->cur_val0x6cc = val0x6cc;\r
+\r
+       if (!force_exec) {\r
+               if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) &&\r
+                   (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) &&\r
+                   (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) &&\r
+                   (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc))\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8,\r
+                                      val0x6cc);\r
+\r
+       coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0;\r
+       coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4;\r
+       coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8;\r
+       coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc;\r
+}\r
+\r
+void halbtc8723b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist,\r
+               IN boolean force_exec, IN u8 type)\r
+{\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+       if (board_info->btdm_ant_num_by_ant_det == 2) {\r
+               if (type == 3)\r
+                       type = 14;\r
+               else if (type == 4)\r
+                       type  = 13;\r
+               else if (type == 5)\r
+                       type = 8;\r
+       }\r
+#endif\r
+#endif\r
+\r
+       coex_sta->coex_table_type = type;\r
+\r
+       switch (type) {\r
+       case 0:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55555555, 0x55555555, 0xffffff, 0x3);\r
+               break;\r
+       case 1:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55555555, 0x5a5a5a5a, 0xffffff, 0x3);\r
+               break;\r
+       case 2:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3);\r
+               break;\r
+       case 3:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55555555, 0x5a5a5a5a, 0xffffff, 0x3);\r
+               break;\r
+       case 4:\r
+               if ((coex_sta->cck_ever_lock)  &&\r
+                   (coex_sta->scan_ap_num <= 5))\r
+                       halbtc8723b1ant_coex_table(btcoexist,\r
+                                          force_exec, 0x55555555, 0xaaaa5a5a,\r
+                                                  0xffffff, 0x3);\r
+               else\r
+                       halbtc8723b1ant_coex_table(btcoexist,\r
+                                          force_exec, 0x55555555, 0x5a5a5a5a,\r
+                                                  0xffffff, 0x3);\r
+               break;\r
+       case 5:\r
+               if ((coex_sta->cck_ever_lock)  &&\r
+                   (coex_sta->scan_ap_num <= 5))\r
+                       halbtc8723b1ant_coex_table(btcoexist,\r
+                                          force_exec, 0x5a5a5a5a, 0x5aaa5a5a,\r
+                                                  0xffffff, 0x3);\r
+               else\r
+                       halbtc8723b1ant_coex_table(btcoexist,\r
+                                          force_exec, 0x5a5a5a5a, 0x5aaa5a5a,\r
+                                                  0xffffff, 0x3);\r
+               break;\r
+       case 6:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55555555, 0xaaaaaaaa, 0xffffff, 0x3);\r
+               break;\r
+       case 7:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3);\r
+               break;\r
+       case 8:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 9:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 10:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 11:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 12:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 13:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3);\r
+               break;\r
+       case 14:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3);\r
+               break;\r
+       case 15:\r
+               halbtc8723b1ant_coex_table(btcoexist, force_exec,\r
+                                  0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3);\r
+               break;\r
+       default:\r
+               break;\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist,\r
+               IN boolean enable)\r
+{\r
+       u8                      h2c_parameter[1] = {0};\r
+\r
+       if (enable) {\r
+               h2c_parameter[0] |= BIT(0);             /* function enable */\r
+       }\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter);\r
+}\r
+\r
+void halbtc8723b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist,\r
+                                    IN boolean force_exec, IN boolean enable)\r
+{\r
+       coex_dm->cur_ignore_wlan_act = enable;\r
+\r
+       if (!force_exec) {\r
+               if (coex_dm->pre_ignore_wlan_act ==\r
+                   coex_dm->cur_ignore_wlan_act)\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_set_fw_ignore_wlan_act(btcoexist, enable);\r
+\r
+       coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act;\r
+}\r
+\r
+void halbtc8723b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist,\r
+                                 IN u8 lps_val, IN u8 rpwm_val)\r
+{\r
+       u8      lps = lps_val;\r
+       u8      rpwm = rpwm_val;\r
+\r
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps);\r
+       btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm);\r
+}\r
+\r
+void halbtc8723b1ant_lps_rpwm(IN struct btc_coexist *btcoexist,\r
+                     IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val)\r
+{\r
+       coex_dm->cur_lps = lps_val;\r
+       coex_dm->cur_rpwm = rpwm_val;\r
+\r
+       if (!force_exec) {\r
+               if ((coex_dm->pre_lps == coex_dm->cur_lps) &&\r
+                   (coex_dm->pre_rpwm == coex_dm->cur_rpwm))\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val);\r
+\r
+       coex_dm->pre_lps = coex_dm->cur_lps;\r
+       coex_dm->pre_rpwm = coex_dm->cur_rpwm;\r
+}\r
+\r
+void halbtc8723b1ant_sw_mechanism(IN struct btc_coexist *btcoexist,\r
+                                 IN boolean low_penalty_ra)\r
+{\r
+       halbtc8723b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra);\r
+}\r
+\r
+void halbtc8723b1ant_set_ant_path(IN struct btc_coexist *btcoexist,\r
+         IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg,\r
+                                 IN boolean wifi_off)\r
+{\r
+       struct  btc_board_info *board_info = &btcoexist->board_info;\r
+       u32                     fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0;\r
+       boolean                 pg_ext_switch = false;\r
+       boolean                 use_ext_switch = false;\r
+       boolean                 is_in_mp_mode = false;\r
+       u8                      h2c_parameter[2] = {0}, u8tmp = 0;\r
+\r
+       coex_dm->cur_ant_pos_type = ant_pos_type;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER,\r
+                          &fw_ver);    /* [31:16]=fw ver, [15:0]=fw sub ver */\r
+\r
+       if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch)\r
+               use_ext_switch = true;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+       if (ant_pos_type == BTC_ANT_PATH_PTA) {\r
+               if ((board_info->btdm_ant_det_finish) &&\r
+                   (board_info->btdm_ant_num_by_ant_det == 2)) {\r
+                       if (board_info->btdm_ant_pos ==\r
+                           BTC_ANTENNA_AT_MAIN_PORT)\r
+                               ant_pos_type = BTC_ANT_PATH_WIFI;\r
+                       else\r
+                               ant_pos_type = BTC_ANT_PATH_BT;\r
+               }\r
+       }\r
+#endif\r
+#endif\r
+\r
+       if (init_hwcfg) {\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff,\r
+                                         0x780); /* WiFi TRx Mask on */\r
+               /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */\r
+               /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on */\r
+\r
+               if (fw_ver >= 0x180000) {\r
+                       /* Use H2C to set GNT_BT to HIGH */\r
+                       h2c_parameter[0] = 1;\r
+                       btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1,\r
+                                               h2c_parameter);\r
+               } else {\r
+                       /* set grant_bt to high */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18);\r
+               }\r
+               /* set wlan_act control by PTA */\r
+               btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4);\r
+\r
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20,\r
+                          0x0); /* BT select s0/s1 is controlled by BT */\r
+\r
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1);\r
+               btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff);\r
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3);\r
+               btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77);\r
+       } else if (wifi_off) {\r
+               if (fw_ver >= 0x180000) {\r
+                       /* Use H2C to set GNT_BT to HIGH */\r
+                       h2c_parameter[0] = 1;\r
+                       btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1,\r
+                                               h2c_parameter);\r
+               } else {\r
+                       /* set grant_bt to high */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18);\r
+               }\r
+               /* set wlan_act to always low */\r
+               btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4);\r
+\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE,\r
+                                  &is_in_mp_mode);\r
+               if (!is_in_mp_mode)\r
+                       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67,\r
+                               0x20, 0x0); /* BT select s0/s1 is controlled by BT */\r
+               else\r
+                       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67,\r
+                               0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */\r
+\r
+               /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL   BT Vendor 0xac=0xf002 */\r
+               u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c);\r
+               u32tmp &= ~BIT(23);\r
+               u32tmp &= ~BIT(24);\r
+               btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp);\r
+       } else {\r
+               /* Use H2C to set GNT_BT to LOW */\r
+               if (fw_ver >= 0x180000) {\r
+                       if (btcoexist->btc_read_1byte(btcoexist, 0x765) != 0) {\r
+                               h2c_parameter[0] = 0;\r
+                               btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1,\r
+                                                       h2c_parameter);\r
+                       }\r
+               } else {\r
+                       /* BT calibration check */\r
+                       while (cnt_bt_cal_chk <= 20) {\r
+                               u8tmp = btcoexist->btc_read_1byte(btcoexist,\r
+                                                                 0x49d);\r
+                               cnt_bt_cal_chk++;\r
+                               if (u8tmp & BIT(0)) {\r
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                               "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n",\r
+                                                   cnt_bt_cal_chk);\r
+                                       BTC_TRACE(trace_buf);\r
+                                       delay_ms(50);\r
+                               } else {\r
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                               "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n",\r
+                                                   cnt_bt_cal_chk);\r
+                                       BTC_TRACE(trace_buf);\r
+                                       break;\r
+                               }\r
+                       }\r
+\r
+                       /* set grant_bt to PTA */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0);\r
+               }\r
+\r
+               if (btcoexist->btc_read_1byte(btcoexist, 0x76e) != 0xc) {\r
+                       /* set wlan_act control by PTA */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc);\r
+               }\r
+\r
+               btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20,\r
+                          0x1); /* BT select s0/s1 is controlled by WiFi */\r
+       }\r
+\r
+       if (use_ext_switch) {\r
+               if (init_hwcfg) {\r
+                       /* 0x4c[23]=0, 0x4c[24]=1  Antenna control by WL/BT */\r
+                       u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c);\r
+                       u32tmp &= ~BIT(23);\r
+                       u32tmp |= BIT(24);\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp);\r
+\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x948,\r
+                               0x0); /* fixed internal switch S1->WiFi, S0->BT */\r
+\r
+                       if (board_info->btdm_ant_pos ==\r
+                           BTC_ANTENNA_AT_MAIN_PORT) {\r
+                               /* tell firmware "no antenna inverse" */\r
+                               h2c_parameter[0] = 0;\r
+                               h2c_parameter[1] = 1;  /* ext switch type */\r
+                               btcoexist->btc_fill_h2c(btcoexist, 0x65, 2,\r
+                                                       h2c_parameter);\r
+                       } else {\r
+                               /* tell firmware "antenna inverse" */\r
+                               h2c_parameter[0] = 1;\r
+                               h2c_parameter[1] = 1;  /* ext switch type */\r
+                               btcoexist->btc_fill_h2c(btcoexist, 0x65, 2,\r
+                                                       h2c_parameter);\r
+                       }\r
+               }\r
+\r
+               if (force_exec ||\r
+                   (coex_dm->cur_ant_pos_type !=\r
+                    coex_dm->pre_ant_pos_type)) {\r
+                       /* ext switch setting */\r
+                       switch (ant_pos_type) {\r
+                       case BTC_ANT_PATH_WIFI:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x1);\r
+                               else\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x2);\r
+                               break;\r
+                       case BTC_ANT_PATH_BT:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x2);\r
+                               else\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x1);\r
+                               break;\r
+                       default:\r
+                       case BTC_ANT_PATH_PTA:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x1);\r
+                               else\r
+                                       btcoexist->btc_write_1byte_bitmask(\r
+                                               btcoexist, 0x92c, 0x3,\r
+                                               0x2);\r
+                               break;\r
+                       }\r
+               }\r
+       } else {\r
+               if (init_hwcfg) {\r
+                       /* 0x4c[23]=1, 0x4c[24]=0  Antenna control by 0x64 */\r
+                       u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c);\r
+                       u32tmp |= BIT(23);\r
+                       u32tmp &= ~BIT(24);\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp);\r
+\r
+                       /* Fix Ext switch Main->S1, Aux->S0 */\r
+                       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1,\r
+                                                          0x0);\r
+\r
+                       if (board_info->btdm_ant_pos ==\r
+                           BTC_ANTENNA_AT_MAIN_PORT) {\r
+\r
+                               /* tell firmware "no antenna inverse" */\r
+                               h2c_parameter[0] = 0;\r
+                               h2c_parameter[1] =\r
+                                       0;  /* internal switch type */\r
+                               btcoexist->btc_fill_h2c(btcoexist, 0x65, 2,\r
+                                                       h2c_parameter);\r
+                       } else {\r
+\r
+                               /* tell firmware "antenna inverse" */\r
+                               h2c_parameter[0] = 1;\r
+                               h2c_parameter[1] =\r
+                                       0;  /* internal switch type */\r
+                               btcoexist->btc_fill_h2c(btcoexist, 0x65, 2,\r
+                                                       h2c_parameter);\r
+                       }\r
+               }\r
+\r
+               if (force_exec ||\r
+                   (coex_dm->cur_ant_pos_type !=\r
+                    coex_dm->pre_ant_pos_type)) {\r
+                       /* internal switch setting */\r
+                       switch (ant_pos_type) {\r
+                       case BTC_ANT_PATH_WIFI:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948, 0x0);\r
+                               else\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948,\r
+                                               0x280);\r
+                               break;\r
+                       case BTC_ANT_PATH_BT:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948,\r
+                                               0x280);\r
+                               else\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948, 0x0);\r
+                               break;\r
+                       default:\r
+                       case BTC_ANT_PATH_PTA:\r
+                               if (board_info->btdm_ant_pos ==\r
+                                   BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948,\r
+                                               0x200);\r
+                               else\r
+                                       btcoexist->btc_write_4byte(\r
+                                               btcoexist, 0x948, 0x80);\r
+                               break;\r
+                       }\r
+               }\r
+       }\r
+\r
+       coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type;\r
+}\r
+\r
+void halbtc8723b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist,\r
+          IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5)\r
+{\r
+       u8                      h2c_parameter[5] = {0};\r
+       u8                      real_byte1 = byte1, real_byte5 = byte5;\r
+       boolean                 ap_enable = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE,\r
+                          &ap_enable);\r
+\r
+       if (ap_enable) {\r
+               if (byte1 & BIT(4) && !(byte1 & BIT(5))) {\r
+                       real_byte1 &= ~BIT(4);\r
+                       real_byte1 |= BIT(5);\r
+\r
+                       real_byte5 |= BIT(5);\r
+                       real_byte5 &= ~BIT(6);\r
+               }\r
+       }\r
+\r
+       h2c_parameter[0] = real_byte1;\r
+       h2c_parameter[1] = byte2;\r
+       h2c_parameter[2] = byte3;\r
+       h2c_parameter[3] = byte4;\r
+       h2c_parameter[4] = real_byte5;\r
+\r
+       coex_dm->ps_tdma_para[0] = real_byte1;\r
+       coex_dm->ps_tdma_para[1] = byte2;\r
+       coex_dm->ps_tdma_para[2] = byte3;\r
+       coex_dm->ps_tdma_para[3] = byte4;\r
+       coex_dm->ps_tdma_para[4] = real_byte5;\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter);\r
+}\r
+\r
+\r
+void halbtc8723b1ant_ps_tdma(IN struct btc_coexist *btcoexist,\r
+                    IN boolean force_exec, IN boolean turn_on, IN u8 type)\r
+{\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean                 wifi_busy = false;\r
+       u8                      rssi_adjust_val = 0;\r
+       u8                      ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51,\r
+                               ps_tdma_byte3_val =  0x10;\r
+       s8                      wifi_duration_adjust = 0x0;\r
+       static boolean   pre_wifi_busy = false;\r
+\r
+       coex_dm->cur_ps_tdma_on = turn_on;\r
+       coex_dm->cur_ps_tdma = type;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+       if (board_info->btdm_ant_num_by_ant_det == 2) {\r
+               if (turn_on)\r
+                       type = type +\r
+                              100; /* for WiFi RSSI low or BT RSSI low */\r
+               else\r
+                       type = 1; /* always translate to TDMA(off,1) for TDMA-off case */\r
+       }\r
+       \r
+#endif \r
+#endif\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);        \r
+\r
+       if (wifi_busy != pre_wifi_busy) {\r
+               force_exec = true;\r
+                pre_wifi_busy = wifi_busy;\r
+       }\r
+                       \r
+       if (!force_exec) {\r
+               if( (coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) &&\r
+                       (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma) )\r
+                       return;\r
+       }\r
+\r
+       if (coex_sta->scan_ap_num <= 5) {\r
+               wifi_duration_adjust = 5;\r
+               \r
+               if (coex_sta->a2dp_bit_pool >= 35)\r
+                 wifi_duration_adjust = -10;\r
+               else if (coex_sta->a2dp_bit_pool >= 45)\r
+                 wifi_duration_adjust = -15;   \r
+       } else if (coex_sta->scan_ap_num >= 40) {\r
+               wifi_duration_adjust = -15;     \r
+\r
+               if (coex_sta->a2dp_bit_pool < 35)\r
+                 wifi_duration_adjust = -5;\r
+               else if (coex_sta->a2dp_bit_pool < 45)\r
+                 wifi_duration_adjust = -10; \r
+       } else if (coex_sta->scan_ap_num >= 20) {\r
+               wifi_duration_adjust = -10;     \r
+       \r
+               if (coex_sta->a2dp_bit_pool >= 45)\r
+                 wifi_duration_adjust = -15;\r
+       } else {\r
+               wifi_duration_adjust = 0;              \r
+               \r
+               if (coex_sta->a2dp_bit_pool >= 35)\r
+                 wifi_duration_adjust = -10;\r
+               else if (coex_sta->a2dp_bit_pool >= 45)\r
+                 wifi_duration_adjust = -15;   \r
+       }\r
+       \r
+       if ((type == 1) || (type == 2) || (type == 9) || (type == 11) ||\r
+           (type == 101)\r
+           || (type == 102) || (type == 109) || (type == 101)) {\r
+               if (!coex_sta->force_lps_on) { /* Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */\r
+                       ps_tdma_byte0_val = 0x61;  /* no null-pkt */\r
+                       ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */\r
+                       ps_tdma_byte4_val =\r
+                               0x10; /* 0x778 = d/1 toggle, no dynamic slot */\r
+               } else {\r
+                       ps_tdma_byte0_val = 0x51;  /* null-pkt */\r
+                       ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */\r
+                       ps_tdma_byte4_val =\r
+                               0x50; /* 0x778 = d/1 toggle, dynamic slot */\r
+               }\r
+       } else if ((type == 3) || (type == 13) || (type == 14) ||\r
+                  (type == 103) || (type == 113) || (type == 114)) {\r
+               ps_tdma_byte0_val = 0x51;  /* null-pkt */\r
+               ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */\r
+               ps_tdma_byte4_val =\r
+                       0x10; /* 0x778 = d/1 toggle, no dynamic slot */\r
+#if 0\r
+               if (!wifi_busy)\r
+                       ps_tdma_byte4_val = ps_tdma_byte4_val |\r
+                               0x1;  /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */\r
+#endif\r
+       } else { /* native power save case */\r
+               ps_tdma_byte0_val = 0x61;  /* no null-pkt */\r
+               ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */\r
+               ps_tdma_byte4_val =\r
+                       0x11; /* 0x778 = d/1 toggle, no dynamic slot */\r
+               /* psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case */\r
+       }\r
+\r
+       /* if (bt_link_info->slave_role == true) */\r
+       if ((bt_link_info->slave_role == true)  && (bt_link_info->a2dp_exist))\r
+               ps_tdma_byte4_val = ps_tdma_byte4_val |\r
+                       0x1;  /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */\r
+\r
+       if (type > 100) {\r
+               ps_tdma_byte0_val = ps_tdma_byte0_val |\r
+                                   0x82; /* set antenna control by SW   */\r
+               ps_tdma_byte3_val = ps_tdma_byte3_val |\r
+                       0x60;  /* set antenna no toggle, control by antenna diversity */\r
+       }\r
+               \r
+\r
+       if (turn_on) {\r
+               switch (type) {\r
+               default:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51,\r
+                                     0x1a, 0x1a, 0x0, ps_tdma_byte4_val);\r
+                       break;\r
+               case 1:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                                     ps_tdma_byte0_val, 0x3a +\r
+                                             wifi_duration_adjust, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 2:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                                     ps_tdma_byte0_val, 0x2d +\r
+                                             wifi_duration_adjust, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 3:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x30, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 4:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93,\r
+                                                     0x15, 0x3, 0x14, 0x0);\r
+                       break;\r
+               case 5:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x1f, 0x3,\r
+                                                     ps_tdma_byte3_val, 0x11);\r
+                       break;\r
+               case 6:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x20, 0x3,\r
+                                                     ps_tdma_byte3_val, 0x11);\r
+                       break;\r
+               case 7:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13,\r
+                                                     0xc, 0x5, 0x0, 0x0);\r
+                       break;\r
+               case 8:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93,\r
+                                                     0x25, 0x3, 0x10, 0x0);\r
+                       break;\r
+               case 9:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 10:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13,\r
+                                                     0xa, 0xa, 0x0, 0x40);\r
+                       break;\r
+               case 11:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 12:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51,\r
+                                                     0x0a, 0x0a, 0x0, 0x50);\r
+                       break;\r
+               case 13:\r
+                       if (coex_sta->scan_ap_num <= 3)\r
+                               halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x40, 0x3,\r
+                                                             ps_tdma_byte3_val,\r
+                                                     ps_tdma_byte4_val);\r
+                       else\r
+                               halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                                             ps_tdma_byte3_val,\r
+                                                     ps_tdma_byte4_val);\r
+                       break;\r
+               case 14:\r
+                       if (coex_sta->scan_ap_num <= 3)\r
+                               halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             0x51, 0x30, 0x3, 0x10, 0x50);\r
+                       else\r
+                               halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                                             ps_tdma_byte3_val,\r
+                                                     ps_tdma_byte4_val);\r
+                       break;\r
+               case 15:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13,\r
+                                                     0xa, 0x3, 0x8, 0x0);\r
+                       break;\r
+               case 16:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93,\r
+                                                     0x15, 0x3, 0x10, 0x0);\r
+                       break;\r
+               case 18:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93,\r
+                                                     0x25, 0x3, 0x10, 0x0);\r
+                       break;\r
+               case 20:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x3f, 0x03,\r
+                                                     ps_tdma_byte3_val, 0x10);\r
+                       break;\r
+               case 21:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x61,\r
+                                                     0x25, 0x03, 0x11, 0x11);\r
+                       break;\r
+               case 22:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x25, 0x03,\r
+                                                     ps_tdma_byte3_val, 0x10);\r
+                       break;\r
+               case 23:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3,\r
+                                                     0x25, 0x3, 0x31, 0x18);\r
+                       break;\r
+               case 24:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3,\r
+                                                     0x15, 0x3, 0x31, 0x18);\r
+                       break;\r
+               case 25:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3,\r
+                                                     0xa, 0x3, 0x31, 0x18);\r
+                       break;\r
+               case 26:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3,\r
+                                                     0xa, 0x3, 0x31, 0x18);\r
+                       break;\r
+               case 27:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3,\r
+                                                     0x25, 0x3, 0x31, 0x98);\r
+                       break;\r
+               case 28:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x69,\r
+                                                     0x25, 0x3, 0x31, 0x0);\r
+                       break;\r
+               case 29:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xab,\r
+                                                     0x1a, 0x1a, 0x1, 0x10);\r
+                       break;\r
+               case 30:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51,\r
+                                                     0x30, 0x3, 0x10, 0x10);\r
+                       break;\r
+               case 31:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3,\r
+                                                     0x1a, 0x1a, 0, 0x58);\r
+                       break;\r
+               case 32:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x35, 0x3,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 33:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x35, 0x3,\r
+                                                     ps_tdma_byte3_val, 0x10);\r
+                       break;\r
+               case 34:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x53,\r
+                                                     0x1a, 0x1a, 0x0, 0x10);\r
+                       break;\r
+               case 35:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x63,\r
+                                                     0x1a, 0x1a, 0x0, 0x10);\r
+                       break;\r
+               case 36:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3,\r
+                                                     0x12, 0x3, 0x14, 0x50);\r
+                       break;\r
+               case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */\r
+                       /* here softap mode screen off will cost 70-80mA for phone */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x23,\r
+                                                     0x18, 0x00, 0x10, 0x24);\r
+                       break;\r
+\r
+               /* for 1-Ant translate to 2-Ant  */\r
+               case 101:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                                     ps_tdma_byte0_val, 0x3a +\r
+                                             wifi_duration_adjust, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 102:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                                     ps_tdma_byte0_val, 0x2d +\r
+                                             wifi_duration_adjust, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 103:\r
+                       /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x3a, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 105:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x15, 0x3,\r
+                                                     ps_tdma_byte3_val, 0x11);\r
+                       break;\r
+               case 106:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x20, 0x3,\r
+                                                     ps_tdma_byte3_val, 0x11);\r
+                       break;\r
+               case 109:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 111:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 113:\r
+                       /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x12, 0x12, 0x0, ps_tdma_byte4_val); */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 114:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x21, 0x3,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 120:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x3f, 0x03,\r
+                                                     ps_tdma_byte3_val, 0x10);\r
+                       break;\r
+               case 122:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x25, 0x03,\r
+                                                     ps_tdma_byte3_val, 0x10);\r
+                       break;\r
+               case 132:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x25, 0x03,\r
+                                     ps_tdma_byte3_val, ps_tdma_byte4_val);\r
+                       break;\r
+               case 133:\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist,\r
+                                             ps_tdma_byte0_val, 0x25, 0x03,\r
+                                                     ps_tdma_byte3_val, 0x11);\r
+                       break;\r
+\r
+               }\r
+       } else {\r
+\r
+               /* disable PS tdma */\r
+               switch (type) {\r
+               case 8: /* PTA Control */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x8,\r
+                                                     0x0, 0x0, 0x0, 0x0);\r
+                       break;\r
+               case 0:\r
+               default:  /* Software control, Antenna at BT side */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0,\r
+                                                     0x0, 0x0, 0x0, 0x0);\r
+                       break;\r
+               case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */\r
+                       halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0,\r
+                                                     0x0, 0x0, 0x48, 0x0);\r
+                       break;\r
+               }\r
+       }\r
+       rssi_adjust_val = 0;\r
+       btcoexist->btc_set(btcoexist,\r
+               BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val);\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+               "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+                   btcoexist->btc_read_4byte(btcoexist, 0x948),\r
+                   btcoexist->btc_read_1byte(btcoexist, 0x765),\r
+                   btcoexist->btc_read_1byte(btcoexist, 0x67));\r
+       BTC_TRACE(trace_buf);\r
+\r
+       /* update pre state */\r
+       coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on;\r
+       coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma;\r
+}\r
+\r
+void halbtc8723b1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist\r
+               *btcoexist, IN u8 wifi_status)\r
+{\r
+       static s32              up, dn, m, n, wait_count;\r
+       s32                     result;   /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */\r
+       u8                      retry_count = 0, bt_info_ext;\r
+       boolean                 wifi_busy = false;\r
+\r
+       if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status)\r
+               wifi_busy = true;\r
+       else\r
+               wifi_busy = false;\r
+\r
+       if ((BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN ==\r
+            wifi_status) ||\r
+           (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) ||\r
+           (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT ==\r
+            wifi_status)) {\r
+               if (coex_dm->cur_ps_tdma != 1 &&\r
+                   coex_dm->cur_ps_tdma != 2 &&\r
+                   coex_dm->cur_ps_tdma != 3 &&\r
+                   coex_dm->cur_ps_tdma != 9) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               9);\r
+                       coex_dm->ps_tdma_du_adj_type = 9;\r
+\r
+                       up = 0;\r
+                       dn = 0;\r
+                       m = 1;\r
+                       n = 3;\r
+                       result = 0;\r
+                       wait_count = 0;\r
+               }\r
+               return;\r
+       }\r
+\r
+       if (!coex_dm->auto_tdma_adjust) {\r
+               coex_dm->auto_tdma_adjust = true;\r
+\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2);\r
+               coex_dm->ps_tdma_du_adj_type = 2;\r
+               /* ============ */\r
+               up = 0;\r
+               dn = 0;\r
+               m = 1;\r
+               n = 3;\r
+               result = 0;\r
+               wait_count = 0;\r
+       } else {\r
+               /* accquire the BT TRx retry count from BT_Info byte2 */\r
+               retry_count = coex_sta->bt_retry_cnt;\r
+               bt_info_ext = coex_sta->bt_info_ext;\r
+\r
+               if ((coex_sta->low_priority_tx) > 1050 ||\r
+                   (coex_sta->low_priority_rx) > 1250)\r
+                       retry_count++;\r
+\r
+               result = 0;\r
+               wait_count++;\r
+\r
+               if (retry_count ==\r
+                   0) { /* no retry in the last 2-second duration */\r
+                       up++;\r
+                       dn--;\r
+\r
+                       if (dn <= 0)\r
+                               dn = 0;\r
+\r
+                       if (up >= n) {  /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */\r
+                               wait_count = 0;\r
+                               n = 3;\r
+                               up = 0;\r
+                               dn = 0;\r
+                               result = 1;\r
+                       }\r
+               } else if (retry_count <=\r
+                          3) { /* <=3 retry in the last 2-second duration */\r
+                       up--;\r
+                       dn++;\r
+\r
+                       if (up <= 0)\r
+                               up = 0;\r
+\r
+                       if (dn == 2) {  /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */\r
+                               if (wait_count <= 2)\r
+                                       m++; /* to avoid loop between the two levels */\r
+                               else\r
+                                       m = 1;\r
+\r
+                               if (m >= 20)  /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */\r
+                                       m = 20;\r
+\r
+                               n = 3 * m;\r
+                               up = 0;\r
+                               dn = 0;\r
+                               wait_count = 0;\r
+                               result = -1;\r
+                       }\r
+               } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */\r
+                       if (wait_count == 1)\r
+                               m++; /* to avoid loop between the two levels */\r
+                       else\r
+                               m = 1;\r
+\r
+                       if (m >= 20)  /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */\r
+                               m = 20;\r
+\r
+                       n = 3 * m;\r
+                       up = 0;\r
+                       dn = 0;\r
+                       wait_count = 0;\r
+                       result = -1;\r
+               }\r
+\r
+               if (result == -1) {\r
+                       /*              if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) &&\r
+                                               ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) )\r
+                                       {\r
+                                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9);\r
+                                               coex_dm->ps_tdma_du_adj_type = 9;\r
+                                       }\r
+                                       else */ if (coex_dm->cur_ps_tdma == 1) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 2);\r
+                               coex_dm->ps_tdma_du_adj_type = 2;\r
+                       } else if (coex_dm->cur_ps_tdma == 2) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 9);\r
+                               coex_dm->ps_tdma_du_adj_type = 9;\r
+                       } else if (coex_dm->cur_ps_tdma == 9) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 11);\r
+                               coex_dm->ps_tdma_du_adj_type = 11;\r
+                       }\r
+               } else if (result == 1) {\r
+                       /*                      if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) &&\r
+                                                       ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) )\r
+                                               {\r
+                                                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9);\r
+                                                       coex_dm->ps_tdma_du_adj_type = 9;\r
+                                               }\r
+                                               else */ if (coex_dm->cur_ps_tdma == 11) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 9);\r
+                               coex_dm->ps_tdma_du_adj_type = 9;\r
+                       } else if (coex_dm->cur_ps_tdma == 9) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 2);\r
+                               coex_dm->ps_tdma_du_adj_type = 2;\r
+                       } else if (coex_dm->cur_ps_tdma == 2) {\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC,\r
+                                                       true, 1);\r
+                               coex_dm->ps_tdma_du_adj_type = 1;\r
+                       }\r
+               } else { /* no change */\r
+                       /* Bryant Modify\r
+                       if(wifi_busy != pre_wifi_busy)\r
+                       {\r
+                               pre_wifi_busy = wifi_busy;\r
+                               halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma);\r
+                       }\r
+                       */\r
+\r
+               }\r
+\r
+               if (coex_dm->cur_ps_tdma != 1 &&\r
+                   coex_dm->cur_ps_tdma != 2 &&\r
+                   coex_dm->cur_ps_tdma != 9 &&\r
+                   coex_dm->cur_ps_tdma != 11) {\r
+                       /* recover to previous adjust type */\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               coex_dm->ps_tdma_du_adj_type);\r
+               }\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_ps_tdma_check_for_power_save_state(\r
+       IN struct btc_coexist *btcoexist, IN boolean new_ps_state)\r
+{\r
+       u8      lps_mode = 0x0;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode);\r
+\r
+       if (lps_mode) { /* already under LPS state */\r
+               if (new_ps_state) {\r
+                       /* keep state under LPS, do nothing. */\r
+               } else {\r
+                       /* will leave LPS state, turn off psTdma first */\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,\r
+                                               8);\r
+               }\r
+       } else {                                        /* NO PS state */\r
+               if (new_ps_state) {\r
+                       /* will enter LPS state, turn off psTdma first */\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,\r
+                                               8);\r
+               } else {\r
+                       /* keep state under NO PS state, do nothing. */\r
+               }\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_power_save_state(IN struct btc_coexist *btcoexist,\r
+                             IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val)\r
+{\r
+       boolean         low_pwr_disable = false;\r
+\r
+       switch (ps_type) {\r
+       case BTC_PS_WIFI_NATIVE:\r
+               /* recover to original 32k low power setting */\r
+               low_pwr_disable = false;\r
+               btcoexist->btc_set(btcoexist,\r
+                                  BTC_SET_ACT_DISABLE_LOW_POWER,\r
+                                  &low_pwr_disable);\r
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS,\r
+                                  NULL);\r
+               coex_sta->force_lps_on = false;\r
+               break;\r
+       case BTC_PS_LPS_ON:\r
+               halbtc8723b1ant_ps_tdma_check_for_power_save_state(\r
+                       btcoexist, true);\r
+               halbtc8723b1ant_lps_rpwm(btcoexist, NORMAL_EXEC,\r
+                                        lps_val, rpwm_val);\r
+               /* when coex force to enter LPS, do not enter 32k low power. */\r
+               low_pwr_disable = true;\r
+               btcoexist->btc_set(btcoexist,\r
+                                  BTC_SET_ACT_DISABLE_LOW_POWER,\r
+                                  &low_pwr_disable);\r
+               /* power save must executed before psTdma.                       */\r
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS,\r
+                                  NULL);\r
+               coex_sta->force_lps_on = true;\r
+               break;\r
+       case BTC_PS_LPS_OFF:\r
+               halbtc8723b1ant_ps_tdma_check_for_power_save_state(\r
+                       btcoexist, false);\r
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS,\r
+                                  NULL);\r
+               coex_sta->force_lps_on = false;\r
+               break;\r
+       default:\r
+               break;\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_only(IN struct btc_coexist *btcoexist)\r
+{\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0);\r
+       halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8);\r
+       halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC,\r
+                                    false, false);\r
+}\r
+\r
+void halbtc8723b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist)\r
+{\r
+       static u32              bt_disable_cnt = 0;\r
+       boolean                 bt_active = true, bt_disabled = false;\r
+\r
+       /* This function check if bt is disabled */\r
+\r
+       if (coex_sta->high_priority_tx == 0 &&\r
+           coex_sta->high_priority_rx == 0 &&\r
+           coex_sta->low_priority_tx == 0 &&\r
+           coex_sta->low_priority_rx == 0)\r
+               bt_active = false;\r
+       if (coex_sta->high_priority_tx == 0xffff &&\r
+           coex_sta->high_priority_rx == 0xffff &&\r
+           coex_sta->low_priority_tx == 0xffff &&\r
+           coex_sta->low_priority_rx == 0xffff)\r
+               bt_active = false;\r
+       if (bt_active) {\r
+               bt_disable_cnt = 0;\r
+               bt_disabled = false;\r
+       } else {\r
+               bt_disable_cnt++;\r
+               if (bt_disable_cnt >= 2)\r
+                       bt_disabled = true;\r
+       }\r
+       if (coex_sta->bt_disabled != bt_disabled) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], BT is from %s to %s!!\n",\r
+                           (coex_sta->bt_disabled ? "disabled" : "enabled"),\r
+                           (bt_disabled ? "disabled" : "enabled"));\r
+               BTC_TRACE(trace_buf);\r
+\r
+               coex_sta->bt_disabled = bt_disabled;\r
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE,\r
+                                  &bt_disabled);\r
+               if (bt_disabled) {\r
+                       halbtc8723b1ant_action_wifi_only(btcoexist);\r
+                       btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS,\r
+                                          NULL);\r
+                       btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS,\r
+                                          NULL);\r
+               }\r
+       }\r
+}\r
+\r
+/* *********************************************\r
+ *\r
+ *     Non-Software Coex Mechanism start\r
+ *\r
+ * ********************************************* */\r
+void halbtc8723b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist)\r
+{\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+       halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC,\r
+                                    false, false);\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist)\r
+{\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+       halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC,\r
+                                    false, false);\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+}\r
+\r
+void halbtc8723b1ant_action_hs(IN struct btc_coexist *btcoexist)\r
+{\r
+       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5);\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+}\r
+\r
+void halbtc8723b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean                 wifi_connected = false, ap_enable = false, wifi_busy = false,\r
+                               bt_busy = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE,\r
+                          &ap_enable);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                          &wifi_connected);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy);\r
+\r
+       if (coex_sta->bt_abnormal_scan) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               33);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);                                \r
+       } else if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) {\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);\r
+       } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) ||\r
+                  (bt_link_info->a2dp_exist)) {\r
+               /* SCO/HID/A2DP  busy */\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+\r
+               if (coex_sta->c2h_bt_remote_name_req)\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               33);\r
+               else\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+       } else if ((bt_link_info->pan_exist) || (wifi_busy)) {\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+\r
+               if (coex_sta->c2h_bt_remote_name_req)\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               33);\r
+               else\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+       } else {\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);\r
+\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist\r
+               *btcoexist, IN u8 wifi_status)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean wifi_connected = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                          &wifi_connected);\r
+\r
+       /* tdma and coex table */\r
+\r
+       if (bt_link_info->sco_exist) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5);\r
+       } else { /* HID */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5);\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist\r
+               *btcoexist, IN u8 wifi_status)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+\r
+       if ((coex_sta->low_priority_rx >= 950)  && (!coex_sta->under_ips))\r
+               bt_link_info->slave_role = true;\r
+       else\r
+               bt_link_info->slave_role = false;\r
+\r
+       if (bt_link_info->hid_only) { /* HID */\r
+               halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist,\r
+                               wifi_status);\r
+               coex_dm->auto_tdma_adjust = false;\r
+               return;\r
+       } else if (bt_link_info->a2dp_only) { /* A2DP            */\r
+               if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+                       coex_dm->auto_tdma_adjust = false;\r
+               } else {\r
+                       halbtc8723b1ant_tdma_duration_adjust_for_acl(btcoexist,\r
+                                       wifi_status);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+                       coex_dm->auto_tdma_adjust = true;\r
+               }\r
+       } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) ||\r
+                  (bt_link_info->hid_exist && bt_link_info->a2dp_exist &&\r
+               bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+               coex_dm->auto_tdma_adjust = false;\r
+       } else if (bt_link_info->hid_exist &&\r
+                  bt_link_info->a2dp_exist) { /* HID+A2DP */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14);\r
+               coex_dm->auto_tdma_adjust = false;\r
+\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+       } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist &&\r
+               bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP)                    */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+               coex_dm->auto_tdma_adjust = false;\r
+       } else {\r
+               /* BT no-profile busy (0x9) */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+               coex_dm->auto_tdma_adjust = false;\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist)\r
+{\r
+       /* power save state */\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       /* tdma and coex table */\r
+       halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8);\r
+       halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC,\r
+                                    false, false);\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_not_connected_scan(IN struct btc_coexist\r
+               *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       /* tdma and coex table */\r
+       if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) {\r
+               if (bt_link_info->a2dp_exist) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               } else if (bt_link_info->a2dp_exist &&\r
+                          bt_link_info->pan_exist) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               22);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               } else {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               20);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               }\r
+       } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||\r
+                  (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY ==\r
+                   coex_dm->bt_status)) {\r
+               halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN);\r
+       } else {\r
+               /* Bryant Add */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_not_connected_asso_auth(\r
+       IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       /* tdma and coex table */\r
+       if ((bt_link_info->sco_exist)  || (bt_link_info->hid_exist) ||\r
+           (bt_link_info->a2dp_exist)) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4);\r
+       } else if (bt_link_info->pan_exist) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4);\r
+       } else {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2);\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_connected_scan(IN struct btc_coexist\r
+               *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       /* tdma and coex table */\r
+       if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) {\r
+               if (bt_link_info->a2dp_exist) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               } else if (bt_link_info->a2dp_exist &&\r
+                          bt_link_info->pan_exist) {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               22);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               } else {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               20);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+               }\r
+       } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||\r
+                  (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY ==\r
+                   coex_dm->bt_status)) {\r
+               halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN);\r
+       } else {\r
+               /* Bryant Add */\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_connected_specific_packet(\r
+       IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean wifi_busy = false;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+\r
+       /* no specific packet process for both WiFi and BT very busy */\r
+       if ((wifi_busy) && ((bt_link_info->pan_exist) ||\r
+                           (coex_sta->num_of_profile >= 2)))\r
+               return;\r
+\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+\r
+       /* tdma and coex table */\r
+       if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5);\r
+       } else if (bt_link_info->a2dp_exist) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+       } else if (bt_link_info->pan_exist) {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);\r
+       } else {\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            NORMAL_EXEC, false, false);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist)\r
+{\r
+       boolean wifi_busy = false;\r
+       boolean         scan = false, link = false, roam = false;\r
+       boolean         under_4way = false, ap_enable = false;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "[BTCoex], CoexForWifiConnect()===>\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,\r
+                          &under_4way);\r
+       if (under_4way) {\r
+               halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist);\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n");\r
+               BTC_TRACE(trace_buf);\r
+               return;\r
+       }\r
+       \r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);\r
+       if (scan || link || roam) {\r
+               if (scan)\r
+                       halbtc8723b1ant_action_wifi_connected_scan(btcoexist);\r
+               else\r
+                       halbtc8723b1ant_action_wifi_connected_specific_packet(\r
+                               btcoexist);\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n");\r
+               BTC_TRACE(trace_buf);\r
+               return;\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE,\r
+                          &ap_enable);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+       \r
+       /* power save state */\r
+       if (!ap_enable &&\r
+           BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status &&\r
+           !btcoexist->bt_link_info.hid_only) {\r
+               if (btcoexist->bt_link_info.a2dp_only) {        /* A2DP */\r
+                       if (!wifi_busy)\r
+                               halbtc8723b1ant_power_save_state(btcoexist,\r
+                                                BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+                       else { /* busy */\r
+                               if (coex_sta->scan_ap_num >=\r
+                                   BT_8723B_1ANT_WIFI_NOISY_THRESH)  /* no force LPS, no PS-TDMA, use pure TDMA */\r
+                                       halbtc8723b1ant_power_save_state(\r
+                                               btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                               0x0, 0x0);\r
+                               else\r
+                                       halbtc8723b1ant_power_save_state(\r
+                                               btcoexist, BTC_PS_LPS_ON, 0x50,\r
+                                               0x4);\r
+                       }\r
+               } else if ((coex_sta->pan_exist == false) &&\r
+                          (coex_sta->a2dp_exist == false) &&\r
+                          (coex_sta->hid_exist == false))\r
+                       halbtc8723b1ant_power_save_state(btcoexist,\r
+                                                BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               else\r
+                       halbtc8723b1ant_power_save_state(btcoexist,\r
+                                                BTC_PS_LPS_ON, 0x50, 0x4);\r
+       } else\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+\r
+       /* tdma and coex table */\r
+       if (!wifi_busy) {\r
+               if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) {\r
+                       halbtc8723b1ant_action_wifi_connected_bt_acl_busy(\r
+                               btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);\r
+               } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY ==\r
+                           coex_dm->bt_status) ||\r
+                          (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY ==\r
+                           coex_dm->bt_status)) {\r
+                       halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);\r
+               } else {\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,\r
+                                               8);\r
+                       halbtc8723b1ant_set_ant_path(btcoexist,\r
+                               BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false);\r
+                       /* if ((coex_sta->high_priority_tx) +\r
+                           (coex_sta->high_priority_rx) <= 60) */\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 2);\r
+                       /* else\r
+                               halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 7); */\r
+               }\r
+       } else {\r
+               if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) {\r
+                       halbtc8723b1ant_action_wifi_connected_bt_acl_busy(\r
+                               btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY);\r
+               } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY ==\r
+                           coex_dm->bt_status) ||\r
+                          (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY ==\r
+                           coex_dm->bt_status)) {\r
+                       halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY);\r
+               } else {\r
+                       /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,\r
+                                               8);\r
+                       halbtc8723b1ant_set_ant_path(btcoexist,\r
+                               BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false);\r
+                       if ((coex_sta->high_priority_tx) +\r
+                           (coex_sta->high_priority_rx) <= 60)\r
+                               halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 2);\r
+                       else\r
+                               halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 7); */\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true,\r
+                                               32);\r
+                       halbtc8723b1ant_set_ant_path(btcoexist,\r
+                               BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false);\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            NORMAL_EXEC, 4);\r
+\r
+               }\r
+       }\r
+}\r
+\r
+void halbtc8723b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;\r
+       boolean wifi_connected = false, bt_hs_on = false, wifi_busy = false;\r
+       boolean increase_scan_dev_num = false;\r
+       boolean bt_ctrl_agg_buf_size = false;\r
+       boolean miracast_plus_bt = false;\r
+       u8      agg_buf_size = 5;\r
+       u32     wifi_link_status = 0;\r
+       u32     num_of_wifi_link = 0, wifi_bw;\r
+       u8      iot_peer = BTC_IOT_PEER_UNKNOWN;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "[BTCoex], RunCoexistMechanism()===>\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       if (btcoexist->manual_control) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n");\r
+               BTC_TRACE(trace_buf);\r
+               return;\r
+       }\r
+\r
+       if (btcoexist->stop_coex_dm) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n");\r
+               BTC_TRACE(trace_buf);\r
+               return;\r
+       }\r
+\r
+       if (coex_sta->under_ips) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], wifi is under IPS !!!\n");\r
+               BTC_TRACE(trace_buf);\r
+               return;\r
+       }\r
+\r
+       if (coex_sta->bt_whck_test) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], BT is under WHCK TEST!!!\n");\r
+               BTC_TRACE(trace_buf);\r
+               halbtc8723b1ant_action_bt_whck_test(btcoexist);\r
+               return;\r
+       }\r
+\r
+       if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) ||\r
+           (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||\r
+           (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status))\r
+               increase_scan_dev_num = true;\r
+\r
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM,\r
+                          &increase_scan_dev_num);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                          &wifi_connected);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,\r
+                          &wifi_link_status);\r
+       num_of_wifi_link = wifi_link_status >> 16;\r
+\r
+       if ((num_of_wifi_link >= 2) ||\r
+           (wifi_link_status & WIFI_P2P_GO_CONNECTED)) {\r
+               if (bt_link_info->bt_link_exist) {\r
+                       halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1,\r
+                                                  0, 1);\r
+                       miracast_plus_bt = true;\r
+               } else {\r
+                       halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0,\r
+                                                  0, 0);\r
+                       miracast_plus_bt = false;\r
+               }\r
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,\r
+                                  &miracast_plus_bt);\r
+               halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false,\r
+                                          bt_ctrl_agg_buf_size, agg_buf_size);\r
+\r
+               if (((bt_link_info->a2dp_exist) || (wifi_busy)) &&\r
+                   (coex_sta->c2h_bt_inquiry_page))\r
+                       halbtc8723b1ant_action_bt_inquiry(btcoexist);\r
+               else\r
+                       halbtc8723b1ant_action_wifi_multi_port(btcoexist);\r
+\r
+               return;\r
+       } else {\r
+               miracast_plus_bt = false;\r
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,\r
+                                  &miracast_plus_bt);\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw);\r
+\r
+       if ((bt_link_info->bt_link_exist) && (wifi_connected)) {\r
+               halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1);\r
+\r
+               btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer);\r
+\r
+               /* if(BTC_IOT_PEER_CISCO != iot_peer)            */\r
+               if ((BTC_IOT_PEER_CISCO != iot_peer) &&\r
+                   (BTC_IOT_PEER_BROADCOM != iot_peer)) {\r
+                       if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */\r
+                               /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, true, false, 0x5);                                 */\r
+                               halbtc8723b1ant_limited_rx(btcoexist,\r
+                                          NORMAL_EXEC, false, false, 0x5);\r
+                       else\r
+                               halbtc8723b1ant_limited_rx(btcoexist,\r
+                                          NORMAL_EXEC, false, false, 0x5);\r
+                       /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8);                 */\r
+               } else {\r
+                       if (bt_link_info->sco_exist)\r
+                               halbtc8723b1ant_limited_rx(btcoexist,\r
+                                          NORMAL_EXEC, true, false, 0x5);\r
+                       else {\r
+                               if (BTC_WIFI_BW_HT40 == wifi_bw)\r
+                                       halbtc8723b1ant_limited_rx(btcoexist,\r
+                                               NORMAL_EXEC, false, true, 0x10);\r
+                               else\r
+                                       halbtc8723b1ant_limited_rx(btcoexist,\r
+                                               NORMAL_EXEC, false, true, 0x8);\r
+                       }\r
+               }\r
+\r
+               halbtc8723b1ant_sw_mechanism(btcoexist, true);\r
+       } else {\r
+               halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+\r
+               halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false,\r
+                                          0x5);\r
+\r
+               halbtc8723b1ant_sw_mechanism(btcoexist, false);\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+       if (coex_sta->c2h_bt_inquiry_page) {\r
+               halbtc8723b1ant_action_bt_inquiry(btcoexist);\r
+               return;\r
+       } else if (bt_hs_on) {\r
+               halbtc8723b1ant_action_hs(btcoexist);\r
+               return;\r
+       }\r
+\r
+\r
+       if (!wifi_connected) {\r
+               boolean scan = false, link = false, roam = false;\r
+\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], wifi is non connected-idle !!!\n");\r
+               BTC_TRACE(trace_buf);\r
+\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);\r
+\r
+               if (scan || link || roam) {\r
+                       if (scan)\r
+                               halbtc8723b1ant_action_wifi_not_connected_scan(\r
+                                       btcoexist);\r
+                       else\r
+                               halbtc8723b1ant_action_wifi_not_connected_asso_auth(\r
+                                       btcoexist);\r
+               } else\r
+                       halbtc8723b1ant_action_wifi_not_connected(btcoexist);\r
+       } else  /* wifi LPS/Busy */\r
+               halbtc8723b1ant_action_wifi_connected(btcoexist);\r
+}\r
+\r
+void halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist)\r
+{\r
+       /* force to reset coex mechanism */\r
+\r
+       /* sw all off */\r
+       halbtc8723b1ant_sw_mechanism(btcoexist, false);\r
+\r
+       /* halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */\r
+       /* halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */\r
+\r
+       coex_sta->pop_event_cnt = 0;\r
+}\r
+\r
+void halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist,\r
+                                   IN boolean back_up, IN boolean wifi_only)\r
+{\r
+       u32                             u32tmp = 0; /* , fw_ver; */\r
+       u8                              u8tmpa = 0, u8tmpb = 0;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "[BTCoex], 1Ant Init HW Config!!\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       psd_scan->ant_det_is_ant_det_available = false;\r
+\r
+       /* 0xf0[15:12] --> Chip Cut information */\r
+       coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist,\r
+                                0xf1) & 0xf0) >> 4;\r
+\r
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8,\r
+                                          0x1);  /* enable TBTT nterrupt */\r
+\r
+       /* 0x790[5:0]=0x5        */\r
+       btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5);\r
+\r
+       /* Enable counter statistics */\r
+       /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA */\r
+       btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1);\r
+       btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1);\r
+\r
+\r
+       /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi */\r
+\r
+       halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8);\r
+\r
+       /* Antenna config */\r
+       if (wifi_only)\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI,\r
+                                            FORCE_EXEC, true, false);\r
+       else\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT,\r
+                                            FORCE_EXEC, true, false);\r
+\r
+       /* PTA parameter */\r
+       halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0);\r
+\r
+       u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948);\r
+       u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765);\r
+       u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67);\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+               "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+                   u32tmp,  u8tmpa, u8tmpb);\r
+       BTC_TRACE(trace_buf);\r
+}\r
+\r
+void halbtc8723b1ant_mechanism_switch(IN struct btc_coexist *btcoexist,\r
+                                     IN boolean bSwitchTo2Antenna)\r
+{\r
+\r
+       if (bSwitchTo2Antenna) { /* 1-Ant -> 2-Ant */\r
+               /* un-lock TRx Mask setup for 8723b f-cut */\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x1);\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x1);\r
+               /* WiFi TRx Mask on                              */\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff,\r
+                                         0x0);\r
+\r
+               /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c,\r
+                                         0x7c45);\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30,\r
+                                         0x7c45);\r
+\r
+               /* BT TRx Mask on */\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x1);\r
+\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT,\r
+                                            FORCE_EXEC, false, false);\r
+       } else {\r
+               /* WiFi TRx Mask on                              */\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff,\r
+                                         0x780);\r
+\r
+               /* lock TRx Mask setup for 8723b f-cut */\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x0);\r
+               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x0);\r
+\r
+               /* BT TRx Mask on */\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15);\r
+\r
+               /* BT TRx Mask ock 0x2c[0], 0x30[0]  = 0 */\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c,\r
+                                         0x7c44);\r
+               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30,\r
+                                         0x7c44);\r
+\r
+\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            FORCE_EXEC, false, false);\r
+       }\r
+\r
+}\r
+\r
+u32 halbtc8723b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val)\r
+{\r
+       u8      j;\r
+       u32     tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0;\r
+       u32     result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200,\r
+                                  174, 151, 132, 115, 100, 86, 74, 62, 51, 42,\r
+                                                          32, 23, 15, 7, 0\r
+                                                             };\r
+\r
+       if (val == 0)\r
+               return 0;\r
+\r
+       tmp = val;\r
+\r
+       while (1) {\r
+               if (tmp == 1)\r
+                       break;\r
+               else {\r
+                       tmp = (tmp >> 1);\r
+                       shiftcount++;\r
+               }\r
+       }\r
+\r
+\r
+       val_integerd_b = shiftcount + 1;\r
+\r
+       tmp2 = 1;\r
+       for (j = 1; j <= val_integerd_b; j++)\r
+               tmp2 = tmp2 * 2;\r
+\r
+       tmp = (val * 100) / tmp2;\r
+       tindex = tmp / 5;\r
+\r
+       if (tindex > 20)\r
+               tindex = 20;\r
+\r
+       val_fractiond_b = table_fraction[tindex];\r
+\r
+       result = val_integerd_b * 100 - val_fractiond_b;\r
+\r
+       return result;\r
+\r
+\r
+}\r
+\r
+void halbtc8723b1ant_psd_show_antenna_detect_result(IN struct btc_coexist\r
+               *btcoexist)\r
+{      \r
+       u8              *cli_buf = btcoexist->cli_buf;\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       \r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n============[Antenna Detection info]  ============\n");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       if (psd_scan->ant_det_result == 1)\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)",\r
+                          "Ant Det Result", "2-Antenna (Bad-Isolation)",\r
+                          BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);\r
+       else if (psd_scan->ant_det_result == 2)\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",\r
+                          "Ant Det Result", "2-Antenna (Good-Isolation)",\r
+                          BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION\r
+                          + psd_scan->ant_det_thres_offset,\r
+                          BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);\r
+       else\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",\r
+                          "Ant Det Result", "1-Antenna",\r
+                          BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT,\r
+                          BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION\r
+                          + psd_scan->ant_det_thres_offset);\r
+\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ",\r
+                  "Antenna Detection Finish",\r
+                  (board_info->btdm_ant_det_finish\r
+                   ? "Yes" : "No"));\r
+       CL_PRINTF(cli_buf);\r
+\r
+       switch (psd_scan->ant_det_result) {\r
+       case 0:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is not available)");\r
+               break;\r
+       case 1:  /* 2-Ant bad-isolation */\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is available)");\r
+               break;\r
+       case 2:  /* 2-Ant good-isolation */\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is available)");\r
+               break;\r
+       case 3:  /* 1-Ant */\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is available)");\r
+               break;\r
+       case 4:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(Uncertainty result)");\r
+               break;\r
+       case 5:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)");\r
+               break;\r
+       case 6:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(WiFi is Scanning)");\r
+               break;\r
+       case 7:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is not idle)");\r
+               break;\r
+       case 8:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(Abort by WiFi Scanning)");\r
+               break;\r
+       case 9:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(Antenna Init is not ready)");\r
+               break;\r
+       case 10:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is Inquiry or page)");\r
+               break;\r
+       case 11:\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "(BT is Disabled)");\r
+               break;\r
+       }\r
+       CL_PRINTF(cli_buf);     \r
+\r
+       \r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "Ant Detect Total Count", psd_scan->ant_det_try_count);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "Ant Detect Fail Count", psd_scan->ant_det_fail_count);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       if ((!board_info->btdm_ant_det_finish) &&\r
+           (psd_scan->ant_det_result != 5))\r
+               return;\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response",\r
+                  (psd_scan->ant_det_result ? "ok" : "fail"));\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time",\r
+                  psd_scan->ant_det_bt_tx_time);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch",\r
+                  psd_scan->ant_det_bt_le_channel);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d",\r
+                  "WiFi PSD Cent-Ch/Offset/Span",\r
+                  psd_scan->real_cent_freq, psd_scan->real_offset,\r
+                  psd_scan->real_span);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB",\r
+                  "PSD Pre-Scan Peak Value",\r
+                  psd_scan->ant_det_pre_psdscan_peak_val / 100);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)",\r
+                  "PSD Pre-Scan result",\r
+                  (psd_scan->ant_det_result != 5 ? "ok" : "fail"),\r
+                  BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND\r
+                  + psd_scan->ant_det_thres_offset);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       if (psd_scan->ant_det_result == 5)\r
+               return;\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB",\r
+                  "PSD Scan Peak Value", psd_scan->ant_det_peak_val);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz",\r
+                  "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq);\r
+       CL_PRINTF(cli_buf);\r
+\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package",\r
+                  (board_info->tfbga_package) ?  "Yes" : "No");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "PSD Threshold Offset", psd_scan->ant_det_thres_offset);\r
+       CL_PRINTF(cli_buf);\r
+\r
+}\r
+\r
+void halbtc8723b1ant_psd_showdata(IN struct btc_coexist *btcoexist)\r
+{\r
+       u8              *cli_buf = btcoexist->cli_buf;\r
+       u32             delta_freq_per_point;\r
+       u32             freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2;\r
+       \r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n\n============[PSD info]  (%d)============\n",\r
+                  psd_scan->psd_gen_count);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       if (psd_scan->psd_gen_count == 0) {\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n");\r
+               CL_PRINTF(cli_buf);\r
+               return;\r
+       }\r
+\r
+       if (psd_scan->psd_point == 0)\r
+               delta_freq_per_point = 0;\r
+       else\r
+               delta_freq_per_point = psd_scan->psd_band_width /\r
+                                      psd_scan->psd_point;\r
+\r
+       /* if (psd_scan->is_psd_show_max_only) */\r
+       if (0) {\r
+               psd_rep1 = psd_scan->psd_max_value / 100;\r
+               psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100;\r
+\r
+               freq = ((psd_scan->real_cent_freq - 20) * 1000000 +\r
+                       psd_scan->psd_max_value_point * delta_freq_per_point);\r
+               freq1 = freq / 1000000;\r
+               freq2 = freq / 1000 - freq1 * 1000;\r
+\r
+               if (freq2 < 100)\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                  "\r\n Freq = %d.0%d MHz",\r
+                                  freq1, freq2);\r
+               else\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                  "\r\n Freq = %d.%d MHz",\r
+                                  freq1, freq2);\r
+\r
+               if (psd_rep2 < 10)\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                  ", Value = %d.0%d dB, (%d)\n",\r
+                                  psd_rep1, psd_rep2, psd_scan->psd_max_value);\r
+               else\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                  ", Value = %d.%d dB, (%d)\n",\r
+                                  psd_rep1, psd_rep2, psd_scan->psd_max_value);\r
+\r
+               CL_PRINTF(cli_buf);\r
+       } else {\r
+               m = psd_scan->psd_start_point;\r
+               n = psd_scan->psd_start_point;\r
+               i = 1;\r
+               j = 1;\r
+\r
+               while (1) {\r
+                       do {\r
+                               freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m *\r
+                                       delta_freq_per_point);\r
+                               freq1 = freq / 1000000;\r
+                               freq2 = freq / 1000 - freq1 * 1000;\r
+\r
+                               if (i == 1) {\r
+                                       if (freq2 == 0)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "\r\n Freq%6d.000", freq1);\r
+                                       else if (freq2 < 100)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "\r\n Freq%6d.0%2d", freq1,\r
+                                                          freq2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "\r\n Freq%6d.%3d", freq1,\r
+                                                          freq2);\r
+                               } else if ((i % 8 == 0) ||\r
+                                          (m == psd_scan->psd_stop_point)) {\r
+                                       if (freq2 == 0)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                          "%6d.000\n", freq1);\r
+                                       else if (freq2 < 100)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%6d.0%2d\n", freq1, freq2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%6d.%3d\n", freq1, freq2);\r
+                               } else {\r
+                                       if (freq2 == 0)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                          "%6d.000", freq1);\r
+                                       else if (freq2 < 100)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%6d.0%2d", freq1, freq2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%6d.%3d", freq1, freq2);\r
+                               }\r
+\r
+                               i++;\r
+                               m++;\r
+                               CL_PRINTF(cli_buf);\r
+\r
+                       } while ((i <= 8) && (m <= psd_scan->psd_stop_point));\r
+\r
+\r
+                       do {\r
+                               psd_rep1 = psd_scan->psd_report_max_hold[n] / 100;\r
+                               psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 *\r
+                                          100;\r
+\r
+                               if (j == 1) {\r
+                                       if (psd_rep2 < 10)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "\r\n Val %7d.0%d", psd_rep1,\r
+                                                          psd_rep2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "\r\n Val %7d.%d", psd_rep1,\r
+                                                          psd_rep2);\r
+                               } else if ((j % 8 == 0)  ||\r
+                                          (n == psd_scan->psd_stop_point)) {\r
+                                       if (psd_rep2 < 10)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%7d.0%d\n", psd_rep1,\r
+                                                          psd_rep2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%7d.%d\n", psd_rep1, psd_rep2);\r
+                               } else {\r
+                                       if (psd_rep2 < 10)\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%7d.0%d", psd_rep1, psd_rep2);\r
+                                       else\r
+                                               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                                                       "%7d.%d", psd_rep1, psd_rep2);\r
+                               }\r
+\r
+                               j++;\r
+                               n++;\r
+                               CL_PRINTF(cli_buf);\r
+\r
+                       } while ((j <= 8) && (n <= psd_scan->psd_stop_point));\r
+\r
+                       if ((m > psd_scan->psd_stop_point) ||\r
+                           (n > psd_scan->psd_stop_point))\r
+                               break;\r
+                       else {\r
+                               i = 1;\r
+                               j = 1;\r
+                       }\r
+\r
+               }\r
+       }\r
+\r
+\r
+}\r
+\r
+void halbtc8723b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist,\r
+                                     IN u32 gen_count)\r
+{\r
+       u32     i = 0, i_max = 0, val_max = 0;\r
+\r
+       if (gen_count == 1) {\r
+               memcpy(psd_scan->psd_report_max_hold,\r
+                      psd_scan->psd_report,\r
+                      BT_8723B_1ANT_ANTDET_PSD_POINTS * sizeof(u32));\r
+\r
+               psd_scan->psd_max_value_point = 0;\r
+               psd_scan->psd_max_value = 0;\r
+\r
+       } else {\r
+               for (i = psd_scan->psd_start_point;\r
+                    i <= psd_scan->psd_stop_point; i++) {\r
+                       if (psd_scan->psd_report[i] >\r
+                           psd_scan->psd_report_max_hold[i])\r
+                               psd_scan->psd_report_max_hold[i] =\r
+                                       psd_scan->psd_report[i];\r
+\r
+                       /* search Max Value */\r
+                       if (i == psd_scan->psd_start_point) {\r
+                               i_max = i;\r
+                               val_max = psd_scan->psd_report_max_hold[i];\r
+                       } else {\r
+                               if (psd_scan->psd_report_max_hold[i] >\r
+                                   val_max) {\r
+                                       i_max = i;\r
+                                       val_max = psd_scan->psd_report_max_hold[i];\r
+                               }\r
+                       }\r
+\r
+               }\r
+\r
+               psd_scan->psd_max_value_point = i_max;\r
+               psd_scan->psd_max_value = val_max;\r
+\r
+       }\r
+\r
+\r
+}\r
+\r
+u32 halbtc8723b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point)\r
+{\r
+       /* reg 0x808[9:0]: FFT data x */\r
+       /* reg 0x808[22]: 0-->1 to get 1 FFT data y */\r
+       /* reg 0x8b4[15:0]: FFT data y report */\r
+\r
+       u32 val = 0, psd_report = 0;\r
+       int k = 0;\r
+\r
+       val = btcoexist->btc_read_4byte(btcoexist, 0x808);\r
+\r
+       val &= 0xffbffc00;\r
+       val |= point;\r
+\r
+       btcoexist->btc_write_4byte(btcoexist, 0x808, val);\r
+\r
+       val |= 0x00400000;\r
+       btcoexist->btc_write_4byte(btcoexist, 0x808, val);\r
+\r
+       while (1) {\r
+               if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY)\r
+                       break;\r
+       }\r
+\r
+       val = btcoexist->btc_read_4byte(btcoexist, 0x8b4);\r
+\r
+       psd_report = val & 0x0000ffff;\r
+\r
+       return psd_report;\r
+}\r
+\r
+\r
+boolean halbtc8723b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist,\r
+               IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points,\r
+                                       IN u32 avgnum, IN u32 loopcnt)\r
+{\r
+       u32      i, val, n, k = 0, j, point_index = 0;\r
+       u32     points1 = 0, psd_report = 0;\r
+       u32     start_p = 0, stop_p = 0, delta_freq_per_point = 156250;\r
+       u32    psd_center_freq = 20 * 10 ^ 6;\r
+       boolean outloop = false, scan , roam, is_sweep_ok = true;\r
+       u8       flag = 0;\r
+       u32     tmp;\r
+       u32     wifi_original_channel = 1;\r
+\r
+       psd_scan->is_psd_running = true;\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       do {\r
+               switch (flag) {\r
+               case 0:  /* Get PSD parameters */\r
+               default:\r
+\r
+                       psd_scan->psd_band_width = 40 * 1000000;\r
+                       psd_scan->psd_point = points;\r
+                       psd_scan->psd_start_base = points / 2;\r
+                       psd_scan->psd_avg_num = avgnum;\r
+                       psd_scan->real_cent_freq = cent_freq;\r
+                       psd_scan->real_offset = offset;\r
+                       psd_scan->real_span = span;\r
+\r
+\r
+                       points1 = psd_scan->psd_point;\r
+                       delta_freq_per_point = psd_scan->psd_band_width /\r
+                                              psd_scan->psd_point;\r
+\r
+                       /* PSD point setup */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x808);\r
+                       val &= 0xffff0fff;\r
+\r
+                       switch (psd_scan->psd_point) {\r
+                       case 128:\r
+                               val |= 0x0;\r
+                               break;\r
+                       case 256:\r
+                       default:\r
+                               val |= 0x00004000;\r
+                               break;\r
+                       case 512:\r
+                               val |= 0x00008000;\r
+                               break;\r
+                       case 1024:\r
+                               val |= 0x0000c000;\r
+                               break;\r
+                       }\r
+\r
+                       switch (psd_scan->psd_avg_num) {\r
+                       case 1:\r
+                               val |= 0x0;\r
+                               break;\r
+                       case 8:\r
+                               val |= 0x00001000;\r
+                               break;\r
+                       case 16:\r
+                               val |= 0x00002000;\r
+                               break;\r
+                       case 32:\r
+                       default:\r
+                               val |= 0x00003000;\r
+                               break;\r
+                       }\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x808, val);\r
+\r
+                       flag = 1;\r
+                       break;\r
+               case 1:   /* calculate the PSD point index from freq/offset/span */\r
+                       psd_center_freq = psd_scan->psd_band_width / 2 +\r
+                                         offset * (1000000);\r
+\r
+                       start_p = psd_scan->psd_start_base + (psd_center_freq -\r
+                               span * (1000000) / 2) / delta_freq_per_point;\r
+                       psd_scan->psd_start_point = start_p -\r
+                                                   psd_scan->psd_start_base;\r
+\r
+                       stop_p = psd_scan->psd_start_base + (psd_center_freq +\r
+                               span * (1000000) / 2) / delta_freq_per_point;\r
+                       psd_scan->psd_stop_point = stop_p -\r
+                                                  psd_scan->psd_start_base - 1;\r
+\r
+                       flag = 2;\r
+                       break;\r
+               case 2:  /* set RF channel/BW/Mode */\r
+\r
+                       /* set 3-wire off */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x88c);\r
+                       val |= 0x00300000;\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x88c, val);\r
+\r
+                       /* CCK off */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x800);\r
+                       val &= 0xfeffffff;\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x800, val);\r
+\r
+                       /* store WiFi original channel */\r
+                       wifi_original_channel = btcoexist->btc_get_rf_reg(\r
+                                       btcoexist, BTC_RF_A, 0x18, 0x3ff);\r
+\r
+                       /* Set RF channel */\r
+                       if (cent_freq == 2484)\r
+                               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,\r
+                                                         0x18, 0x3ff, 0xe);\r
+                       else\r
+                               btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,\r
+                                         0x18, 0x3ff, (cent_freq - 2412) / 5 +\r
+                                                 1); /* WiFi TRx Mask on */\r
+\r
+\r
+                       /* Set RF Rx filter corner */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e,\r
+                                                 0xfffff, 0x3e4);\r
+\r
+                       /* Set TRx mask off */\r
+                       /* un-lock TRx Mask setup */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd,\r
+                                                 0x80, 0x1);\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf,\r
+                                                 0x1, 0x1);\r
+\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1,\r
+                                                 0xfffff, 0x0);\r
+\r
+                       /* Set  RF mode = Rx, RF Gain = 0x8a0 */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0,\r
+                                                 0xfffff, 0x308a0);\r
+\r
+                       while (1) {\r
+                               if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY)\r
+                                       break;\r
+                       }\r
+                       flag = 3;\r
+                       break;\r
+               case 3:\r
+                       psd_scan->psd_gen_count = 0;\r
+                       for (j = 1; j <= loopcnt; j++) {\r
+\r
+                               btcoexist->btc_get(btcoexist,\r
+                                                  BTC_GET_BL_WIFI_SCAN, &scan);\r
+                               btcoexist->btc_get(btcoexist,\r
+                                                  BTC_GET_BL_WIFI_ROAM, &roam);\r
+\r
+                               if (scan || roam) {\r
+                                       is_sweep_ok = false;\r
+                                       break;\r
+                               }\r
+                               memset(psd_scan->psd_report, 0,\r
+                                      psd_scan->psd_point * sizeof(u32));\r
+                               start_p = psd_scan->psd_start_point +\r
+                                         psd_scan->psd_start_base;\r
+                               stop_p = psd_scan->psd_stop_point +\r
+                                        psd_scan->psd_start_base + 1;\r
+\r
+                               i = start_p;\r
+                               point_index = 0;\r
+\r
+                               while (i < stop_p) {\r
+                                       if (i >= points1)\r
+                                               psd_report =\r
+                                                       halbtc8723b1ant_psd_getdata(\r
+                                                       btcoexist, i - points1);\r
+                                       else\r
+                                               psd_report =\r
+                                                       halbtc8723b1ant_psd_getdata(\r
+                                                               btcoexist, i);\r
+\r
+                                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                               "Point=%d, psd_raw_data = 0x%08x\n",\r
+                                                   i, psd_report);\r
+                                       BTC_TRACE(trace_buf);\r
+                                       if (psd_report == 0)\r
+                                               tmp = 0;\r
+                                       else\r
+                                               /* tmp =  20*log10((double)psd_report); */\r
+                                               /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */\r
+                                               tmp = 6 * halbtc8723b1ant_psd_log2base(\r
+                                                       btcoexist, psd_report);\r
+\r
+                                       n = i - psd_scan->psd_start_base;\r
+                                       psd_scan->psd_report[n] =  tmp;\r
+\r
+\r
+                                       halbtc8723b1ant_psd_max_holddata(\r
+                                               btcoexist, j);\r
+\r
+                                       i++;\r
+\r
+                               }\r
+\r
+                               psd_scan->psd_gen_count = j;\r
+                       }\r
+\r
+                       flag = 100;\r
+                       break;\r
+               case 99:        /* error */\r
+\r
+                       outloop = true;\r
+                       break;\r
+               case 100: /* recovery */\r
+\r
+                       /* set 3-wire on */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x88c);\r
+                       val &= 0xffcfffff;\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x88c, val);\r
+\r
+                       /* CCK on */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x800);\r
+                       val |= 0x01000000;\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x800, val);\r
+\r
+                       /* PSD off */\r
+                       val = btcoexist->btc_read_4byte(btcoexist, 0x808);\r
+                       val &= 0xffbfffff;\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x808, val);\r
+\r
+                       /* TRx Mask on */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1,\r
+                                                 0xfffff, 0x780);\r
+\r
+                       /* lock TRx Mask setup */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd,\r
+                                                 0x80, 0x0);\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf,\r
+                                                 0x1, 0x0);\r
+\r
+                       /* Set RF Rx filter corner */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e,\r
+                                                 0xfffff, 0x0);\r
+\r
+                       /* restore WiFi original channel */\r
+                       btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18,\r
+                                                 0x3ff, wifi_original_channel);\r
+\r
+                       outloop = true;\r
+                       break;\r
+\r
+               }\r
+\r
+       } while (!outloop);\r
+\r
+\r
+\r
+       psd_scan->is_psd_running = false;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n");\r
+       BTC_TRACE(trace_buf);\r
+       return is_sweep_ok;\r
+\r
+}\r
+\r
+void halbtc8723b1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist,\r
+               IN u32 bt_tx_time, IN u32 bt_le_channel)\r
+{\r
+       u32     i = 0;\r
+       u32     wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; \r
+       s32     wlpsd_offset = -4;\r
+       u8      bt_le_ch[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33};\r
+\r
+       u8      h2c_parameter[3] ={0},u8tmpa,u8tmpb;\r
+       \r
+       u8      state=0;\r
+       boolean         outloop = false, bt_resp = false;\r
+       u32             freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point,\r
+                       u32tmp;\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+\r
+       board_info->btdm_ant_det_finish = false;        \r
+       memset(psd_scan->ant_det_peak_val, 0, 16*sizeof(u8));\r
+       memset(psd_scan->ant_det_peak_freq, 0, 16*sizeof(u8));\r
+\r
+       if (board_info->tfbga_package) /* for TFBGA */\r
+               psd_scan->ant_det_thres_offset = 5;\r
+       else\r
+               psd_scan->ant_det_thres_offset = 0;\r
+\r
+       do {\r
+               switch (state) {\r
+               case 0:\r
+                       if (bt_le_channel == 39)\r
+                               wlpsd_cent_freq = 2484;\r
+                       else {\r
+                               for (i = 1; i <= 13; i++) {\r
+                                       if (bt_le_ch[i - 1] ==\r
+                                           bt_le_channel) {\r
+                                               wlpsd_cent_freq = 2412\r
+                                                                 + (i - 1) * 5;\r
+                                               break;\r
+                                       }\r
+                               }\r
+\r
+                               if (i == 14) {\r
+\r
+                                       BTC_SPRINTF(trace_buf,\r
+                                                   BT_TMP_BUF_SIZE,\r
+                                               "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ",\r
+                                                   bt_le_channel);\r
+                                       BTC_TRACE(trace_buf);\r
+                                       outloop = true;\r
+                                       break;\r
+                               }\r
+                       }\r
+\r
+                       wlpsd_sweep_count = bt_tx_time * 238 /\r
+                                           100; /* bt_tx_time/0.42                                                              */\r
+                       wlpsd_sweep_count = wlpsd_sweep_count / 5;\r
+\r
+                       if (wlpsd_sweep_count % 5 != 0)\r
+                               wlpsd_sweep_count = (wlpsd_sweep_count /\r
+                                                    5 + 1) * 5;\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d,  BT_LECh = %d\n",\r
+                                   bt_tx_time, bt_le_channel);\r
+                       BTC_TRACE(trace_buf);\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d,  wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n",\r
+                                   wlpsd_cent_freq,\r
+                                   wlpsd_offset,\r
+                                   wlpsd_span,\r
+                                   wlpsd_sweep_count);\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       state = 1;\r
+                       break;\r
+               case 1: /* stop coex DM & set antenna path */\r
+                       /* Stop Coex DM */\r
+                               btcoexist->stop_coex_dm = true;\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       /* set native power save */\r
+                       halbtc8723b1ant_power_save_state(btcoexist,\r
+                                                BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+                       /* Set TDMA off,                                 */\r
+                       halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC,\r
+                                               false, 0);\r
+\r
+                       /* Set coex table */\r
+                       halbtc8723b1ant_coex_table_with_type(btcoexist,\r
+                                                            FORCE_EXEC, 0);\r
+\r
+                       if (board_info->btdm_ant_pos ==\r
+                           BTC_ANTENNA_AT_MAIN_PORT) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       } else {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       }\r
+\r
+                       /* Set Antenna path, switch WiFi to un-certain antenna port */\r
+                       halbtc8723b1ant_set_ant_path(btcoexist,\r
+                                            BTC_ANT_PATH_BT, FORCE_EXEC, false,\r
+                                                    false);\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */\r
+                       h2c_parameter[0] = 0x1;\r
+                       h2c_parameter[1] = 0xd;\r
+                       h2c_parameter[2] = 0x14;\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",\r
+                                   h2c_parameter[1],\r
+                                   h2c_parameter[2]);\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,\r
+                                               h2c_parameter);\r
+\r
+                       u32tmp = btcoexist->btc_read_4byte(btcoexist,\r
+                                                          0x948);\r
+                       u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765);\r
+                       u8tmpb = btcoexist->btc_read_1byte(btcoexist,\r
+                                                          0x778);\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n",\r
+                                   u32tmp,  u8tmpa, u8tmpb);\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       state = 2;\r
+                       break;\r
+                       case 2: /* Pre-sweep background psd */\r
+                       if (!halbtc8723b1ant_psd_sweep_point(btcoexist,\r
+                                    wlpsd_cent_freq, wlpsd_offset, wlpsd_span,\r
+                                            BT_8723B_1ANT_ANTDET_PSD_POINTS,\r
+                                    BT_8723B_1ANT_ANTDET_PSD_AVGNUM, 3)) {\r
+                               board_info->btdm_ant_det_finish = false;\r
+                               board_info->btdm_ant_num_by_ant_det = 1;\r
+                               psd_scan->ant_det_result = 8;\r
+                               state = 99;\r
+                               break;\r
+                       }\r
+\r
+                       psd_scan->ant_det_pre_psdscan_peak_val =\r
+                               psd_scan->psd_max_value;\r
+\r
+                       if (psd_scan->psd_max_value >\r
+                           (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND\r
+                            + psd_scan->ant_det_thres_offset) * 100) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n",\r
+                                           psd_scan->psd_max_value / 100,\r
+                                       BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND\r
+                                           + psd_scan->ant_det_thres_offset);\r
+                               BTC_TRACE(trace_buf);\r
+                               board_info->btdm_ant_det_finish = false;\r
+                               board_info->btdm_ant_num_by_ant_det = 1;\r
+                               psd_scan->ant_det_result = 5;\r
+                               state = 99;\r
+                       } else {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n",\r
+                                           psd_scan->psd_max_value / 100,\r
+                                       BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND\r
+                                           + psd_scan->ant_det_thres_offset);\r
+                               BTC_TRACE(trace_buf);\r
+                               state = 3;\r
+                       }\r
+                       break;\r
+                       case 3: \r
+                       bt_resp = btcoexist->btc_set_bt_ant_detection(\r
+                                         btcoexist, (u8)(bt_tx_time & 0xff),\r
+                                         (u8)(bt_le_channel & 0xff));\r
+\r
+                       if (!halbtc8723b1ant_psd_sweep_point(btcoexist,\r
+                                            wlpsd_cent_freq, wlpsd_offset,\r
+                                                            wlpsd_span,\r
+                                            BT_8723B_1ANT_ANTDET_PSD_POINTS,\r
+                                            BT_8723B_1ANT_ANTDET_PSD_AVGNUM,\r
+                                                    wlpsd_sweep_count)) {\r
+                               board_info->btdm_ant_det_finish\r
+                                       = false;\r
+                               board_info->btdm_ant_num_by_ant_det\r
+                                       = 1;\r
+                               psd_scan->ant_det_result = 8;\r
+                               state = 99;\r
+                               break;\r
+                       }\r
+\r
+                       psd_scan->ant_det_psd_scan_peak_val =\r
+                               psd_scan->psd_max_value;\r
+                       psd_scan->ant_det_psd_scan_peak_freq =\r
+                               psd_scan->psd_max_value_point;\r
+                       state = 4;\r
+                       break;\r
+                       case 4:                         \r
+\r
+                       if (psd_scan->psd_point == 0)\r
+                               delta_freq_per_point = 0;\r
+                       else\r
+                               delta_freq_per_point =\r
+                                       psd_scan->psd_band_width /\r
+                                       psd_scan->psd_point;\r
+\r
+                       psd_rep1 = psd_scan->psd_max_value / 100;\r
+                       psd_rep2 = psd_scan->psd_max_value - psd_rep1 *\r
+                                  100;\r
+\r
+                       freq = ((psd_scan->real_cent_freq - 20) *\r
+                               1000000 + psd_scan->psd_max_value_point\r
+                               * delta_freq_per_point);\r
+                       freq1 = freq / 1000000;\r
+                       freq2 = freq / 1000 - freq1 * 1000;\r
+\r
+                       if (freq2 < 100) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz",\r
+                                           freq1, freq2);\r
+                               BTC_TRACE(trace_buf);\r
+                               CL_SPRINTF(psd_scan->ant_det_peak_freq,\r
+                                          BT_8723B_1ANT_ANTDET_BUF_LEN,\r
+                                          "%d.0%d", freq1, freq2);\r
+                       } else {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz",\r
+                                           freq1, freq2);\r
+                               BTC_TRACE(trace_buf);\r
+                               CL_SPRINTF(psd_scan->ant_det_peak_freq,\r
+                                          BT_8723B_1ANT_ANTDET_BUF_LEN,\r
+                                          "%d.%d", freq1, freq2);\r
+                       }\r
+\r
+                       if (psd_rep2 < 10) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                           ", Value = %d.0%d dB\n",\r
+                                           psd_rep1, psd_rep2);\r
+                               BTC_TRACE(trace_buf);\r
+                               CL_SPRINTF(psd_scan->ant_det_peak_val,\r
+                                          BT_8723B_1ANT_ANTDET_BUF_LEN,\r
+                                          "%d.0%d", psd_rep1, psd_rep2);\r
+                       } else {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                           ", Value = %d.%d dB\n",\r
+                                           psd_rep1, psd_rep2);\r
+                               BTC_TRACE(trace_buf);\r
+                               CL_SPRINTF(psd_scan->ant_det_peak_val,\r
+                                          BT_8723B_1ANT_ANTDET_BUF_LEN,\r
+                                          "%d.%d", psd_rep1, psd_rep2);\r
+                       }\r
+\r
+                       psd_scan->ant_det_is_btreply_available = true;\r
+\r
+                       if (bt_resp == false) {\r
+                               psd_scan->ant_det_is_btreply_available =\r
+                                       false;\r
+                               psd_scan->ant_det_result = 0;\r
+                               board_info->btdm_ant_det_finish = false;\r
+                               board_info->btdm_ant_num_by_ant_det = 1;\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n ");\r
+                               BTC_TRACE(trace_buf);\r
+                       } else if (psd_scan->psd_max_value >\r
+                               (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)\r
+                                  * 100) {\r
+                               psd_scan->ant_det_result = 1;\r
+                               board_info->btdm_ant_det_finish = true;\r
+                               board_info->btdm_ant_num_by_ant_det = 2;\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       } else if (psd_scan->psd_max_value >\r
+                               (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION\r
+                                   + psd_scan->ant_det_thres_offset) * 100) {\r
+                               psd_scan->ant_det_result = 2;\r
+                               board_info->btdm_ant_det_finish = true;\r
+                               board_info->btdm_ant_num_by_ant_det = 2;\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       } else if (psd_scan->psd_max_value >\r
+                                  (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT) *\r
+                                  100) {\r
+                               psd_scan->ant_det_result = 3;\r
+                               board_info->btdm_ant_det_finish = true;\r
+                               board_info->btdm_ant_num_by_ant_det = 1;\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       } else {\r
+                               psd_scan->ant_det_result = 4;\r
+                               board_info->btdm_ant_det_finish = false;\r
+                               board_info->btdm_ant_num_by_ant_det = 1;\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       }\r
+\r
+                       state = 99;\r
+                       break;\r
+               case 99:  /* restore setup */\r
+\r
+                       /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */\r
+                       h2c_parameter[0] = 0x0;\r
+                       h2c_parameter[1] = 0x0;\r
+                       h2c_parameter[2] = 0x0;\r
+\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",\r
+                                   h2c_parameter[1], h2c_parameter[2]);\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,\r
+                                               h2c_parameter);\r
+\r
+                       /* Set Antenna Path                                      */\r
+                       halbtc8723b1ant_set_ant_path(btcoexist,\r
+                                    BTC_ANT_PATH_PTA, FORCE_EXEC, false,\r
+                                                    false);\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       /* Resume Coex DM */\r
+                       btcoexist->stop_coex_dm = false;\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       /* stimulate coex running */\r
+                       halbtc8723b1ant_run_coexist_mechanism(\r
+                               btcoexist);\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       outloop = true;\r
+                       break;\r
+               }\r
+\r
+       } while (!outloop);\r
+\r
+\r
+\r
+}\r
+\r
+void halbtc8723b1ant_psd_antenna_detection_check(IN struct btc_coexist\r
+               *btcoexist)\r
+{\r
+       static u32 ant_det_count = 0, ant_det_fail_count = 0;\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       \r
+       boolean scan, roam;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);\r
+\r
+\r
+       /* psd_scan->ant_det_bt_tx_time = 20;  */\r
+       psd_scan->ant_det_bt_tx_time =\r
+               BT_8723B_1ANT_ANTDET_BTTXTIME;     /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */\r
+       psd_scan->ant_det_bt_le_channel = BT_8723B_1ANT_ANTDET_BTTXCHANNEL;             \r
+\r
+       ant_det_count++;\r
+       \r
+       psd_scan->ant_det_try_count = ant_det_count;    \r
+                       \r
+       if (scan || roam) {\r
+               board_info->btdm_ant_det_finish = false;\r
+               psd_scan->ant_det_result = 6;\r
+       } else if (coex_sta->bt_disabled) {\r
+               board_info->btdm_ant_det_finish = false;\r
+               psd_scan->ant_det_result = 11;\r
+       } else if (coex_sta->num_of_profile >= 1) {\r
+               board_info->btdm_ant_det_finish = false;\r
+               psd_scan->ant_det_result = 7;\r
+       } else if (\r
+               !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */\r
+               board_info->btdm_ant_det_finish = false;\r
+               psd_scan->ant_det_result = 9;\r
+       } else if (coex_sta->c2h_bt_inquiry_page) {\r
+               board_info->btdm_ant_det_finish = false;\r
+               psd_scan->ant_det_result = 10;\r
+       } else\r
+               halbtc8723b1ant_psd_antenna_detection(btcoexist,\r
+                                             psd_scan->ant_det_bt_tx_time,\r
+                                             psd_scan->ant_det_bt_le_channel);\r
+\r
+       if (!board_info->btdm_ant_det_finish)\r
+               ant_det_fail_count++;\r
+\r
+       psd_scan->ant_det_fail_count = ant_det_fail_count;\r
+\r
+}\r
+\r
+\r
+/* ************************************************************\r
+ * work around function start with wa_halbtc8723b1ant_\r
+ * ************************************************************\r
+ * ************************************************************\r
+ * extern function start with ex_halbtc8723b1ant_\r
+ * ************************************************************ */\r
+void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       u8                              u8tmp=0x0;\r
+       u16                             u16tmp=0x0;\r
+       u32                             value;\r
+       \r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+               "xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "Ant Det Finish = %s, Ant Det Number  = %d\n",\r
+                   (board_info->btdm_ant_det_finish ? "Yes" : "No"),\r
+                   board_info->btdm_ant_num_by_ant_det);\r
+       BTC_TRACE(trace_buf);\r
+\r
+       \r
+       btcoexist->stop_coex_dm = true;\r
+\r
+       btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20);\r
+\r
+       /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */\r
+       u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2);\r
+       btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1));\r
+\r
+       /* set GRAN_BT = 1 */\r
+       btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18);\r
+       /* set WLAN_ACT = 0 */\r
+       btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4);      \r
+\r
+       /*  */\r
+       /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */\r
+       /* Local setting bit define */\r
+       /*      BIT0: "0" for no antenna inverse; "1" for antenna inverse  */\r
+       /*      BIT1: "0" for internal switch; "1" for external switch */\r
+       /*      BIT2: "0" for one antenna; "1" for two antenna */\r
+       /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */\r
+       if(btcoexist->chip_interface == BTC_INTF_USB) {\r
+               /* fixed at S0 for USB interface */\r
+               btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0);\r
+               \r
+               u8tmp |= 0x1;   /* antenna inverse */\r
+               btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp);\r
+\r
+               board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT;\r
+       } else {\r
+               /* for PCIE and SDIO interface, we check efuse 0xc3[6] */\r
+               if (board_info->single_ant_path == 0) {\r
+                       /* set to S1 */\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280);\r
+                       board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT;\r
+                       value = 1;\r
+               } else if (board_info->single_ant_path == 1) {\r
+                       /* set to S0 */\r
+                       btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0);\r
+                       u8tmp |= 0x1;   /* antenna inverse */\r
+                       board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT;\r
+                       value = 0;\r
+               }\r
+\r
+               btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL,\r
+                                  &value);\r
+               \r
+               if(btcoexist->chip_interface == BTC_INTF_PCI)\r
+                       btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384,\r
+                                                            u8tmp);\r
+               else if(btcoexist->chip_interface == BTC_INTF_SDIO)\r
+                       btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, \r
+                                                            u8tmp);\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist)\r
+{\r
+}\r
+\r
+void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist,\r
+                                      IN boolean wifi_only)\r
+{\r
+       halbtc8723b1ant_init_hw_config(btcoexist, true, wifi_only);\r
+       btcoexist->stop_coex_dm = false;\r
+}\r
+\r
+void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist)\r
+{\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                   "[BTCoex], Coex Mechanism Init!!\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       btcoexist->stop_coex_dm = false;\r
+       \r
+       halbtc8723b1ant_init_coex_dm(btcoexist);\r
+\r
+       halbtc8723b1ant_query_bt_info(btcoexist);\r
+}\r
+\r
+void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;\r
+       u8                              *cli_buf = btcoexist->cli_buf;\r
+       u8                              u8tmp[4], i, bt_info_ext, ps_tdma_case=0;\r
+       u16                             u16tmp[4];\r
+       u32                             u32tmp[4];\r
+       u32                             fa_ofdm, fa_cck;\r
+       u32                             fw_ver=0, bt_patch_ver=0;\r
+       static u8               pop_report_in_10s = 0;  \r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n ============[BT Coexist info]============");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       if(btcoexist->manual_control) {\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                       "\r\n ============[Under Manual Control]============");\r
+               CL_PRINTF(cli_buf);\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "\r\n ==========================================");\r
+               CL_PRINTF(cli_buf);\r
+       }\r
+       if(btcoexist->stop_coex_dm) {\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "\r\n ============[Coex is STOPPED]============");\r
+               CL_PRINTF(cli_buf);\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "\r\n ==========================================");\r
+               CL_PRINTF(cli_buf);\r
+       }\r
+\r
+       if (psd_scan->ant_det_try_count == 0) {\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d",\r
+                          "Ant PG Num/ Mech/ Pos",\r
+                          board_info->pg_ant_num, board_info->btdm_ant_num,\r
+                          board_info->btdm_ant_pos);\r
+               CL_PRINTF(cli_buf);\r
+       } else {\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                          "\r\n %-35s = %d/ %d/ %d  (%d/%d/%d)",\r
+                          "Ant PG Num/ Mech(Ant_Det)/ Pos",\r
+                       board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det,\r
+                          board_info->btdm_ant_pos,\r
+                       psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count,\r
+                          psd_scan->ant_det_result);\r
+               CL_PRINTF(cli_buf);\r
+\r
+               if (board_info->btdm_ant_det_finish) {\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s",\r
+                                  "Ant Det PSD Value",\r
+                                  psd_scan->ant_det_peak_val);\r
+                       CL_PRINTF(cli_buf);\r
+               }\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c",\r
+                  "Version Coex/ Fw/ Patch/ Cut",\r
+                  glcoex_ver_date_8723b_1ant, glcoex_ver_8723b_1ant, fw_ver,\r
+                  bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ",\r
+                  "Wifi channel informed to BT",\r
+                  coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1],\r
+                  coex_dm->wifi_chnl_info[2]);\r
+       CL_PRINTF(cli_buf);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s",\r
+                  "WifibHiPri/ Ccklock/ CckEverLock",\r
+                  (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"),\r
+                  (coex_sta->cck_lock ? "Yes" : "No"),\r
+                  (coex_sta->cck_ever_lock ? "Yes" : "No"));\r
+       CL_PRINTF(cli_buf);\r
+\r
+       /* wifi status */\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",\r
+                  "============[Wifi Status]============");\r
+       CL_PRINTF(cli_buf);\r
+       btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",\r
+                  "============[BT Status]============");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s",\r
+                  "BT Abnormal scan",\r
+                  (coex_sta->bt_abnormal_scan) ? "Yes" : "No");\r
+       CL_PRINTF(cli_buf);\r
+       \r
+       pop_report_in_10s++;\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", \r
+                  "BT [status/ rssi/ retryCnt/ popCnt]",\r
+               ((coex_sta->bt_disabled)? ("disabled"): ((\r
+                  coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan")\r
+                          : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE ==\r
+                              coex_dm->bt_status) ? "non-connected idle" :\r
+               ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)\r
+                                      ? "connected-idle" : "busy")))),\r
+                  coex_sta->bt_rssi, coex_sta->bt_retry_cnt,\r
+                  coex_sta->pop_event_cnt);\r
+       CL_PRINTF(cli_buf);\r
+       \r
+       if (pop_report_in_10s >= 5) {\r
+               coex_sta->pop_event_cnt = 0;    \r
+               pop_report_in_10s = 0;\r
+       }\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n %-35s = %d / %d / %d / %d / %d / %d",\r
+                  "SCO/HID/PAN/A2DP/NameReq/WHQL",\r
+                  bt_link_info->sco_exist, bt_link_info->hid_exist,\r
+                  bt_link_info->pan_exist, bt_link_info->a2dp_exist,\r
+                  coex_sta->c2h_bt_remote_name_req,\r
+                  coex_sta->bt_whck_test);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s",\r
+                  "BT Role",\r
+                  (bt_link_info->slave_role) ? "Slave" : "Master");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       bt_info_ext = coex_sta->bt_info_ext;\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d",\r
+                  "A2DP Rate/Bitpool",\r
+               (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool);\r
+       CL_PRINTF(cli_buf);     \r
+\r
+       for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) {\r
+               if (coex_sta->bt_info_c2h_cnt[i]) {\r
+                       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                               "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)",\r
+                                  glbt_info_src_8723b_1ant[i],\r
+                                  coex_sta->bt_info_c2h[i][0],\r
+                                  coex_sta->bt_info_c2h[i][1],\r
+                                  coex_sta->bt_info_c2h[i][2],\r
+                                  coex_sta->bt_info_c2h[i][3],\r
+                                  coex_sta->bt_info_c2h[i][4],\r
+                                  coex_sta->bt_info_c2h[i][5],\r
+                                  coex_sta->bt_info_c2h[i][6],\r
+                                  coex_sta->bt_info_c2h_cnt[i]);\r
+                       CL_PRINTF(cli_buf);\r
+               }\r
+       }\r
+\r
+       \r
+       if(btcoexist->manual_control)\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",\r
+                       "============[mechanisms] (before Manual)============");\r
+       else\r
+               CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",\r
+                          "============[mechanisms]============");\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "SM[LowPenaltyRA]",\r
+                  coex_dm->cur_low_penalty_ra);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       ps_tdma_case = coex_dm->cur_ps_tdma;\r
+       if (board_info->btdm_ant_num_by_ant_det == 2) {\r
+               if (coex_dm->cur_ps_tdma_on)\r
+                       ps_tdma_case = ps_tdma_case +\r
+                               100; /* for WiFi RSSI low or BT RSSI low */\r
+               else\r
+                       ps_tdma_case =\r
+                               1; /* always translate to TDMA(off,1) for TDMA-off case */\r
+       }\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)",\r
+                  "PS TDMA",\r
+                  coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1],\r
+                  coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3],\r
+                  coex_dm->ps_tdma_para[4], ps_tdma_case,\r
+                  (coex_dm->cur_ps_tdma_on ? "On" : "Off"),\r
+                  (coex_dm->auto_tdma_adjust ? "Adj" : "Fix"));\r
+\r
+       CL_PRINTF(cli_buf);\r
+               \r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "Coex Table Type",\r
+                  coex_sta->coex_table_type);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",\r
+                  "IgnWlanAct",\r
+                  coex_dm->cur_ignore_wlan_act);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       /*\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)",\r
+               coex_dm->error_condition);\r
+       CL_PRINTF(cli_buf);\r
+       */\r
+\r
+       /* Hw setting            */\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",\r
+                  "============[Hw setting]============");\r
+       CL_PRINTF(cli_buf);     \r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x",\r
+                  "backup ARFR1/ARFR2/RL/AMaxTime",\r
+                  coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2,\r
+                  coex_dm->backup_retry_limit,\r
+                  coex_dm->backup_ampdu_max_time);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434);\r
+       u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a);\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", \r
+                  "0x430/0x434/0x42a/0x456",\r
+                  u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778);\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x880);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", \r
+                  "0x778/0x6cc/0x880[29:25]",\r
+                  u8tmp[0], u32tmp[0], (u32tmp[1] & 0x3e000000) >> 25);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948);\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x764);\r
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x76e);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",\r
+                  "0x948/ 0x67[5] / 0x764 / 0x76e",\r
+                  u32tmp[0], ((u8tmp[0] & 0x20) >> 5), (u32tmp[1] & 0xffff),\r
+                  u8tmp[1]);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930);\r
+       u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944);        \r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",\r
+                  "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]",\r
+                  u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39);\r
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40);\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c);\r
+       u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,\r
+                  "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",\r
+                  "0x38[11]/0x40/0x4c[24:23]/0x64[0]",\r
+                  ((u8tmp[0] & 0x8) >> 3), u8tmp[1],\r
+                  ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550);\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",\r
+                  "0x550(bcn ctrl)/0x522",\r
+                  u32tmp[0], u8tmp[0]);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50);\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",\r
+                  "0xc50(dig)/0x49c(null-drop)",\r
+                  u32tmp[0] & 0xff, u8tmp[0]);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4);\r
+       u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8);\r
+       u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0);\r
+\r
+       u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b);\r
+       u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c);\r
+\r
+       fa_ofdm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000)\r
+                       >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) +\r
+                  ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] &\r
+                                  0xffff) ;\r
+       fa_cck = (u8tmp[0] << 8) + u8tmp[1];\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",\r
+                  "OFDM-CCA/OFDM-FA/CCK-FA",\r
+                  u32tmp[0] & 0xffff, fa_ofdm, fa_cck);\r
+       CL_PRINTF(cli_buf);\r
+\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",\r
+                  "CRC_OK CCK/11g/11n/11n-Agg",\r
+                  coex_sta->crc_ok_cck, coex_sta->crc_ok_11g,\r
+                  coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",\r
+                  "CRC_Err CCK/11g/11n/11n-Agg",\r
+                  coex_sta->crc_err_cck, coex_sta->crc_err_11g,\r
+                  coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0);\r
+       u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4);\r
+       u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",\r
+                  "0x6c0/0x6c4/0x6c8(coexTable)",\r
+                  u32tmp[0], u32tmp[1], u32tmp[2]);\r
+       CL_PRINTF(cli_buf);\r
+\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",\r
+                  "0x770(high-pri rx/tx)",\r
+                  coex_sta->high_priority_rx, coex_sta->high_priority_tx);\r
+       CL_PRINTF(cli_buf);\r
+       CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",\r
+                  "0x774(low-pri rx/tx)",\r
+                  coex_sta->low_priority_rx, coex_sta->low_priority_tx);\r
+       CL_PRINTF(cli_buf);\r
+#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 1)\r
+       /* halbtc8723b1ant_monitor_bt_ctr(btcoexist); */\r
+#endif\r
+       btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS);\r
+}\r
+\r
+\r
+void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type)\r
+{\r
+       if(btcoexist->manual_control || btcoexist->stop_coex_dm)\r
+               return;\r
+\r
+       if (BTC_IPS_ENTER == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], IPS ENTER notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               coex_sta->under_ips = true;\r
+\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT,\r
+                                            FORCE_EXEC, false, true);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);\r
+       } else if (BTC_IPS_LEAVE == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], IPS LEAVE notify\n");\r
+               BTC_TRACE(trace_buf);\r
+\r
+               halbtc8723b1ant_init_hw_config(btcoexist, false, false);\r
+               halbtc8723b1ant_init_coex_dm(btcoexist);\r
+               halbtc8723b1ant_query_bt_info(btcoexist);\r
+\r
+               coex_sta->under_ips = false;\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type)\r
+{\r
+       if(btcoexist->manual_control || btcoexist->stop_coex_dm)\r
+               return;\r
+\r
+       if (BTC_LPS_ENABLE == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], LPS ENABLE notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               coex_sta->under_lps = true;\r
+       } else if (BTC_LPS_DISABLE == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], LPS DISABLE notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               coex_sta->under_lps = false;\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist,\r
+                                   IN u8 type)\r
+{\r
+       boolean wifi_connected=false, bt_hs_on=false;\r
+       u32     wifi_link_status=0;\r
+       u32     num_of_wifi_link=0;\r
+       boolean bt_ctrl_agg_buf_size=false;\r
+       u8      agg_buf_size=5;\r
+\r
+       u8 u8tmpa, u8tmpb;\r
+       u32 u32tmp;\r
+\r
+       if(btcoexist->manual_control ||\r
+               btcoexist->stop_coex_dm )\r
+               return;\r
+\r
+       if (BTC_SCAN_START == type) {\r
+               coex_sta->wifi_is_high_pri_task = true;\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], SCAN START notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               psd_scan->ant_det_is_ant_det_available = true;\r
+               halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false,\r
+                       8);  /* Force antenna setup for no scan result issue */\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            FORCE_EXEC, false, false);\r
+               u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948);\r
+               u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765);\r
+               u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67);\r
+\r
+\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+                           u32tmp,  u8tmpa, u8tmpb);\r
+               BTC_TRACE(trace_buf);\r
+       } else {\r
+               coex_sta->wifi_is_high_pri_task = false;\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], SCAN FINISH notify\n");\r
+               BTC_TRACE(trace_buf);\r
+\r
+               btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,\r
+                                  &coex_sta->scan_ap_num);\r
+       }       \r
+\r
+       if(coex_sta->bt_disabled)\r
+               return;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, \r
+&wifi_connected);\r
+\r
+       halbtc8723b1ant_query_bt_info(btcoexist);\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,\r
+ &wifi_link_status);\r
+       num_of_wifi_link = wifi_link_status>>16;\r
+       if (num_of_wifi_link >= 2) {\r
+               halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false,\r
+                                          bt_ctrl_agg_buf_size, agg_buf_size);\r
+               halbtc8723b1ant_action_wifi_multi_port(btcoexist);\r
+               return;\r
+       }\r
+\r
+       if (coex_sta->c2h_bt_inquiry_page) {\r
+               halbtc8723b1ant_action_bt_inquiry(btcoexist);\r
+               return;\r
+       } else if (bt_hs_on) {\r
+               halbtc8723b1ant_action_hs(btcoexist);\r
+               return;\r
+       }\r
+\r
+       if (BTC_SCAN_START == type) {\r
+               if (!wifi_connected)    /* non-connected scan */\r
+                       halbtc8723b1ant_action_wifi_not_connected_scan(\r
+                               btcoexist);\r
+               else    /* wifi is connected */\r
+                       halbtc8723b1ant_action_wifi_connected_scan(btcoexist);\r
+       } else if (BTC_SCAN_FINISH == type) {\r
+               if (!wifi_connected)    /* non-connected scan */\r
+                       halbtc8723b1ant_action_wifi_not_connected(btcoexist);\r
+               else\r
+                       halbtc8723b1ant_action_wifi_connected(btcoexist);\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist,\r
+                                      IN u8 type)\r
+{\r
+       boolean wifi_connected=false, bt_hs_on=false;   \r
+       u32     wifi_link_status=0;\r
+       u32     num_of_wifi_link=0;\r
+       boolean bt_ctrl_agg_buf_size=false;\r
+       u8      agg_buf_size=5;\r
+\r
+       if(btcoexist->manual_control ||\r
+               btcoexist->stop_coex_dm ||\r
+               coex_sta->bt_disabled )\r
+               return;\r
+\r
+       if (BTC_ASSOCIATE_START == type) {\r
+               coex_sta->wifi_is_high_pri_task = true;\r
+               psd_scan->ant_det_is_ant_det_available = true;\r
+               halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false,\r
+                       8);  /* Force antenna setup for no scan result issue */\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            FORCE_EXEC, false, false);\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], CONNECT START notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               coex_dm->arp_cnt = 0;\r
+       } else {\r
+               coex_sta->wifi_is_high_pri_task = false;\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], CONNECT FINISH notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               /* coex_dm->arp_cnt = 0; */\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,\r
+                          &wifi_link_status);\r
+       num_of_wifi_link = wifi_link_status >> 16;\r
+       if (num_of_wifi_link >= 2) {\r
+               halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false,\r
+                                          bt_ctrl_agg_buf_size, agg_buf_size);\r
+               halbtc8723b1ant_action_wifi_multi_port(btcoexist);\r
+               return;\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+       if (coex_sta->c2h_bt_inquiry_page) {\r
+               halbtc8723b1ant_action_bt_inquiry(btcoexist);\r
+               return;\r
+       } else if (bt_hs_on) {\r
+               halbtc8723b1ant_action_hs(btcoexist);\r
+               return;\r
+       }\r
+\r
+       if (BTC_ASSOCIATE_START == type)\r
+               halbtc8723b1ant_action_wifi_not_connected_asso_auth(btcoexist);\r
+       else if (BTC_ASSOCIATE_FINISH == type) {\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                                  &wifi_connected);\r
+               if (!wifi_connected) /* non-connected scan */\r
+                       halbtc8723b1ant_action_wifi_not_connected(btcoexist);\r
+               else\r
+                       halbtc8723b1ant_action_wifi_connected(btcoexist);\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist,\r
+               IN u8 type)\r
+{\r
+       u8                      h2c_parameter[3] ={0};\r
+       u32                     wifi_bw;\r
+       u8                      wifi_central_chnl;\r
+       boolean                 wifi_under_b_mode = false;\r
+\r
+       if(btcoexist->manual_control ||\r
+               btcoexist->stop_coex_dm ||\r
+               coex_sta->bt_disabled )\r
+               return;\r
+\r
+       if (BTC_MEDIA_CONNECT == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], MEDIA connect notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false,\r
+                       8);  /* Force antenna setup for no scan result issue */\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA,\r
+                                            FORCE_EXEC, false, false);\r
+               psd_scan->ant_det_is_ant_det_available = true;\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,\r
+                                  &wifi_under_b_mode);\r
+\r
+               /* Set CCK Tx/Rx high Pri except 11b mode */\r
+               if (wifi_under_b_mode) {\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cd,\r
+                                                  0x00); /* CCK Tx */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cf,\r
+                                                  0x00); /* CCK Rx */\r
+               } else {\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cd,\r
+                                                  0x00); /* CCK Tx */\r
+                       btcoexist->btc_write_1byte(btcoexist, 0x6cf,\r
+                                                  0x10); /* CCK Rx */\r
+               }\r
+\r
+               coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist,\r
+                                           0x430);\r
+               coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist,\r
+                                           0x434);\r
+               coex_dm->backup_retry_limit = btcoexist->btc_read_2byte(\r
+                                                     btcoexist, 0x42a);\r
+               coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte(\r
+                               btcoexist, 0x456);\r
+       } else {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], MEDIA disconnect notify\n");\r
+               BTC_TRACE(trace_buf);\r
+               coex_dm->arp_cnt = 0;\r
+\r
+               btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */\r
+               btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */\r
+\r
+               coex_sta->cck_ever_lock = false;\r
+       }\r
+\r
+       /* only 2.4G we need to inform bt the chnl mask */\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL,\r
+                          &wifi_central_chnl);\r
+       if ((BTC_MEDIA_CONNECT == type) &&\r
+           (wifi_central_chnl <= 14)) {\r
+               /* h2c_parameter[0] = 0x1; */\r
+               h2c_parameter[0] = 0x0;\r
+               h2c_parameter[1] = wifi_central_chnl;\r
+               btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw);\r
+               if (BTC_WIFI_BW_HT40 == wifi_bw)\r
+                       h2c_parameter[2] = 0x30;\r
+               else\r
+                       h2c_parameter[2] = 0x20;\r
+       }\r
+\r
+       coex_dm->wifi_chnl_info[0] = h2c_parameter[0];\r
+       coex_dm->wifi_chnl_info[1] = h2c_parameter[1];\r
+       coex_dm->wifi_chnl_info[2] = h2c_parameter[2];\r
+\r
+       btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter);\r
+}\r
+\r
+void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist,\r
+               IN u8 type)\r
+{\r
+       boolean bt_hs_on=false;\r
+       u32     wifi_link_status=0;\r
+       u32     num_of_wifi_link=0;\r
+       boolean bt_ctrl_agg_buf_size=false, under_4way=false;\r
+       u8      agg_buf_size=5;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,\r
+                          &under_4way);\r
+\r
+       if(btcoexist->manual_control ||\r
+               btcoexist->stop_coex_dm ||\r
+               coex_sta->bt_disabled )\r
+               return;\r
+\r
+       if (BTC_PACKET_DHCP == type ||\r
+           BTC_PACKET_EAPOL == type ||\r
+           BTC_PACKET_ARP == type) {\r
+               if (BTC_PACKET_ARP == type) {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                   "[BTCoex], specific Packet ARP notify\n");\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       coex_dm->arp_cnt++;\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                   "[BTCoex], ARP Packet Count = %d\n",\r
+                                   coex_dm->arp_cnt);\r
+                       BTC_TRACE(trace_buf);\r
+\r
+                       if ((coex_dm->arp_cnt >= 10) &&\r
+                           (!under_4way))  /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */\r
+                               coex_sta->wifi_is_high_pri_task = false;\r
+                       else\r
+                               coex_sta->wifi_is_high_pri_task = true;\r
+               } else {\r
+                       coex_sta->wifi_is_high_pri_task = true;\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "[BTCoex], specific Packet DHCP or EAPOL notify\n");\r
+                       BTC_TRACE(trace_buf);\r
+               }\r
+       } else {\r
+               coex_sta->wifi_is_high_pri_task = false;\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "[BTCoex], specific Packet [Type = %d] notify\n", type);\r
+               BTC_TRACE(trace_buf);\r
+       }\r
+\r
+       coex_sta->specific_pkt_period_cnt = 0;\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,\r
+                          &wifi_link_status);\r
+       num_of_wifi_link = wifi_link_status >> 16;\r
+       if (num_of_wifi_link >= 2) {\r
+               halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false,\r
+                                          bt_ctrl_agg_buf_size, agg_buf_size);\r
+               halbtc8723b1ant_action_wifi_multi_port(btcoexist);\r
+               return;\r
+       }\r
+\r
+       btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on);\r
+       if (coex_sta->c2h_bt_inquiry_page) {\r
+               halbtc8723b1ant_action_bt_inquiry(btcoexist);\r
+               return;\r
+       } else if (bt_hs_on) {\r
+               halbtc8723b1ant_action_hs(btcoexist);\r
+               return;\r
+       }\r
+\r
+       if (BTC_PACKET_DHCP == type ||\r
+           BTC_PACKET_EAPOL == type ||\r
+           ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task)))\r
+               halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist);\r
+}\r
+\r
+void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist,\r
+                                      IN u8 *tmp_buf, IN u8 length)\r
+{\r
+       u8                              bt_info = 0;\r
+       u8                              i, rsp_source=0;\r
+       boolean                         wifi_connected=false;\r
+       boolean                         bt_busy=false;\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       \r
+       coex_sta->c2h_bt_info_req_sent = false;\r
+\r
+       rsp_source = tmp_buf[0]&0xf;\r
+       if(rsp_source >= BT_INFO_SRC_8723B_1ANT_MAX)\r
+               rsp_source = BT_INFO_SRC_8723B_1ANT_WIFI_FW;\r
+       coex_sta->bt_info_c2h_cnt[rsp_source]++;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, \r
+"[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, \r
+length);\r
+       BTC_TRACE(trace_buf);\r
+       for (i = 0; i < length; i++) {\r
+               coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i];\r
+               if (i == 1)\r
+                       bt_info = tmp_buf[i];\r
+               if (i == length - 1) {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n",\r
+                                   tmp_buf[i]);\r
+                       BTC_TRACE(trace_buf);\r
+               } else {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ",\r
+                                   tmp_buf[i]);\r
+                       BTC_TRACE(trace_buf);\r
+               }\r
+       }\r
+\r
+       /* if 0xff, it means BT is under WHCK test */\r
+       if (bt_info == 0xff)\r
+               coex_sta->bt_whck_test = true;\r
+       else\r
+               coex_sta->bt_whck_test = false;\r
+\r
+       if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rsp_source) {\r
+               coex_sta->bt_retry_cnt =        /* [3:0] */\r
+                       coex_sta->bt_info_c2h[rsp_source][2]&0xf;\r
+\r
+               if (coex_sta->bt_retry_cnt >= 1)\r
+                       coex_sta->pop_event_cnt++;\r
+\r
+               if (coex_sta->bt_info_c2h[rsp_source][2]&0x20)\r
+                       coex_sta->c2h_bt_remote_name_req = true;\r
+               else\r
+                       coex_sta->c2h_bt_remote_name_req = false;                       \r
+\r
+               coex_sta->bt_rssi =\r
+                       coex_sta->bt_info_c2h[rsp_source][3]*2-90;\r
+               /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */\r
+\r
+               coex_sta->bt_info_ext = \r
+                       coex_sta->bt_info_c2h[rsp_source][4];\r
+\r
+               if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) {\r
+                       coex_sta->a2dp_bit_pool = \r
+                               coex_sta->bt_info_c2h[rsp_source][6]; \r
+               } else\r
+                       coex_sta->a2dp_bit_pool = 0;\r
+\r
+               coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2]\r
+                                          & 0x40);\r
+               btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK,\r
+                                  &coex_sta->bt_tx_rx_mask);\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+               if ((board_info->btdm_ant_det_finish) &&\r
+                   (board_info->btdm_ant_num_by_ant_det == 2)) {\r
+                       if (coex_sta->bt_tx_rx_mask) {\r
+                               /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n");\r
+                               BTC_TRACE(trace_buf);\r
+\r
+                               /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */\r
+                               btcoexist->btc_set_bt_reg(btcoexist,\r
+                                                 BTC_BT_REG_RF, 0x2c, 0x7c45);\r
+                               btcoexist->btc_set_bt_reg(btcoexist,\r
+                                                 BTC_BT_REG_RF, 0x30, 0x7c45);\r
+\r
+                               btcoexist->btc_set_bt_reg(btcoexist,\r
+                                                 BTC_BT_REG_RF, 0x3c, 0x1);\r
+                       }\r
+               } else\r
+#endif                 \r
+#endif\r
+\r
+               {\r
+                       if (!coex_sta->bt_tx_rx_mask) {\r
+                               /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n");\r
+                               BTC_TRACE(trace_buf);\r
+                               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF,\r
+                                                         0x3c, 0x15);\r
+\r
+                               /* BT TRx Mask lock 0x2c[0], 0x30[0] = 0 */\r
+                               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF,\r
+                                                         0x2c, 0x7c44);\r
+                               btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF,\r
+                                                         0x30, 0x7c44);\r
+                       }\r
+               }\r
+               \r
+               /* Here we need to resend some wifi info to BT */\r
+               /* because bt is reset and loss of the info. */\r
+               if (coex_sta->bt_info_ext & BIT(1)) {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n");\r
+                       BTC_TRACE(trace_buf);\r
+                       btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,\r
+                                          &wifi_connected);\r
+                       if (wifi_connected)\r
+                               ex_halbtc8723b1ant_media_status_notify(\r
+                                       btcoexist, BTC_MEDIA_CONNECT);\r
+                       else\r
+                               ex_halbtc8723b1ant_media_status_notify(\r
+                                       btcoexist, BTC_MEDIA_DISCONNECT);\r
+               }\r
+                               \r
+               if (coex_sta->bt_info_ext & BIT(3)) {\r
+                       if(!btcoexist->manual_control && \r
+                           !btcoexist->stop_coex_dm) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                               halbtc8723b1ant_ignore_wlan_act(btcoexist,\r
+                                                       FORCE_EXEC, false);\r
+                       }\r
+               } else {\r
+                       /* BT already NOT ignore Wlan active, do nothing here. */\r
+               }\r
+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0)\r
+               if ((coex_sta->bt_info_ext & BIT(4))) {\r
+                       /* BT auto report already enabled, do nothing */\r
+               } else\r
+                       halbtc8723b1ant_bt_auto_report(btcoexist, FORCE_EXEC,\r
+                                                      true);\r
+#endif\r
+       }\r
+               \r
+       /* check BIT2 first ==> check if bt is under inquiry or page scan */\r
+       if (bt_info & BT_INFO_8723B_1ANT_B_INQ_PAGE)\r
+               coex_sta->c2h_bt_inquiry_page = true;\r
+       else\r
+               coex_sta->c2h_bt_inquiry_page = false;\r
+\r
+       coex_sta->num_of_profile = 0;\r
+\r
+       /* set link exist status */\r
+       if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) {\r
+               coex_sta->bt_link_exist = false;\r
+               coex_sta->pan_exist = false;\r
+               coex_sta->a2dp_exist = false;\r
+               coex_sta->hid_exist = false;\r
+               coex_sta->sco_exist = false;\r
+\r
+               coex_sta->bt_hi_pri_link_exist = false;\r
+       } else {        /* connection exists */\r
+               coex_sta->bt_link_exist = true;\r
+               if (bt_info & BT_INFO_8723B_1ANT_B_FTP) {\r
+                       coex_sta->pan_exist = true;\r
+                       coex_sta->num_of_profile++;\r
+               } else\r
+                       coex_sta->pan_exist = false;\r
+               if (bt_info & BT_INFO_8723B_1ANT_B_A2DP) {\r
+                       coex_sta->a2dp_exist = true;    \r
+                       coex_sta->num_of_profile++;\r
+               } else\r
+                       coex_sta->a2dp_exist = false;\r
+               if (bt_info & BT_INFO_8723B_1ANT_B_HID) {\r
+                       coex_sta->hid_exist = true;\r
+                       coex_sta->num_of_profile++;\r
+               } else\r
+                       coex_sta->hid_exist = false;\r
+               if (bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) {\r
+                       coex_sta->sco_exist = true;\r
+                       coex_sta->num_of_profile++;\r
+               } else\r
+                       coex_sta->sco_exist = false;\r
+\r
+               if ((coex_sta->hid_exist == false) &&\r
+                   (coex_sta->c2h_bt_inquiry_page == false) &&\r
+                   (coex_sta->sco_exist == false)) {\r
+                       if (coex_sta->high_priority_tx  +\r
+                           coex_sta->high_priority_rx >= 160) {\r
+                               coex_sta->hid_exist = true;\r
+                               coex_sta->wrong_profile_notification++;\r
+                               coex_sta->num_of_profile++;\r
+                               bt_info = bt_info | 0x28;\r
+                       }\r
+               }\r
+\r
+               /* Add Hi-Pri Tx/Rx counter to avoid false detection */\r
+               if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) &&\r
+                   (coex_sta->high_priority_tx  +\r
+                    coex_sta->high_priority_rx >= 160)\r
+                   && (!coex_sta->c2h_bt_inquiry_page))\r
+                       coex_sta->bt_hi_pri_link_exist = true;\r
+\r
+               if ((bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) &&\r
+                   (coex_sta->num_of_profile == 0)) {\r
+                       if (coex_sta->low_priority_tx  +\r
+                           coex_sta->low_priority_rx >= 160) {\r
+                               coex_sta->pan_exist = true;\r
+                               coex_sta->num_of_profile++;\r
+                               coex_sta->wrong_profile_notification++;\r
+                               bt_info = bt_info | 0x88;\r
+                       }\r
+               }\r
+       }\r
+\r
+       halbtc8723b1ant_update_bt_link_info(btcoexist);\r
+       \r
+       bt_info = bt_info &\r
+               0x1f;  /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */\r
+       \r
+       if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION))\r
+               coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE;\r
+       else if (bt_info ==\r
+               BT_INFO_8723B_1ANT_B_CONNECTION)        /* connection exists but no busy */\r
+               coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE;\r
+       else if ((bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) ||\r
+                (bt_info & BT_INFO_8723B_1ANT_B_SCO_BUSY))\r
+               coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_SCO_BUSY;\r
+       else if (bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) {\r
+               if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status)\r
+                       coex_dm->auto_tdma_adjust = false;\r
+               coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_ACL_BUSY;\r
+       } else\r
+               coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_MAX;\r
+\r
+       if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) ||\r
+               (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||\r
+               (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status) )\r
+               bt_busy = true;\r
+       else\r
+               bt_busy = false;\r
+       btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy);\r
+\r
+       halbtc8723b1ant_run_coexist_mechanism(btcoexist);\r
+}\r
+\r
+void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist,\r
+               IN u8 type)\r
+{\r
+       u32     u32tmp;\r
+       u8      u8tmpa,u8tmpb, u8tmpc;\r
+       \r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       if (BTC_RF_ON == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], RF is turned ON!!\n");\r
+               BTC_TRACE(trace_buf);\r
+               btcoexist->stop_coex_dm = false;\r
+       } else if (BTC_RF_OFF == type) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], RF is turned OFF!!\n");\r
+               BTC_TRACE(trace_buf);\r
+               \r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, \r
+0x0, 0x0);\r
+               halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, \r
+FORCE_EXEC, false, true);\r
+               \r
+               halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true);\r
+               btcoexist->stop_coex_dm = true;\r
+\r
+               u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948);\r
+               u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765);\r
+               u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67);\r
+               u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e);\r
+\r
+\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                       "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n",\r
+                           u32tmp,  u8tmpa, u8tmpb, u8tmpc);\r
+               BTC_TRACE(trace_buf);\r
+\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist)\r
+{\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+       halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,\r
+                                        0x0);\r
+       halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0);\r
+       halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC,\r
+                                    false, true);\r
+\r
+       halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true);\r
+\r
+       ex_halbtc8723b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT);\r
+\r
+       btcoexist->stop_coex_dm = true; \r
+}\r
+\r
+void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist,\r
+                                  IN u8 pnp_state)\r
+{\r
+       if (BTC_WIFI_PNP_SLEEP == pnp_state) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], Pnp notify to SLEEP\n");\r
+               BTC_TRACE(trace_buf);\r
+\r
+               halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE,\r
+                                                0x0, 0x0);\r
+               halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);\r
+               halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT,\r
+                                            FORCE_EXEC, false, true);\r
+               halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2);\r
+\r
+               /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */\r
+               /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */\r
+               /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */\r
+               coex_sta->under_ips = false;\r
+               coex_sta->under_lps = false;\r
+               btcoexist->stop_coex_dm = true;\r
+       } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) {\r
+               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                           "[BTCoex], Pnp notify to WAKE UP\n");\r
+               BTC_TRACE(trace_buf);\r
+               btcoexist->stop_coex_dm = false;\r
+               halbtc8723b1ant_init_hw_config(btcoexist, false, false);\r
+               halbtc8723b1ant_init_coex_dm(btcoexist);\r
+               halbtc8723b1ant_query_bt_info(btcoexist);\r
+       }\r
+}\r
+\r
+void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist)\r
+{\r
+\r
+       halbtc8723b1ant_init_hw_config(btcoexist, false, false);\r
+       /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */\r
+       /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */\r
+       halbtc8723b1ant_init_coex_dm(btcoexist);\r
+}\r
+\r
+void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist)\r
+{\r
+       struct  btc_bt_link_info        *bt_link_info = &btcoexist->bt_link_info;\r
+\r
+       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+               "[BTCoex], ==========================Periodical===========================\n");\r
+       BTC_TRACE(trace_buf);\r
+\r
+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0)\r
+       halbtc8723b1ant_query_bt_info(btcoexist);\r
+       halbtc8723b1ant_monitor_bt_enable_disable(btcoexist);\r
+#else\r
+       halbtc8723b1ant_monitor_bt_ctr(btcoexist);\r
+       halbtc8723b1ant_monitor_wifi_ctr(btcoexist);\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+       halbtc8723b1ant_monitor_bt_enable_disable(btcoexist);\r
+#endif\r
+\r
+       if ((coex_sta->high_priority_tx  + coex_sta->high_priority_rx < 50) &&\r
+           (bt_link_info->hid_exist == true))\r
+               bt_link_info->hid_exist  = false;\r
+\r
+       if( halbtc8723b1ant_is_wifi_status_changed(btcoexist) ||\r
+               coex_dm->auto_tdma_adjust )\r
+               halbtc8723b1ant_run_coexist_mechanism(btcoexist);       \r
+\r
+       coex_sta->specific_pkt_period_cnt++;\r
+\r
+       /* sample to set bt to execute Ant detection */\r
+       /* btcoexist->btc_set_bt_ant_detection(btcoexist, 20, 14);\r
+       *\r
+       if (psd_scan->is_ant_det_enable)\r
+       {\r
+                if (psd_scan->psd_gen_count > psd_scan->realseconds)\r
+                       psd_scan->psd_gen_count = 0;\r
+\r
+               halbtc8723b1ant_antenna_detection(btcoexist, psd_scan->realcent_freq,  psd_scan->realoffset, psd_scan->realspan,  psd_scan->realseconds);\r
+               psd_scan->psd_gen_total_count +=2;\r
+               psd_scan->psd_gen_count += 2;\r
+       }\r
+       */              \r
+#endif\r
+}\r
+\r
+void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist,\r
+               IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds)\r
+{\r
+#if BT_8723B_1ANT_ANTDET_ENABLE        \r
+       static u32 ant_det_count = 0, ant_det_fail_count = 0;\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+       /*boolean scan, roam;*/\r
+\r
+       if (seconds == 0) {\r
+               psd_scan->ant_det_try_count     = 0;\r
+               psd_scan->ant_det_fail_count    = 0;\r
+               ant_det_count = 0;\r
+               ant_det_fail_count = 0;\r
+               board_info->btdm_ant_det_finish = false;\r
+               board_info->btdm_ant_num_by_ant_det = 1;\r
+               return;\r
+       }\r
+\r
+       if (!board_info->btdm_ant_det_finish) {\r
+               psd_scan->ant_det_inteval_count =\r
+                       psd_scan->ant_det_inteval_count + 2;\r
+\r
+               if (psd_scan->ant_det_inteval_count >=\r
+                   BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n");\r
+                       BTC_TRACE(trace_buf);\r
+                       halbtc8723b1ant_psd_antenna_detection_check(btcoexist);\r
+\r
+                       if (board_info->btdm_ant_det_finish) {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+#if 1\r
+                               if (board_info->btdm_ant_num_by_ant_det == 2)\r
+                                       halbtc8723b1ant_mechanism_switch(\r
+                                               btcoexist, true);\r
+                               else\r
+                                       halbtc8723b1ant_mechanism_switch(\r
+                                               btcoexist, false);\r
+#endif\r
+                       } else {\r
+                               BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                                       "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n");\r
+                               BTC_TRACE(trace_buf);\r
+                       }\r
+                       psd_scan->ant_det_inteval_count = 0;\r
+               } else {\r
+                       BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,\r
+                               "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n",\r
+                                   psd_scan->ant_det_inteval_count);\r
+                       BTC_TRACE(trace_buf);\r
+               }\r
+\r
+       }\r
+#endif\r
+               \r
+               \r
+/*\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);\r
+               btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);\r
+\r
+\r
+               psd_scan->ant_det_bt_tx_time = seconds;\r
+       psd_scan->ant_det_bt_le_channel = cent_freq;            \r
+               \r
+       if (seconds == 0)\r
+               {\r
+               psd_scan->ant_det_try_count     = 0;\r
+               psd_scan->ant_det_fail_count    = 0;\r
+               ant_det_count = 0;\r
+               ant_det_fail_count = 0;\r
+               board_info->btdm_ant_det_finish = false;\r
+               board_info->btdm_ant_num_by_ant_det = 1;\r
+                        return;\r
+       }\r
+       else\r
+       {\r
+               ant_det_count++;\r
+       \r
+               psd_scan->ant_det_try_count = ant_det_count;    \r
+                               \r
+                       if (scan ||roam)\r
+               {\r
+                       board_info->btdm_ant_det_finish = false;\r
+                       psd_scan->ant_det_result = 6;\r
+               }\r
+               else if (coex_sta->num_of_profile >= 1) \r
+               {\r
+                       board_info->btdm_ant_det_finish = false;\r
+                       psd_scan->ant_det_result = 7;\r
+               }                       \r
+                       else if (!psd_scan->ant_det_is_ant_det_available)\r
+               {\r
+                       board_info->btdm_ant_det_finish = false;\r
+                       psd_scan->ant_det_result = 9;\r
+               }                               \r
+               else if (coex_sta->c2h_bt_inquiry_page)\r
+               {\r
+                       board_info->btdm_ant_det_finish = false;\r
+                       psd_scan->ant_det_result = 10;\r
+               }       \r
+               else\r
+               {\r
+\r
+       }\r
+\r
+               if (!board_info->btdm_ant_det_finish)\r
+                       ant_det_fail_count++;\r
+\r
+               psd_scan->ant_det_fail_count = ant_det_fail_count;\r
+       }\r
+*/\r
+}\r
+\r
+\r
+void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist)\r
+{\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+       struct  btc_board_info  *board_info = &btcoexist->board_info;\r
+\r
+       if (psd_scan->ant_det_try_count != 0)   {\r
+               halbtc8723b1ant_psd_show_antenna_detect_result(btcoexist);\r
+\r
+               if (board_info->btdm_ant_det_finish)\r
+                       halbtc8723b1ant_psd_showdata(btcoexist);\r
+               return;\r
+       }\r
+#endif\r
+       \r
+       /* halbtc8723b1ant_show_psd_data(btcoexist); */\r
+}\r
+\r
+#endif\r
+\r
+#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */\r