net: wireless: rockchip_wlan: add rtl8188fu support
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8188fu / hal / btc / HalBtc8723b1Ant.c
diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188fu/hal/btc/HalBtc8723b1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188fu/hal/btc/HalBtc8723b1Ant.c
new file mode 100644 (file)
index 0000000..265ef13
--- /dev/null
@@ -0,0 +1,5638 @@
+//============================================================\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 WPP_SOFTWARE_TRACE\r
+#include "HalBtc8723b1Ant.tmh"\r
+#endif\r
+\r
+//#include <Math.h>\r
+#if(BT_30_SUPPORT == 1)\r
+//============================================================\r
+// Global variables, these are static variables\r
+//============================================================\r
+static COEX_DM_8723B_1ANT              GLCoexDm8723b1Ant;\r
+static PCOEX_DM_8723B_1ANT     pCoexDm=&GLCoexDm8723b1Ant;\r
+static COEX_STA_8723B_1ANT             GLCoexSta8723b1Ant;\r
+static PCOEX_STA_8723B_1ANT    pCoexSta=&GLCoexSta8723b1Ant;\r
+static PSDSCAN_STA_8723B_1ANT  GLPsdScan8723b1Ant;\r
+static PPSDSCAN_STA_8723B_1ANT pPsdScan = &GLPsdScan8723b1Ant;\r
+\r
+\r
+const char *const GLBtInfoSrc8723b1Ant[]={\r
+       "BT Info[wifi fw]",\r
+       "BT Info[bt rsp]",\r
+       "BT Info[bt auto report]",\r
+};\r
+\r
+u4Byte GLCoexVerDate8723b1Ant=20150119;\r
+u4Byte GLCoexVer8723b1Ant=0x58;\r
+\r
+//============================================================\r
+// local function proto type if needed\r
+//============================================================\r
+//============================================================\r
+// local function start with halbtc8723b1ant_\r
+//============================================================\r
+u1Byte\r
+halbtc8723b1ant_BtRssiState(\r
+       u1Byte                  levelNum,\r
+       u1Byte                  rssiThresh,\r
+       u1Byte                  rssiThresh1\r
+       )\r
+{\r
+       s4Byte                  btRssi=0;\r
+       u1Byte                  btRssiState=pCoexSta->preBtRssiState;\r
+\r
+       btRssi = pCoexSta->btRssi;\r
+\r
+       if(levelNum == 2)\r
+       {                       \r
+               if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||\r
+                       (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW))\r
+               {\r
+                       if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_HIGH;\r
+                       }\r
+                       else\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_STAY_LOW;\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if(btRssi < rssiThresh)\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_LOW;\r
+                       }\r
+                       else\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_STAY_HIGH;\r
+                       }\r
+               }\r
+       }\r
+       else if(levelNum == 3)\r
+       {\r
+               if(rssiThresh > rssiThresh1)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n"));\r
+                       return pCoexSta->preBtRssiState;\r
+               }\r
+               \r
+               if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||\r
+                       (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW))\r
+               {\r
+                       if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_MEDIUM;\r
+                       }\r
+                       else\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_STAY_LOW;\r
+                       }\r
+               }\r
+               else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) ||\r
+                       (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM))\r
+               {\r
+                       if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_HIGH;\r
+                       }\r
+                       else if(btRssi < rssiThresh)\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_LOW;\r
+                       }\r
+                       else\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_STAY_MEDIUM;\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if(btRssi < rssiThresh1)\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_MEDIUM;\r
+                       }\r
+                       else\r
+                       {\r
+                               btRssiState = BTC_RSSI_STATE_STAY_HIGH;\r
+                       }\r
+               }\r
+       }\r
+               \r
+       pCoexSta->preBtRssiState = btRssiState;\r
+\r
+       return btRssiState;\r
+}\r
+\r
+u1Byte\r
+halbtc8723b1ant_WifiRssiState(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  index,\r
+       IN      u1Byte                  levelNum,\r
+       IN      u1Byte                  rssiThresh,\r
+       IN      u1Byte                  rssiThresh1\r
+       )\r
+{\r
+       s4Byte                  wifiRssi=0;\r
+       u1Byte                  wifiRssiState=pCoexSta->preWifiRssiState[index];\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);\r
+       \r
+       if(levelNum == 2)\r
+       {\r
+               if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) ||\r
+                       (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW))\r
+               {\r
+                       if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_HIGH;\r
+                       }\r
+                       else\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_STAY_LOW;\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if(wifiRssi < rssiThresh)\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_LOW;\r
+                       }\r
+                       else\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_STAY_HIGH;\r
+                       }\r
+               }\r
+       }\r
+       else if(levelNum == 3)\r
+       {\r
+               if(rssiThresh > rssiThresh1)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n"));\r
+                       return pCoexSta->preWifiRssiState[index];\r
+               }\r
+               \r
+               if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) ||\r
+                       (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW))\r
+               {\r
+                       if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_MEDIUM;\r
+                       }\r
+                       else\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_STAY_LOW;\r
+                       }\r
+               }\r
+               else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) ||\r
+                       (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM))\r
+               {\r
+                       if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT))\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_HIGH;\r
+                       }\r
+                       else if(wifiRssi < rssiThresh)\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_LOW;\r
+                       }\r
+                       else\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM;\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if(wifiRssi < rssiThresh1)\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_MEDIUM;\r
+                       }\r
+                       else\r
+                       {\r
+                               wifiRssiState = BTC_RSSI_STATE_STAY_HIGH;\r
+                       }\r
+               }\r
+       }\r
+               \r
+       pCoexSta->preWifiRssiState[index] = wifiRssiState;\r
+\r
+       return wifiRssiState;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_UpdateRaMask(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u4Byte                          disRateMask\r
+       )\r
+{\r
+       pCoexDm->curRaMask = disRateMask;\r
+       \r
+       if( bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask))\r
+       {\r
+               pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_UPDATE_RAMASK, &pCoexDm->curRaMask);\r
+       }\r
+       pCoexDm->preRaMask = pCoexDm->curRaMask;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_AutoRateFallbackRetry(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       BOOLEAN bWifiUnderBMode=FALSE;\r
+       \r
+       pCoexDm->curArfrType = type;\r
+\r
+       if( bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType))\r
+       {\r
+               switch(pCoexDm->curArfrType)\r
+               {\r
+                       case 0: // normal mode\r
+                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, pCoexDm->backupArfrCnt1);\r
+                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, pCoexDm->backupArfrCnt2);\r
+                               break;\r
+                       case 1: \r
+                               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode);\r
+                               if(bWifiUnderBMode)\r
+                               {\r
+                                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);\r
+                                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101);\r
+                               }\r
+                               else\r
+                               {\r
+                                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);\r
+                                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201);\r
+                               }\r
+                               break;\r
+                       default:\r
+                               break;\r
+               }\r
+       }\r
+\r
+       pCoexDm->preArfrType = pCoexDm->curArfrType;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_RetryLimit(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       pCoexDm->curRetryLimitType = type;\r
+\r
+       if( bForceExec || (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType))\r
+       {\r
+               switch(pCoexDm->curRetryLimitType)\r
+               {\r
+                       case 0: // normal mode\r
+                               pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, pCoexDm->backupRetryLimit);\r
+                               break;\r
+                       case 1: // retry limit=8\r
+                               pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808);\r
+                               break;\r
+                       default:\r
+                               break;\r
+               }\r
+       }\r
+\r
+       pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_AmpduMaxTime(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       pCoexDm->curAmpduTimeType = type;\r
+\r
+       if( bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType))\r
+       {\r
+               switch(pCoexDm->curAmpduTimeType)\r
+               {\r
+                       case 0: // normal mode\r
+                               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime);\r
+                               break;\r
+                       case 1: // AMPDU timw = 0x38 * 32us\r
+                               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38);\r
+                               break;\r
+                       default:\r
+                               break;\r
+               }\r
+       }\r
+\r
+       pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_LimitedTx(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u1Byte                          raMaskType,\r
+       IN      u1Byte                          arfrType,\r
+       IN      u1Byte                          retryLimitType,\r
+       IN      u1Byte                          ampduTimeType\r
+       )\r
+{\r
+       switch(raMaskType)\r
+       {\r
+               case 0: // normal mode\r
+                       halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0);\r
+                       break;\r
+               case 1: // disable cck 1/2\r
+                       halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 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_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7);\r
+                       break;\r
+               default:\r
+                       break;\r
+       }\r
+\r
+       halbtc8723b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType);\r
+       halbtc8723b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType);\r
+       halbtc8723b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_LimitedRx(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      BOOLEAN                         bRejApAggPkt,\r
+       IN      BOOLEAN                         bBtCtrlAggBufSize,\r
+       IN      u1Byte                          aggBufSize\r
+       )\r
+{\r
+       BOOLEAN bRejectRxAgg=bRejApAggPkt;\r
+       BOOLEAN bBtCtrlRxAggSize=bBtCtrlAggBufSize;\r
+       u1Byte  rxAggSize=aggBufSize;\r
+\r
+       //============================================\r
+       //      Rx Aggregation related setting\r
+       //============================================\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg);\r
+       // decide BT control aggregation buf size or not\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize);\r
+       // aggregation buf size, only work when BT control Rx aggregation size.\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize);\r
+       // real update aggregation setting\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);\r
+\r
+\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_QueryBtInfo(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[1] ={0};\r
+\r
+       pCoexSta->bC2hBtInfoReqSent = TRUE;\r
+\r
+       H2C_Parameter[0] |= BIT0;       // trigger\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x61=0x%x\n", \r
+               H2C_Parameter[0]));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_MonitorBtCtr(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       u4Byte                  regHPTxRx, regLPTxRx, u4Tmp, u4Tmp1;\r
+       u4Byte                  regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0;\r
+       u1Byte                  u1Tmp, u1Tmp1;\r
+       s4Byte                  wifiRssi;\r
+       static u4Byte           NumOfBtCounterChk = 0;\r
+       \r
+       //to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS\r
+       //if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8) ) \r
+\r
+       if (pCoexSta->bUnderIps)\r
+       {\r
+               //pCoexSta->highPriorityTx = 65535;\r
+               //pCoexSta->highPriorityRx = 65535;\r
+               //pCoexSta->lowPriorityTx = 65535;\r
+               //pCoexSta->lowPriorityRx = 65535;\r
+               //return;\r
+       }\r
+               \r
+       regHPTxRx = 0x770;\r
+       regLPTxRx = 0x774;\r
+\r
+       u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx);\r
+       regHPTx = u4Tmp & bMaskLWord;\r
+       regHPRx = (u4Tmp & bMaskHWord)>>16;\r
+\r
+       u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx);\r
+       regLPTx = u4Tmp & bMaskLWord;\r
+       regLPRx = (u4Tmp & bMaskHWord)>>16;\r
+               \r
+       pCoexSta->highPriorityTx = regHPTx;\r
+       pCoexSta->highPriorityRx = regHPRx;\r
+       pCoexSta->lowPriorityTx = regLPTx;\r
+       pCoexSta->lowPriorityRx = regLPRx;\r
+\r
+       if( (pCoexSta->lowPriorityTx > 1050)  && (!pCoexSta->bC2hBtInquiryPage))\r
+               pCoexSta->popEventCnt++;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n",\r
+               regHPRx, regHPTx, regLPRx, regLPTx));\r
+\r
+       // reset counter\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 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 ((regHPTx == 0) && (regHPRx ==0) && (regLPTx == 0) && (regLPRx == 0))\r
+       {\r
+               NumOfBtCounterChk++;\r
+               if (NumOfBtCounterChk == 3)\r
+{\r
+                       halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+               }\r
+       }\r
+       else\r
+       {\r
+                       NumOfBtCounterChk = 0;\r
+               }\r
+       }\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_MonitorWiFiCtr(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       u4Byte  u4Tmp;\r
+       u2Byte  u2Tmp[3];\r
+       s4Byte  wifiRssi=0;\r
+       BOOLEAN bWifiBusy = FALSE, bWifiUnderBMode = FALSE;\r
+       static u1Byte nCCKLockCounter = 0;\r
+       u4Byte  TotalCnt;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode);\r
+\r
+       if (pCoexSta->bUnderIps)\r
+       {\r
+               pCoexSta->nCRCOK_CCK = 0;\r
+               pCoexSta->nCRCOK_11g = 0;\r
+               pCoexSta->nCRCOK_11n = 0;\r
+               pCoexSta->nCRCOK_11nAgg = 0;\r
+\r
+               pCoexSta->nCRCErr_CCK = 0;\r
+               pCoexSta->nCRCErr_11g = 0;\r
+               pCoexSta->nCRCErr_11n = 0;\r
+               pCoexSta->nCRCErr_11nAgg = 0;   \r
+       }\r
+       else\r
+       {\r
+               pCoexSta->nCRCOK_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88);\r
+               pCoexSta->nCRCOK_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94);\r
+               pCoexSta->nCRCOK_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90);\r
+               pCoexSta->nCRCOK_11nAgg= pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8);\r
+\r
+               pCoexSta->nCRCErr_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84);\r
+               pCoexSta->nCRCErr_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96);\r
+               pCoexSta->nCRCErr_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92);\r
+               pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba);                \r
+       }\r
+\r
+\r
+       //reset counter\r
+       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1);\r
+       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0);\r
+\r
+       if ( (bWifiBusy) && (wifiRssi >= 30) && (!bWifiUnderBMode))\r
+       {\r
+               TotalCnt = pCoexSta->nCRCOK_CCK + pCoexSta->nCRCOK_11g + pCoexSta->nCRCOK_11n + \r
+                               pCoexSta->nCRCOK_11nAgg;\r
+       \r
+               if ( (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) ||\r
+                       (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) ||\r
+                       (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_SCO_BUSY) )\r
+               {\r
+                       if (pCoexSta->nCRCOK_CCK >(TotalCnt -pCoexSta->nCRCOK_CCK)) \r
+                       {\r
+                               if (nCCKLockCounter < 3)\r
+                                nCCKLockCounter++;\r
+                       }\r
+                       else\r
+                       {\r
+                               if (nCCKLockCounter > 0)\r
+                                nCCKLockCounter--;\r
+                       }\r
+\r
+               }\r
+               else\r
+               {\r
+                       if (nCCKLockCounter > 0)\r
+                         nCCKLockCounter--;\r
+               }\r
+       }\r
+       else\r
+       {\r
+               if (nCCKLockCounter > 0)\r
+                       nCCKLockCounter--;\r
+       }\r
+\r
+       if (!pCoexSta->bPreCCKLock)\r
+       {\r
+\r
+               if (nCCKLockCounter >= 3)\r
+                pCoexSta->bCCKLock = TRUE;\r
+               else\r
+                pCoexSta->bCCKLock = FALSE;                    \r
+       }\r
+       else\r
+       {\r
+               if (nCCKLockCounter == 0)\r
+                pCoexSta->bCCKLock = FALSE;\r
+               else\r
+                pCoexSta->bCCKLock = TRUE;             \r
+       }\r
+\r
+       if  (pCoexSta->bCCKLock)\r
+               pCoexSta->bCCKEverLock = TRUE;\r
+       \r
+       pCoexSta->bPreCCKLock =  pCoexSta->bCCKLock;    \r
+               \r
+\r
+}\r
+\r
+BOOLEAN\r
+halbtc8723b1ant_IsWifiStatusChanged(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       static BOOLEAN  bPreWifiBusy=FALSE, bPreUnder4way=FALSE, bPreBtHsOn=FALSE;\r
+       BOOLEAN bWifiBusy=FALSE, bUnder4way=FALSE, bBtHsOn=FALSE;\r
+       BOOLEAN bWifiConnected=FALSE;\r
+       u1Byte  wifiRssiState=BTC_RSSI_STATE_HIGH;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way);\r
+\r
+       if(bWifiConnected)\r
+       {\r
+               if(bWifiBusy != bPreWifiBusy)\r
+               {\r
+                       bPreWifiBusy = bWifiBusy;\r
+                       return TRUE;\r
+               }\r
+               if(bUnder4way != bPreUnder4way)\r
+               {\r
+                       bPreUnder4way = bUnder4way;\r
+                       return TRUE;\r
+               }\r
+               if(bBtHsOn != bPreBtHsOn)\r
+               {\r
+                       bPreBtHsOn = bBtHsOn;\r
+                       return TRUE;\r
+               }\r
+\r
+            \r
+       }\r
+\r
+       return FALSE;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_UpdateBtLinkInfo(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO       pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN                         bBtHsOn=FALSE;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+\r
+       pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist;\r
+       pBtLinkInfo->bScoExist = pCoexSta->bScoExist;\r
+       pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist;\r
+       pBtLinkInfo->bPanExist = pCoexSta->bPanExist;\r
+       pBtLinkInfo->bHidExist = pCoexSta->bHidExist;\r
+       pBtLinkInfo->bBtHiPriLinkExist = pCoexSta->bBtHiPriLinkExist;\r
+\r
+       // work around for HS mode.\r
+       if(bBtHsOn)\r
+       {\r
+               pBtLinkInfo->bPanExist = TRUE;\r
+               pBtLinkInfo->bBtLinkExist = TRUE;\r
+       }\r
+\r
+       // check if Sco only\r
+       if( pBtLinkInfo->bScoExist &&\r
+               !pBtLinkInfo->bA2dpExist &&\r
+               !pBtLinkInfo->bPanExist &&\r
+               !pBtLinkInfo->bHidExist )\r
+               pBtLinkInfo->bScoOnly = TRUE;\r
+       else\r
+               pBtLinkInfo->bScoOnly = FALSE;\r
+\r
+       // check if A2dp only\r
+       if( !pBtLinkInfo->bScoExist &&\r
+               pBtLinkInfo->bA2dpExist &&\r
+               !pBtLinkInfo->bPanExist &&\r
+               !pBtLinkInfo->bHidExist )\r
+               pBtLinkInfo->bA2dpOnly = TRUE;\r
+       else\r
+               pBtLinkInfo->bA2dpOnly = FALSE;\r
+\r
+       // check if Pan only\r
+       if( !pBtLinkInfo->bScoExist &&\r
+               !pBtLinkInfo->bA2dpExist &&\r
+               pBtLinkInfo->bPanExist &&\r
+               !pBtLinkInfo->bHidExist )\r
+               pBtLinkInfo->bPanOnly = TRUE;\r
+       else\r
+               pBtLinkInfo->bPanOnly = FALSE;\r
+       \r
+       // check if Hid only\r
+       if( !pBtLinkInfo->bScoExist &&\r
+               !pBtLinkInfo->bA2dpExist &&\r
+               !pBtLinkInfo->bPanExist &&\r
+               pBtLinkInfo->bHidExist )\r
+               pBtLinkInfo->bHidOnly = TRUE;\r
+       else\r
+               pBtLinkInfo->bHidOnly = FALSE;\r
+}\r
+\r
+u1Byte\r
+halbtc8723b1ant_ActionAlgorithm(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO       pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN                         bBtHsOn=FALSE;\r
+       u1Byte                          algorithm=BT_8723B_1ANT_COEX_ALGO_UNDEFINED;\r
+       u1Byte                          numOfDiffProfile=0;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+\r
+       if(!pBtLinkInfo->bBtLinkExist)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No BT link exists!!!\n"));\r
+               return algorithm;\r
+       }\r
+\r
+       if(pBtLinkInfo->bScoExist)\r
+               numOfDiffProfile++;\r
+       if(pBtLinkInfo->bHidExist)\r
+               numOfDiffProfile++;\r
+       if(pBtLinkInfo->bPanExist)\r
+               numOfDiffProfile++;\r
+       if(pBtLinkInfo->bA2dpExist)\r
+               numOfDiffProfile++;\r
+       \r
+       if(numOfDiffProfile == 1)\r
+       {\r
+               if(pBtLinkInfo->bScoExist)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO only\n"));\r
+                       algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;\r
+               }\r
+               else\r
+               {\r
+                       if(pBtLinkInfo->bHidExist)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID only\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_HID;\r
+                       }\r
+                       else if(pBtLinkInfo->bA2dpExist)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP only\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP;\r
+                       }\r
+                       else if(pBtLinkInfo->bPanExist)\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(HS) only\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANHS;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = PAN(EDR) only\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR;\r
+                               }\r
+                       }\r
+               }\r
+       }\r
+       else if(numOfDiffProfile == 2)\r
+       {\r
+               if(pBtLinkInfo->bScoExist)\r
+               {\r
+                       if(pBtLinkInfo->bHidExist)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_HID;\r
+                       }\r
+                       else if(pBtLinkInfo->bA2dpExist)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;\r
+                       }\r
+                       else if(pBtLinkInfo->bPanExist)\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + PAN(EDR)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;\r
+                               }\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;\r
+                       }\r
+                       else if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bPanExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + PAN(EDR)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;\r
+                               }\r
+                       }\r
+                       else if( pBtLinkInfo->bPanExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP;\r
+                               }\r
+                       }\r
+               }\r
+       }\r
+       else if(numOfDiffProfile == 3)\r
+       {\r
+               if(pBtLinkInfo->bScoExist)\r
+               {\r
+                       if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"));\r
+                               algorithm = BT_8723B_1ANT_COEX_ALGO_HID;\r
+                       }\r
+                       else if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bPanExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;\r
+                               }\r
+                       }\r
+                       else if( pBtLinkInfo->bPanExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;\r
+                               }\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bPanExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR;\r
+                               }\r
+                       }\r
+               }\r
+       }\r
+       else if(numOfDiffProfile >= 3)\r
+       {\r
+               if(pBtLinkInfo->bScoExist)\r
+               {\r
+                       if( pBtLinkInfo->bHidExist &&\r
+                               pBtLinkInfo->bPanExist &&\r
+                               pBtLinkInfo->bA2dpExist )\r
+                       {\r
+                               if(bBtHsOn)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"));\r
+\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"));\r
+                                       algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;\r
+                               }\r
+                       }\r
+               }\r
+       }\r
+\r
+       return algorithm;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetBtAutoReport(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bEnableAutoReport\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[1] ={0};\r
+       \r
+       H2C_Parameter[0] = 0;\r
+\r
+       if(bEnableAutoReport)\r
+       {\r
+               H2C_Parameter[0] |= BIT0;\r
+       }\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], BT FW auto report : %s, FW write 0x68=0x%x\n", \r
+               (bEnableAutoReport? "Enabled!!":"Disabled!!"), H2C_Parameter[0]));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x68, 1, H2C_Parameter);    \r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_BtAutoReport(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      BOOLEAN                 bEnableAutoReport\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s BT Auto report = %s\n",  \r
+               (bForceExec? "force to":""), ((bEnableAutoReport)? "Enabled":"Disabled")));\r
+       pCoexDm->bCurBtAutoReport = bEnableAutoReport;\r
+\r
+       if(!bForceExec)\r
+       {\r
+               if(pCoexDm->bPreBtAutoReport == pCoexDm->bCurBtAutoReport) \r
+                       return;\r
+       }\r
+       halbtc8723b1ant_SetBtAutoReport(pBtCoexist, pCoexDm->bCurBtAutoReport);\r
+\r
+       pCoexDm->bPreBtAutoReport = pCoexDm->bCurBtAutoReport;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bLowPenaltyRa\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[6] ={0};\r
+       \r
+       H2C_Parameter[0] = 0x6; // opCode, 0x6= Retry_Penalty\r
+\r
+       if(bLowPenaltyRa)\r
+       {\r
+               H2C_Parameter[1] |= BIT0;\r
+               H2C_Parameter[2] = 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
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set WiFi Low-Penalty Retry: %s", \r
+               (bLowPenaltyRa? "ON!!":"OFF!!") ));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_LowPenaltyRa(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      BOOLEAN                 bLowPenaltyRa\r
+       )\r
+{\r
+       pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa;\r
+\r
+       if(!bForceExec)\r
+       {\r
+               if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) \r
+                       return;\r
+       }\r
+       halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa);\r
+\r
+       pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetCoexTable(\r
+       IN      PBTC_COEXIST    pBtCoexist,\r
+       IN      u4Byte          val0x6c0,\r
+       IN      u4Byte          val0x6c4,\r
+       IN      u4Byte          val0x6c8,\r
+       IN      u1Byte          val0x6cc\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0));\r
+       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0);\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4));\r
+       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4);\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8));\r
+       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8);\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc));\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_CoexTable(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      u4Byte                  val0x6c0,\r
+       IN      u4Byte                  val0x6c4,\r
+       IN      u4Byte                  val0x6c8,\r
+       IN      u1Byte                  val0x6cc\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6cc=0x%x\n", \r
+               (bForceExec? "force to":""), val0x6c0, val0x6c4, val0x6cc));\r
+       pCoexDm->curVal0x6c0 = val0x6c0;\r
+       pCoexDm->curVal0x6c4 = val0x6c4;\r
+       pCoexDm->curVal0x6c8 = val0x6c8;\r
+       pCoexDm->curVal0x6cc = val0x6cc;\r
+\r
+       if(!bForceExec)\r
+       {\r
+               if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) &&\r
+                       (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) &&\r
+                       (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) &&\r
+                       (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) )\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc);\r
+\r
+       pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0;\r
+       pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4;\r
+       pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8;\r
+       pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_CoexTableWithType(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE    \r
+       if (pBoardInfo->btdmAntNumByAntDet == 2)\r
+       {\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
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** CoexTable(%d) **********\n", type));\r
+       \r
+       pCoexSta->nCoexTableType = type;\r
+       \r
+       switch(type)\r
+       {\r
+               case 0:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3);\r
+                       break;\r
+               case 1:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3);\r
+                       break;\r
+               case 2:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3);\r
+                       break;\r
+               case 3:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3);\r
+                       break;\r
+               case 4:\r
+                       if  ( pCoexSta->bCCKEverLock) \r
+                               halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3);\r
+                       else\r
+                               halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3);\r
+                       break;\r
+               case 5:\r
+                       if  ( pCoexSta->bCCKEverLock) \r
+                               halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaa5a5a, 0xaaaa5a5a, 0xffffff, 0x3);\r
+                       else\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3);\r
+                       break;\r
+               case 6:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3);\r
+                       break;\r
+               case 7:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3);\r
+                       break;\r
+               case 8:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 9:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 10:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 11:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 12:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 13:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3);\r
+                       break;\r
+               case 14:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3);\r
+                       break;\r
+               case 15:\r
+                       halbtc8723b1ant_CoexTable(pBtCoexist, bForceExec, 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3);\r
+                       break;  \r
+               default:\r
+                       break;\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetFwIgnoreWlanAct(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bEnable\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[1] ={0};\r
+               \r
+       if(bEnable)\r
+       {\r
+               H2C_Parameter[0] |= BIT0;               // function enable\r
+       }\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63=0x%x\n", \r
+               H2C_Parameter[0]));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_IgnoreWlanAct(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      BOOLEAN                 bEnable\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", \r
+               (bForceExec? "force to":""), (bEnable? "ON":"OFF")));\r
+       pCoexDm->bCurIgnoreWlanAct = bEnable;\r
+\r
+       if(!bForceExec)\r
+       {\r
+               if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct)\r
+                       return;\r
+       }\r
+       halbtc8723b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable);\r
+\r
+       pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetLpsRpwm(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  lpsVal,\r
+       IN      u1Byte                  rpwmVal\r
+       )\r
+{\r
+       u1Byte  lps=lpsVal;\r
+       u1Byte  rpwm=rpwmVal;\r
+       \r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps);\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_LpsRpwm(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      u1Byte                  lpsVal,\r
+       IN      u1Byte                  rpwmVal\r
+       )\r
+{\r
+       BOOLEAN bForceExecPwrCmd=FALSE;\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set lps/rpwm=0x%x/0x%x \n", \r
+               (bForceExec? "force to":""), lpsVal, rpwmVal));\r
+       pCoexDm->curLps = lpsVal;\r
+       pCoexDm->curRpwm = rpwmVal;\r
+\r
+       if(!bForceExec)\r
+       {\r
+               if( (pCoexDm->preLps == pCoexDm->curLps) &&\r
+                       (pCoexDm->preRpwm == pCoexDm->curRpwm) )\r
+               {\r
+                       return;\r
+               }\r
+       }\r
+       halbtc8723b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal);\r
+\r
+       pCoexDm->preLps = pCoexDm->curLps;\r
+       pCoexDm->preRpwm = pCoexDm->curRpwm;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SwMechanism(\r
+       IN      PBTC_COEXIST    pBtCoexist,     \r
+       IN      BOOLEAN                 bLowPenaltyRA\r
+       ) \r
+{\r
+       halbtc8723b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetAntPath(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                          antPosType,\r
+       IN      BOOLEAN                         bForceExec,\r
+       IN      BOOLEAN                         bInitHwCfg,\r
+       IN      BOOLEAN                         bWifiOff\r
+       )\r
+{\r
+       PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo;\r
+       u4Byte                  fwVer=0, u4Tmp=0, cntBtCalChk=0;\r
+       BOOLEAN                 bPgExtSwitch=FALSE;\r
+       BOOLEAN                 bUseExtSwitch=FALSE;\r
+       BOOLEAN                 bIsInMpMode = FALSE;\r
+       u1Byte                  H2C_Parameter[2] ={0}, u1Tmp = 0;\r
+\r
+       pCoexDm->curAntPosType = antPosType;\r
+       \r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);        // [31:16]=fw ver, [15:0]=fw sub ver\r
+\r
+       if((fwVer>0 && fwVer<0xc0000) || bPgExtSwitch)\r
+               bUseExtSwitch = TRUE;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+               if (antPosType == BTC_ANT_PATH_PTA)\r
+               {\r
+                       if ((pBoardInfo->btdmAntDetFinish) && (pBoardInfo->btdmAntNumByAntDet == 2))\r
+                       {\r
+                               if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                       antPosType = BTC_ANT_PATH_WIFI;\r
+                               else\r
+                                       antPosType = BTC_ANT_PATH_BT;\r
+                       }\r
+               }\r
+#endif         \r
+#endif\r
+\r
+       if(bInitHwCfg)\r
+       {\r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); //WiFi TRx Mask on\r
+               //remove due to interrupt is disabled that polling c2h will fail and delay 100ms.\r
+               //pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on\r
+\r
+               if(fwVer >= 0x180000)\r
+               {\r
+               /* Use H2C to set GNT_BT to HIGH */\r
+               H2C_Parameter[0] = 1;\r
+               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);\r
+               }\r
+               else\r
+               {\r
+                       // set grant_bt to high\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); \r
+               }\r
+               //set wlan_act control by PTA\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); \r
+\r
+               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT\r
+\r
+               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1);\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff);\r
+               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3);\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77);\r
+       }\r
+       else if(bWifiOff)\r
+       {\r
+               if(fwVer >= 0x180000)\r
+               {\r
+               /* Use H2C to set GNT_BT to HIGH */\r
+               H2C_Parameter[0] = 1;\r
+               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);\r
+               }\r
+               else\r
+               {\r
+                       // set grant_bt to high\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18); \r
+               }\r
+               //set wlan_act to always low\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);\r
+               \r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode);\r
+               if(!bIsInMpMode)        \r
+                       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); //BT select s0/s1 is controlled by BT\r
+               else\r
+                       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 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
+               u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);\r
+               u4Tmp &= ~BIT23;\r
+               u4Tmp &= ~BIT24;\r
+               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);\r
+       }\r
+       else\r
+       {                       \r
+               /* Use H2C to set GNT_BT to LOW */\r
+               if(fwVer >= 0x180000)\r
+               {\r
+               if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765) != 0)\r
+               {               \r
+                       H2C_Parameter[0] = 0;\r
+                       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);\r
+               }\r
+               }\r
+               else\r
+               {\r
+                       // BT calibration check\r
+                       while(cntBtCalChk <= 20)\r
+                       {\r
+                               u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d);\r
+                               cntBtCalChk++;\r
+                               if(u1Tmp & BIT0)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", cntBtCalChk));\r
+                                       delay_ms(50);\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", cntBtCalChk));\r
+                                       break;\r
+                               }\r
+                       }\r
+\r
+                       // set grant_bt to PTA\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0);\r
+               }\r
+\r
+               if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) != 0xc)\r
+               {\r
+                       //set wlan_act control by PTA\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); \r
+               }\r
+\r
+               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi\r
+       }\r
+       \r
+       if(bUseExtSwitch)\r
+       {\r
+               if(bInitHwCfg)\r
+               {\r
+                       // 0x4c[23]=0, 0x4c[24]=1  Antenna control by WL/BT\r
+                       u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);\r
+                       u4Tmp &=~BIT23;\r
+                       u4Tmp |= BIT24;\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);\r
+\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); // fixed internal switch S1->WiFi, S0->BT\r
+\r
+                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                       {\r
+                               //tell firmware "no antenna inverse"\r
+                               H2C_Parameter[0] = 0;\r
+                               H2C_Parameter[1] = 1;  //ext switch type\r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);    \r
+                       }\r
+                       else\r
+                       {\r
+                               //tell firmware "antenna inverse"\r
+                               H2C_Parameter[0] = 1;\r
+                               H2C_Parameter[1] = 1;  //ext switch type\r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);    \r
+                       }\r
+               }\r
+               \r
+               if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType))\r
+               {\r
+                       // ext switch setting\r
+                       switch(antPosType)\r
+                       {\r
+                               case BTC_ANT_PATH_WIFI:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);\r
+                                       else\r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);\r
+                                       break;\r
+                               case BTC_ANT_PATH_BT:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);\r
+                                       else                                    \r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);\r
+                                       break;\r
+                               default:\r
+                               case BTC_ANT_PATH_PTA:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);\r
+                                       else\r
+                                               pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);\r
+                                       break;\r
+                       }\r
+               }\r
+       }\r
+       else\r
+       {\r
+               if(bInitHwCfg)\r
+               {\r
+                       // 0x4c[23]=1, 0x4c[24]=0  Antenna control by 0x64\r
+                       u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);\r
+                       u4Tmp |= BIT23;\r
+                       u4Tmp &=~BIT24;       \r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);\r
+\r
+                       //Fix Ext switch Main->S1, Aux->S0\r
+                       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0); \r
+\r
+                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                       {\r
+       \r
+                               //tell firmware "no antenna inverse"\r
+                               H2C_Parameter[0] = 0;\r
+                               H2C_Parameter[1] = 0;  //internal switch type\r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);    \r
+                       }\r
+                       else\r
+                       {\r
+               \r
+                               //tell firmware "antenna inverse"\r
+                               H2C_Parameter[0] = 1;\r
+                               H2C_Parameter[1] = 0;  //internal switch type\r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);    \r
+                       }\r
+               }\r
+       \r
+               if(bForceExec || (pCoexDm->curAntPosType != pCoexDm->preAntPosType))\r
+               {\r
+                       // internal switch setting\r
+                       switch(antPosType)\r
+                       {\r
+                               case BTC_ANT_PATH_WIFI:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);\r
+                                       else\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);\r
+                                       break;\r
+                               case BTC_ANT_PATH_BT:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);\r
+                                       else\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);\r
+                                       break;\r
+                               default:\r
+                               case BTC_ANT_PATH_PTA:\r
+                                       if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x200);                                   \r
+                                       else\r
+                                               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x80);\r
+                                       break;\r
+                       }\r
+               }\r
+       }\r
+\r
+       pCoexDm->preAntPosType = pCoexDm->curAntPosType;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetAntPathDCut(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bAntennaAux,    //For 1-Ant--> 1: Antenna at S0, 0: Antenna at S1. Set 0 for 2-Ant\r
+       IN      BOOLEAN                         bExtSwitch,             // 1: Ext Switch (SPDT) exist on module, 0: no Ext Switch (SPDT) exist on module\r
+       IN      BOOLEAN                         bTwoAntenna,    // 1: 2-Antenna, 0:1-Antenna\r
+       IN      u1Byte                          antennaPos,             //Set Antenna Pos, For 1-Ant: BTC_ANT_PATH_WIFI, BTC_ANT_PATH_BT, BTC_ANT_PATH_PTA, For 2-Ant:BTC_ANT_WIFI_AT_MAIN, BTC_ANT_WIFI_AT_Aux\r
+       IN      u1Byte                          wifiState               //BTC_WIFI_STAT_INIT, BTC_WIFI_STAT_IQK, BTC_WIFI_STAT_NORMAL_OFF, BTC_WIFI_STAT_MP_OFF, BTC_WIFI_STAT_NORMAL, BTC_WIFI_STAT_ANT_DIV\r
+       )\r
+{\r
+       u1Byte  dataLen=5;\r
+       u1Byte  buf[6] = {0};\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set BT Ant, bAntennaAux/bExtSwitch/bTwoAntenna/antennaPos/wifiState=%d/%d/%d/%d/%d\n",\r
+               bAntennaAux, bExtSwitch, bTwoAntenna, antennaPos, wifiState));\r
+\r
+       buf[0] = dataLen; \r
+       \r
+       if(bAntennaAux)\r
+               buf[1] = 0x1;\r
+       \r
+       if(bExtSwitch)\r
+               buf[2] = 0x1;                   \r
+       \r
+       if(bTwoAntenna)\r
+               buf[3] = 0x1;\r
+\r
+       buf[4] = antennaPos;\r
+\r
+       buf[5] = wifiState;\r
+       \r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_CTRL_8723B_ANT, (PVOID)&buf[0]);    \r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_SetFwPstdma(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  byte1,\r
+       IN      u1Byte                  byte2,\r
+       IN      u1Byte                  byte3,\r
+       IN      u1Byte                  byte4,\r
+       IN      u1Byte                  byte5\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[5] ={0};\r
+       u1Byte                  realByte1=byte1, realByte5=byte5;\r
+       BOOLEAN                 bApEnable=FALSE;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);\r
+\r
+       if(bApEnable)\r
+       {\r
+               if(byte1&BIT4 && !(byte1&BIT5))\r
+               {                       \r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n"));\r
+                       realByte1 &= ~BIT4;\r
+                       realByte1 |= BIT5;\r
+\r
+                       realByte5 |= BIT5;\r
+                       realByte5 &= ~BIT6;\r
+               }\r
+       }\r
+\r
+       H2C_Parameter[0] = realByte1;   \r
+       H2C_Parameter[1] = byte2;       \r
+       H2C_Parameter[2] = byte3;\r
+       H2C_Parameter[3] = byte4;\r
+       H2C_Parameter[4] = realByte5;\r
+\r
+       pCoexDm->psTdmaPara[0] = realByte1;\r
+       pCoexDm->psTdmaPara[1] = byte2;\r
+       pCoexDm->psTdmaPara[2] = byte3;\r
+       pCoexDm->psTdmaPara[3] = byte4;\r
+       pCoexDm->psTdmaPara[4] = realByte5;\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", \r
+               H2C_Parameter[0], \r
+               H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4]));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter);\r
+}\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_PsTdma(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bForceExec,\r
+       IN      BOOLEAN                 bTurnOn,\r
+       IN      u1Byte                  type\r
+       )\r
+{\r
+       PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo;\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN                 bTurnOnByCnt=FALSE, bWifiBusy=FALSE, bWiFiNoisy=FALSE;\r
+       u1Byte                  psTdmaTypeByCnt=0, rssiAdjustVal=0;\r
+       u1Byte                  psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val =  0x10;\r
+       s1Byte                  nWiFiDurationAdjust = 0x0;\r
+       static BOOLEAN   bPreWifiBusy=FALSE;\r
+\r
+       pCoexDm->bCurPsTdmaOn = bTurnOn;\r
+       pCoexDm->curPsTdma = type;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+       if (pBoardInfo->btdmAntNumByAntDet == 2)\r
+       {\r
+               if (bTurnOn)\r
+                       type = type +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
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);      \r
+\r
+       if (bWifiBusy != bPreWifiBusy)\r
+       {\r
+               bForceExec = TRUE;      \r
+               bPreWifiBusy = bWifiBusy;\r
+       }\r
+\r
+       if (pCoexDm->bCurPsTdmaOn)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(on, %d) **********\n", \r
+                               pCoexDm->curPsTdma));\r
+       }\r
+       else\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ********** TDMA(off, %d) **********\n", \r
+                               pCoexDm->curPsTdma));\r
+       }\r
+                       \r
+       if(!bForceExec)\r
+       {       \r
+               if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) &&\r
+                       (pCoexDm->prePsTdma == pCoexDm->curPsTdma) )\r
+                       return;\r
+       }\r
+\r
+       if (pCoexSta->nScanAPNum <= 5)\r
+       {\r
+               nWiFiDurationAdjust = 5;\r
+               \r
+               if (pCoexSta->nA2DPBitPool >= 35)\r
+                 nWiFiDurationAdjust = -10;\r
+               else if (pCoexSta->nA2DPBitPool >= 45)\r
+                 nWiFiDurationAdjust = -15;    \r
+       }\r
+       else if  (pCoexSta->nScanAPNum >= 40)\r
+       {\r
+               nWiFiDurationAdjust = -15;      \r
+\r
+               if (pCoexSta->nA2DPBitPool < 35)\r
+                 nWiFiDurationAdjust = -5;\r
+               else if (pCoexSta->nA2DPBitPool < 45)\r
+                 nWiFiDurationAdjust = -10; \r
+       }\r
+       else if  (pCoexSta->nScanAPNum >= 20)\r
+       {\r
+               nWiFiDurationAdjust = -10;      \r
+       \r
+               if (pCoexSta->nA2DPBitPool >= 45)\r
+                 nWiFiDurationAdjust = -15;\r
+       }       \r
+       else\r
+       {\r
+               nWiFiDurationAdjust = 0;               \r
+               \r
+               if (pCoexSta->nA2DPBitPool >= 35)\r
+                 nWiFiDurationAdjust = -10;\r
+               else if (pCoexSta->nA2DPBitPool >= 45)\r
+                 nWiFiDurationAdjust = -15;    \r
+       }\r
+       \r
+       if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || (type == 101)\r
+               || (type == 102) || (type == 109) || (type == 101))\r
+       {\r
+               if (!pCoexSta->bForceLpsOn)  //Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30\r
+       {\r
+               psTdmaByte0Val = 0x61;  //no null-pkt\r
+               psTdmaByte3Val = 0x11; // no tx-pause at BT-slot\r
+               psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot\r
+       }\r
+               else\r
+               {\r
+                       psTdmaByte0Val = 0x51;  //null-pkt\r
+                       psTdmaByte3Val = 0x10; //tx-pause at BT-slot\r
+                       psTdmaByte4Val = 0x50; // 0x778 = d/1 toggle, dynamic slot\r
+               }\r
+       }\r
+       else if ((type == 3) || (type == 13) || (type == 14) || (type == 103) || (type == 113) || (type == 114))\r
+       {\r
+               psTdmaByte0Val = 0x51;  //null-pkt\r
+               psTdmaByte3Val = 0x10; //tx-pause at BT-slot\r
+               psTdmaByte4Val = 0x10; // 0x778 = d/1 toggle, no dynamic slot\r
+#if 0  \r
+               if (!bWifiBusy)\r
+                       psTdmaByte4Val = psTdmaByte4Val | 0x1;  //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts)\r
+#endif         \r
+       }\r
+       else  //native power save case\r
+       {\r
+               psTdmaByte0Val = 0x61;  //no null-pkt\r
+               psTdmaByte3Val = 0x11; // no tx-pause at BT-slot\r
+               psTdmaByte4Val = 0x11; // 0x778 = d/1 toggle, no dynamic slot\r
+               //psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case \r
+               }\r
+                \r
+       //if (pBtLinkInfo->bSlaveRole == TRUE)\r
+       if ((pBtLinkInfo->bSlaveRole == TRUE)   && (pBtLinkInfo->bA2dpExist))\r
+               psTdmaByte4Val = psTdmaByte4Val | 0x1;  //0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts)\r
+               \r
+       if (type > 100)\r
+       {\r
+               psTdmaByte0Val = psTdmaByte0Val | 0x82; //set antenna control by SW     \r
+               psTdmaByte3Val = psTdmaByte3Val | 0x60;  //set antenna no toggle, control by antenna diversity\r
+       }\r
+\r
+               \r
+       if(bTurnOn)\r
+       {        \r
+               switch(type)\r
+               {\r
+                       default:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val);\r
+                               break;\r
+                       case 1:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val);                                                                \r
+                               break;\r
+                       case 2:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val);                                                        \r
+                               break;\r
+                       case 3:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;\r
+                       case 4:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0);\r
+                               break;\r
+                       case 5:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11);\r
+                               break;\r
+                       case 6:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11);\r
+                               break;\r
+                       case 7:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0);\r
+                               break;\r
+                       case 8: \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0);\r
+                               break;\r
+                       case 9: \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);                             \r
+                               break;\r
+                       case 10:        \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40);\r
+                               break;\r
+                       case 11:        \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val);                    \r
+                               break;\r
+                       case 12:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50);\r
+                               break;\r
+                       case 13:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;\r
+                       case 14:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);                             \r
+                               break;\r
+                       case 15:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0);\r
+                               break;\r
+                       case 16:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0);\r
+                               break;\r
+                       case 18:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0);\r
+                               break;                  \r
+                       case 20:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10);\r
+                               break;\r
+                       case 21:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11);\r
+                               break;\r
+                       case 22:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10);\r
+                               break;\r
+                       case 23:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18);\r
+                               break;\r
+                       case 24:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18);\r
+                               break;\r
+                       case 25:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18);\r
+                               break;\r
+                       case 26:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18);\r
+                               break;\r
+                       case 27:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98);\r
+                               break;\r
+                       case 28:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0);\r
+                               break;\r
+                       case 29:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10);\r
+                               break;\r
+                       case 30:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10);\r
+                               break;\r
+                       case 31:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xd3, 0x1a, 0x1a, 0, 0x58);\r
+                               break;\r
+                       case 32:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;\r
+                       case 33:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x35, 0x3, psTdmaByte3Val, 0x10);\r
+                               break;\r
+                       case 34:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10);\r
+                               break;\r
+                       case 35:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10);\r
+                               break;\r
+                       case 36:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0xd3, 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_SetFwPstdma(pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24);\r
+                               break;  \r
+                               \r
+                       //for 1-Ant translate to 2-Ant  \r
+                       case 101:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val);                                                                \r
+                               break;\r
+                       case 102:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x2d+nWiFiDurationAdjust, 0x03, psTdmaByte3Val, psTdmaByte4Val);                                                        \r
+                               break;\r
+                       case 103:\r
+                               //halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, psTdmaByte4Val);\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3a, 0x03, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;\r
+                       case 105:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x15, 0x3, psTdmaByte3Val, 0x11);\r
+                               break;\r
+                       case 106:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x20, 0x3, psTdmaByte3Val, 0x11);\r
+                               break;  \r
+                       case 109:       \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);                             \r
+                               break;                  \r
+                       case 111:       \r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x03, psTdmaByte3Val, psTdmaByte4Val);                    \r
+                               break;  \r
+                       case 113:\r
+                               //halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x51, 0x12, 0x12, 0x0, psTdmaByte4Val);\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;\r
+                       case 114:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x21, 0x3, psTdmaByte3Val, psTdmaByte4Val);                             \r
+                               break;  \r
+                       case 120:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x3f, 0x03, psTdmaByte3Val, 0x10);\r
+                               break;                  \r
+                       case 122:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x10);\r
+                               break;\r
+                       case 132:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, psTdmaByte4Val);\r
+                               break;  \r
+                       case 133:\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, psTdmaByte0Val, 0x25, 0x03, psTdmaByte3Val, 0x11);\r
+                               break;          \r
+                               \r
+               }\r
+       }\r
+       else\r
+       {               \r
+\r
+               // disable PS tdma\r
+               switch(type)\r
+               {\r
+                       case 8: //PTA Control\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0);\r
+                               break;\r
+                       case 0:\r
+                       default:  //Software control, Antenna at BT side\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);\r
+                               break;\r
+                       case 1: // 2-Ant, 0x778=3, antenna control by antenna diversity\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x48, 0x0);\r
+                               break;\r
+#if 0\r
+                       case 9:   //Software control, Antenna at WiFi side\r
+                               halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);\r
+                               //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_WIFI, BTC_WIFI_STAT_NORMAL);\r
+                               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FALSE, FALSE);\r
+                               break;                  \r
+#endif\r
+               }\r
+       }\r
+       rssiAdjustVal =0;\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal);\r
+\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+               pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948),   pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765), pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67)));\r
+\r
+       // update pre state\r
+       pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn;\r
+       pCoexDm->prePsTdma = pCoexDm->curPsTdma;\r
+}\r
+\r
+BOOLEAN\r
+halbtc8723b1ant_IsCommonAction(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       BOOLEAN                 bCommon=FALSE, bWifiConnected=FALSE, bWifiBusy=FALSE;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+\r
+       if(!bWifiConnected && \r
+               BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"));\r
+               \r
+               //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+\r
+               bCommon = TRUE;\r
+       }\r
+       else if(bWifiConnected && \r
+               (BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) )\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT non connected-idle!!\n"));\r
+\r
+               //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+\r
+               bCommon = TRUE;\r
+       }\r
+       else if(!bWifiConnected && \r
+               (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) )\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"));\r
+\r
+               //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+\r
+               bCommon = TRUE;\r
+       }\r
+       else if(bWifiConnected && \r
+               (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) )\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected + BT connected-idle!!\n"));\r
+\r
+               //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+\r
+               bCommon = TRUE;\r
+       }\r
+       else if(!bWifiConnected && \r
+               (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) )\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non connected-idle + BT Busy!!\n"));\r
+\r
+               //halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+               \r
+               bCommon = TRUE;\r
+       }\r
+       else\r
+       {\r
+               if (bWifiBusy)                  \r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n"));\r
+               }\r
+               else\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n"));\r
+               }\r
+               \r
+               bCommon = FALSE;\r
+       }\r
+       \r
+       return bCommon;\r
+}\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_TdmaDurationAdjustForAcl(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                          wifiStatus\r
+       )\r
+{\r
+       static s4Byte           up,dn,m,n,WaitCount;\r
+       s4Byte                  result;   //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration\r
+       u1Byte                  retryCount=0, btInfoExt;\r
+       static BOOLEAN  bPreWifiBusy=FALSE;\r
+       BOOLEAN                 bWifiBusy = FALSE;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjustForAcl()\n"));\r
+\r
+       if(BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus) \r
+               bWifiBusy = TRUE;\r
+       else\r
+               bWifiBusy = FALSE;              \r
+\r
+       if( (BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) ||\r
+               (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) ||\r
+               (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus) )\r
+       {\r
+               if( pCoexDm->curPsTdma != 1 &&\r
+                       pCoexDm->curPsTdma != 2 &&\r
+                       pCoexDm->curPsTdma != 3 &&\r
+                       pCoexDm->curPsTdma != 9 )\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9);\r
+                       pCoexDm->psTdmaDuAdjType = 9;\r
+\r
+                       up = 0;\r
+                       dn = 0;\r
+                       m = 1;\r
+                       n= 3;\r
+                       result = 0;\r
+                       WaitCount = 0;\r
+               }               \r
+               return;\r
+       }\r
+\r
+       if(!pCoexDm->bAutoTdmaAdjust)\r
+       {\r
+               pCoexDm->bAutoTdmaAdjust = TRUE;\r
+               RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n"));\r
+\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2);\r
+               pCoexDm->psTdmaDuAdjType = 2;\r
+               //============\r
+               up = 0;\r
+               dn = 0;\r
+               m = 1;\r
+               n= 3;\r
+               result = 0;\r
+               WaitCount = 0;\r
+       }\r
+       else\r
+       {\r
+               //accquire the BT TRx retry count from BT_Info byte2\r
+               retryCount = pCoexSta->btRetryCnt;\r
+               btInfoExt = pCoexSta->btInfoExt;\r
+\r
+               if ( (pCoexSta->lowPriorityTx) > 1050 ||  (pCoexSta->lowPriorityRx) > 1250 )\r
+                       retryCount++;   \r
+               \r
+               result = 0;\r
+               WaitCount++; \r
+                 \r
+               if(retryCount == 0)  // no retry in the last 2-second duration\r
+               {\r
+                       up++;\r
+                       dn--;\r
+\r
+                       if (dn <= 0)\r
+                               dn = 0;                          \r
+\r
+                       if(up >= n)     // if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration\r
+                       {\r
+                               WaitCount = 0; \r
+                               n = 3;\r
+                               up = 0;\r
+                               dn = 0;\r
+                               result = 1; \r
+                               RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n"));\r
+                       }\r
+               }\r
+               else if (retryCount <= 3)       // <=3 retry in the last 2-second duration\r
+               {\r
+                       up--; \r
+                       dn++;\r
+\r
+                       if (up <= 0)\r
+                               up = 0;\r
+\r
+                       if (dn == 2)    // if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration\r
+                       {\r
+                               if (WaitCount <= 2)\r
+                                       m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^\r
+                               else\r
+                                       m = 1;\r
+\r
+                               if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration.\r
+                                       m = 20;\r
+\r
+                               n = 3*m;\r
+                               up = 0;\r
+                               dn = 0;\r
+                               WaitCount = 0;\r
+                               result = -1; \r
+                               RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n"));\r
+                       }\r
+               }\r
+               else  //retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration\r
+               {\r
+                       if (WaitCount == 1)\r
+                               m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^\r
+                       else\r
+                               m = 1;\r
+\r
+                       if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration.\r
+                               m = 20;\r
+\r
+                       n = 3*m;\r
+                       up = 0;\r
+                       dn = 0;\r
+                       WaitCount = 0; \r
+                       result = -1;\r
+                       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n"));\r
+               }\r
+\r
+               if(result == -1)\r
+               {\r
+/*                     if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt)) &&\r
+                               ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) )\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9);\r
+                               pCoexDm->psTdmaDuAdjType = 9;\r
+                       }\r
+                       else */ if(pCoexDm->curPsTdma == 1)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2);\r
+                               pCoexDm->psTdmaDuAdjType = 2;\r
+                       }\r
+                       else if(pCoexDm->curPsTdma == 2)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9);\r
+                               pCoexDm->psTdmaDuAdjType = 9;\r
+                       }\r
+                       else if(pCoexDm->curPsTdma == 9)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11);\r
+                               pCoexDm->psTdmaDuAdjType = 11;\r
+                       }\r
+               }\r
+               else if(result == 1)\r
+               {\r
+/*                     if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt)) &&\r
+                               ((pCoexDm->curPsTdma == 1) ||(pCoexDm->curPsTdma == 2)) )\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9);\r
+                               pCoexDm->psTdmaDuAdjType = 9;\r
+                       }\r
+                       else */ if(pCoexDm->curPsTdma == 11)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9);\r
+                               pCoexDm->psTdmaDuAdjType = 9;\r
+                       }\r
+                       else if(pCoexDm->curPsTdma == 9)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2);\r
+                               pCoexDm->psTdmaDuAdjType = 2;\r
+                       }\r
+                       else if(pCoexDm->curPsTdma == 2)\r
+                       {\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1);\r
+                               pCoexDm->psTdmaDuAdjType = 1;\r
+                       }\r
+               }\r
+               else      //no change\r
+               {\r
+                       /* Bryant Modify        \r
+                       if(bWifiBusy != bPreWifiBusy)  //if busy / idle change\r
+                       {\r
+                               bPreWifiBusy = bWifiBusy;\r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, TRUE, pCoexDm->curPsTdma);\r
+                       }\r
+                       */\r
+               \r
+                       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], ********** TDMA(on, %d) **********\n", \r
+                               pCoexDm->curPsTdma));\r
+               }\r
+\r
+               if( pCoexDm->curPsTdma != 1 &&\r
+                       pCoexDm->curPsTdma != 2 &&\r
+                       pCoexDm->curPsTdma != 9 &&\r
+                       pCoexDm->curPsTdma != 11 )\r
+               {\r
+                       // recover to previous adjust type\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType);\r
+               }\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_PsTdmaCheckForPowerSaveState(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                 bNewPsState\r
+       )\r
+{\r
+       u1Byte  lpsMode=0x0;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode);\r
+       \r
+       if(lpsMode)     // already under LPS state\r
+       {\r
+               if(bNewPsState)         \r
+               {\r
+                       // keep state under LPS, do nothing.\r
+               }\r
+               else\r
+               {\r
+                       // will leave LPS state, turn off psTdma first\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               }\r
+       }\r
+       else                                            // NO PS state\r
+       {\r
+               if(bNewPsState)\r
+               {\r
+                       // will enter LPS state, turn off psTdma first\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               }\r
+               else\r
+               {\r
+                       // keep state under NO PS state, do nothing.\r
+               }\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_PowerSaveState(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                          psType,\r
+       IN      u1Byte                          lpsVal,\r
+       IN      u1Byte                          rpwmVal\r
+       )\r
+{\r
+       BOOLEAN         bLowPwrDisable=FALSE;\r
+       \r
+       switch(psType)\r
+       {\r
+               case BTC_PS_WIFI_NATIVE:\r
+                       // recover to original 32k low power setting\r
+                       bLowPwrDisable = FALSE;\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable);\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL);\r
+                       pCoexSta->bForceLpsOn = FALSE;\r
+                       break;\r
+               case BTC_PS_LPS_ON:\r
+                       halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, TRUE);\r
+                       halbtc8723b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal);                      \r
+                       // when coex force to enter LPS, do not enter 32k low power.\r
+                       bLowPwrDisable = TRUE;\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable);\r
+                       // power save must executed before psTdma.                      \r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL);\r
+                       pCoexSta->bForceLpsOn = TRUE;\r
+                       break;\r
+               case BTC_PS_LPS_OFF:\r
+                       halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, FALSE);\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL);\r
+                       pCoexSta->bForceLpsOn = FALSE;\r
+                       break;\r
+               default:\r
+                       break;\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiOnly(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);\r
+       halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_MonitorBtEnableDisable(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       static BOOLEAN  bPreBtDisabled=FALSE;\r
+       static u4Byte           btDisableCnt=0;\r
+       BOOLEAN                 bBtActive=TRUE, bBtDisabled=FALSE;\r
+\r
+       // This function check if bt is disabled\r
+\r
+       if(     pCoexSta->highPriorityTx == 0 &&\r
+               pCoexSta->highPriorityRx == 0 &&\r
+               pCoexSta->lowPriorityTx == 0 &&\r
+               pCoexSta->lowPriorityRx == 0)\r
+       {\r
+               bBtActive = FALSE;\r
+       }\r
+       if(     pCoexSta->highPriorityTx == 0xffff &&\r
+               pCoexSta->highPriorityRx == 0xffff &&\r
+               pCoexSta->lowPriorityTx == 0xffff &&\r
+               pCoexSta->lowPriorityRx == 0xffff)\r
+       {\r
+               bBtActive = FALSE;\r
+       }\r
+       if(bBtActive)\r
+       {\r
+               btDisableCnt = 0;\r
+               bBtDisabled = FALSE;\r
+       }\r
+       else\r
+       {\r
+               btDisableCnt++;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n",  btDisableCnt));\r
+               if(btDisableCnt >= 2)\r
+               {\r
+                       bBtDisabled = TRUE;\r
+               }\r
+       }\r
+       if(bPreBtDisabled != bBtDisabled)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n",  (bPreBtDisabled ? "disabled":"enabled"), \r
+                       (bBtDisabled ? "disabled":"enabled")));\r
+\r
+               bPreBtDisabled = bBtDisabled;\r
+               pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled);\r
+               if(bBtDisabled)\r
+               {\r
+                       halbtc8723b1ant_ActionWifiOnly(pBtCoexist);\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL);\r
+                       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL);\r
+               }\r
+       }\r
+}\r
+\r
+//=============================================\r
+//\r
+//     Software Coex Mechanism start\r
+//\r
+//=============================================\r
+\r
+// SCO only or SCO+PAN(HS)\r
+\r
+/*\r
+VOID\r
+halbtc8723b1ant_ActionSco(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+}\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_ActionHid(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+}\r
+\r
+//A2DP only / PAN(EDR) only/ A2DP+PAN(HS)\r
+VOID\r
+halbtc8723b1ant_ActionA2dp(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionA2dpPanHs(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionPanEdr(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+}\r
+\r
+//PAN(HS) only\r
+VOID\r
+halbtc8723b1ant_ActionPanHs(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+}\r
+\r
+//PAN(EDR)+A2DP\r
+VOID\r
+halbtc8723b1ant_ActionPanEdrA2dp(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionPanEdrHid(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+}\r
+\r
+// HID+A2DP+PAN(EDR)\r
+VOID\r
+halbtc8723b1ant_ActionHidA2dpPanEdr(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionHidA2dp(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+}\r
+\r
+*/\r
+\r
+//=============================================\r
+//\r
+//     Non-Software Coex Mechanism start\r
+//\r
+//=============================================\r
+VOID\r
+halbtc8723b1ant_ActionBtWhckTest(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+       \r
+       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiMultiPort(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+       \r
+       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionHs(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5);\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionBtInquiry(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{      \r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN                 bWifiConnected=FALSE, bApEnable=FALSE, bWifiBusy=FALSE, bBtBusy=FALSE;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);\r
+\r
+       if ( (!bWifiConnected) && (!pCoexSta->bWiFiIsHighPriTask) )\r
+       {\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);          \r
+       }\r
+       else if( (pBtLinkInfo->bScoExist) ||    (pBtLinkInfo->bHidExist) ||     (pBtLinkInfo->bA2dpExist)  )\r
+       {\r
+               // SCO/HID/A2DP busy\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+               if (pCoexSta->bC2hBtRemoteNameReq)\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33);\r
+               else \r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+               \r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);          \r
+       }\r
+       else if ( (pBtLinkInfo->bPanExist) || (bWifiBusy) )\r
+       {\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);               \r
+\r
+               if (pCoexSta->bC2hBtRemoteNameReq)\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33);\r
+               else            \r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+               \r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+       }\r
+       else\r
+       {\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               \r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);          \r
+               \r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionBtScoHidOnlyBusy(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                          wifiStatus\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN bWifiConnected=FALSE;\r
+       u1Byte  wifiRssiState=BTC_RSSI_STATE_HIGH;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+\r
+       // tdma and coex table\r
+\r
+       if(pBtLinkInfo->bScoExist)\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);\r
+       }\r
+       else //HID\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiConnectedBtAclBusy(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                          wifiStatus\r
+       )\r
+{\r
+       u1Byte          btRssiState;\r
+       \r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       btRssiState = halbtc8723b1ant_BtRssiState(2, 28, 0);    \r
+\r
+       if ( (pCoexSta->lowPriorityRx >= 950)  && (!pCoexSta->bUnderIps) )\r
+       {\r
+               pBtLinkInfo->bSlaveRole = TRUE;\r
+       }\r
+       else\r
+       {\r
+               pBtLinkInfo->bSlaveRole = FALSE;\r
+       }\r
+\r
+       if(pBtLinkInfo->bHidOnly)  //HID\r
+       {\r
+               halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus);\r
+               pCoexDm->bAutoTdmaAdjust = FALSE;\r
+               return;\r
+       }\r
+       else if(pBtLinkInfo->bA2dpOnly)  //A2DP         \r
+       {\r
+               if(BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus)\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+                       pCoexDm->bAutoTdmaAdjust = FALSE;\r
+               }\r
+               else\r
+               {\r
+                       halbtc8723b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+                       pCoexDm->bAutoTdmaAdjust = TRUE;\r
+               }\r
+       }\r
+       else if ( ((pBtLinkInfo->bA2dpExist) && (pBtLinkInfo->bPanExist)) ||\r
+                      (pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist&&pBtLinkInfo->bPanExist) ) //A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP)\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               pCoexDm->bAutoTdmaAdjust = FALSE;\r
+       }\r
+       else if(pBtLinkInfo->bHidExist&&pBtLinkInfo->bA2dpExist)  //HID+A2DP\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14);\r
+               pCoexDm->bAutoTdmaAdjust = FALSE;\r
+\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 3);\r
+       }\r
+       else if( (pBtLinkInfo->bPanOnly) || (pBtLinkInfo->bHidExist&&pBtLinkInfo->bPanExist) ) //PAN(OPP,FTP), HID+PAN(OPP,FTP)                 \r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               pCoexDm->bAutoTdmaAdjust = FALSE;\r
+       }\r
+       else\r
+       {               \r
+               //BT no-profile busy (0x9)\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 33);      \r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               pCoexDm->bAutoTdmaAdjust = FALSE;\r
+       }       \r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiNotConnected(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       // power save state\r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiNotConnectedScan(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       \r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus)\r
+       {\r
+               if (pBtLinkInfo->bA2dpExist)\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               }\r
+               else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist)\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               }\r
+               else\r
+               {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);                  \r
+               }\r
+       }\r
+       else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+                       (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+       {\r
+               halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,\r
+                       BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN);\r
+       }\r
+       else\r
+       {\r
+               //Bryant Add\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       \r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       if( (pBtLinkInfo->bScoExist)  || (pBtLinkInfo->bHidExist) ||  (pBtLinkInfo->bA2dpExist) )\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4);           \r
+       }\r
+       else if (pBtLinkInfo->bPanExist)                        \r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 4);           \r
+       }\r
+       else\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 2);\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiConnectedScan(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       \r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus)\r
+       {\r
+               if (pBtLinkInfo->bA2dpExist)\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               }\r
+               else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist)\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+               }\r
+               else\r
+               {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20);\r
+                       halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);\r
+       }\r
+       }\r
+       else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+                       (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+       {\r
+               halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,\r
+                       BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN);\r
+       }\r
+       else\r
+       {\r
+               //Bryant Add\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiConnectedSpecialPacket(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN bWifiBusy = FALSE;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+\r
+       //no special packet process for both WiFi and BT very busy\r
+       if ((bWifiBusy) && ((pBtLinkInfo->bPanExist) || (pCoexSta->nNumOfProfile >= 2)))\r
+        return;        \r
+\r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       if((pBtLinkInfo->bScoExist) || (pBtLinkInfo->bHidExist))\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);          \r
+       }\r
+       else if  (pBtLinkInfo->bA2dpExist)\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 32);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);          \r
+       }\r
+       else if(pBtLinkInfo->bPanExist)\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 20);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);          \r
+       }\r
+       else\r
+       {\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_ActionWifiConnected(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       BOOLEAN         bWifiBusy=FALSE;\r
+       BOOLEAN         bScan=FALSE, bLink=FALSE, bRoam=FALSE;\r
+       BOOLEAN         bUnder4way=FALSE, bApEnable=FALSE;\r
+       u4Byte          wifiBw;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect()===>\n"));\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way);\r
+       if(bUnder4way)\r
+       {\r
+               halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"));\r
+               return;\r
+       }\r
+       \r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);\r
+       if(bScan || bLink || bRoam)\r
+       {\r
+               if(bScan)       \r
+                       halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);\r
+               else\r
+                       halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"));\r
+               return;\r
+       }\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+       \r
+       // power save state\r
+       if(!bApEnable && BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus && !pBtCoexist->btLinkInfo.bHidOnly)\r
+       {\r
+               if(pBtCoexist->btLinkInfo.bA2dpOnly)    //A2DP\r
+                       {                       \r
+                       if(!bWifiBusy)\r
+                               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);                               \r
+                       else //busy\r
+                       {\r
+                               if  (pCoexSta->nScanAPNum >= BT_8723B_1ANT_WIFI_NOISY_THRESH)  //no force LPS, no PS-TDMA, use pure TDMA\r
+                               {\r
+                       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+                               }\r
+                               else\r
+                               {\r
+                                       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4);                                   \r
+                               }\r
+                       }\r
+               }\r
+               else if ((pCoexSta->bPanExist == FALSE) && (pCoexSta->bA2dpExist == FALSE) && (pCoexSta->bHidExist == FALSE))\r
+                       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               else\r
+                       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4);\r
+       }\r
+       else\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+       // tdma and coex table\r
+       if(!bWifiBusy)\r
+       {\r
+               if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus)\r
+               {\r
+                       halbtc8723b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist, \r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);\r
+               }\r
+               else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+                       (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+               {\r
+                       halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);\r
+               }\r
+               else\r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+                       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);\r
+                       if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 )\r
+                               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+                       else\r
+                               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);           \r
+               }\r
+       }\r
+       else\r
+       {\r
+               if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus)\r
+               {\r
+                       halbtc8723b1ant_ActionWifiConnectedBtAclBusy(pBtCoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY);\r
+               }\r
+               else if( (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+                       (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+               {\r
+                       halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,\r
+                               BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY);\r
+               }\r
+               else \r
+               {\r
+                       halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8);\r
+                       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, FALSE, FALSE);    \r
+                       if ( (pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60 )\r
+                               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+                       else\r
+                               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7); \r
+               }\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_RunSwCoexistMechanism(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       u1Byte                          algorithm=0;\r
+\r
+       algorithm = halbtc8723b1ant_ActionAlgorithm(pBtCoexist);\r
+       pCoexDm->curAlgorithm = algorithm;\r
+\r
+       if(halbtc8723b1ant_IsCommonAction(pBtCoexist))\r
+       {\r
+\r
+       }\r
+       else\r
+       {\r
+               switch(pCoexDm->curAlgorithm)\r
+               {\r
+                       case BT_8723B_1ANT_COEX_ALGO_SCO:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = SCO.\n"));\r
+                               //halbtc8723b1ant_ActionSco(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_HID:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID.\n"));\r
+                               //halbtc8723b1ant_ActionHid(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_A2DP:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP.\n"));\r
+                               //halbtc8723b1ant_ActionA2dp(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n"));\r
+                               //halbtc8723b1ant_ActionA2dpPanHs(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_PANEDR:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR).\n"));\r
+                               //halbtc8723b1ant_ActionPanEdr(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_PANHS:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HS mode.\n"));\r
+                               //halbtc8723b1ant_ActionPanHs(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN+A2DP.\n"));\r
+                               //halbtc8723b1ant_ActionPanEdrA2dp(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_PANEDR_HID:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n"));\r
+                               //halbtc8723b1ant_ActionPanEdrHid(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n"));\r
+                               //halbtc8723b1ant_ActionHidA2dpPanEdr(pBtCoexist);\r
+                               break;\r
+                       case BT_8723B_1ANT_COEX_ALGO_HID_A2DP:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = HID+A2DP.\n"));\r
+                               //halbtc8723b1ant_ActionHidA2dp(pBtCoexist);\r
+                               break;\r
+                       default:\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action algorithm = coexist All Off!!\n"));\r
+                               //halbtc8723b1ant_CoexAllOff(pBtCoexist);\r
+                               break;\r
+               }\r
+               pCoexDm->preAlgorithm = pCoexDm->curAlgorithm;\r
+       }\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_RunCoexistMechanism(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE, bWifiBusy = FALSE;\r
+       BOOLEAN bIncreaseScanDevNum=FALSE;\r
+       BOOLEAN bBtCtrlAggBufSize=FALSE;\r
+       BOOLEAN bMiracastPlusBt=FALSE;\r
+       u1Byte  aggBufSize=5;\r
+       u1Byte  wifiRssiState=BTC_RSSI_STATE_HIGH;\r
+       u4Byte  wifiLinkStatus=0;\r
+       u4Byte  numOfWifiLink=0, wifiBw;\r
+       u1Byte  iotPeer=BTC_IOT_PEER_UNKNOWN;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism()===>\n"));\r
+\r
+       if(pBtCoexist->bManualControl)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"));\r
+               return;\r
+       }\r
+\r
+       if(pBtCoexist->bStopCoexDm)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"));\r
+               return;\r
+       }\r
+\r
+       if(pCoexSta->bUnderIps)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under IPS !!!\n"));\r
+               return;\r
+       }\r
+\r
+       if(pCoexSta->bBtWhckTest)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is under WHCK TEST!!!\n"));\r
+               halbtc8723b1ant_ActionBtWhckTest(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||\r
+               (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+               (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+       {\r
+               bIncreaseScanDevNum = TRUE;\r
+       }\r
+\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &bIncreaseScanDevNum);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);\r
+       numOfWifiLink = wifiLinkStatus>>16;\r
+       \r
+       if((numOfWifiLink>=2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED))\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex],  Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n", numOfWifiLink,wifiLinkStatus) );\r
+\r
+               if(pBtLinkInfo->bBtLinkExist)\r
+               {\r
+                       halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1);\r
+                       bMiracastPlusBt = TRUE;\r
+               }\r
+               else\r
+               {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+                       bMiracastPlusBt = FALSE;\r
+               }\r
+               pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt);\r
+               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize);\r
+\r
+               if ((  (pBtLinkInfo->bA2dpExist) || (bWifiBusy) ) && (pCoexSta->bC2hBtInquiryPage) )\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex],  BT Is Inquirying \n") );       \r
+                       halbtc8723b1ant_ActionBtInquiry(pBtCoexist);\r
+               }\r
+               else\r
+               halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);\r
+               \r
+               return;\r
+       }\r
+       else\r
+       {\r
+               bMiracastPlusBt = FALSE;\r
+               pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &bMiracastPlusBt);\r
+       }\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);\r
+\r
+       if ( (pBtLinkInfo->bBtLinkExist) && (bWifiConnected) )\r
+       {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1); \r
+\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_IOT_PEER, &iotPeer);\r
+\r
+               if(BTC_IOT_PEER_CISCO != iotPeer)\r
+               {\r
+                       if(pBtLinkInfo->bScoExist)//if (pBtLinkInfo->bBtHiPriLinkExist)\r
+                               //halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5);                         \r
+                               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5);\r
+                       else\r
+                               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5);\r
+                               //halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8);         \r
+               }\r
+               else\r
+               {\r
+                       if(pBtLinkInfo->bScoExist)\r
+                               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x5);\r
+                       else\r
+                       {\r
+                               if (BTC_WIFI_BW_HT40==wifiBw)\r
+                                       halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x10);  \r
+                               else\r
+                                       halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, TRUE, 0x8);\r
+                       }\r
+               }\r
+\r
+               halbtc8723b1ant_SwMechanism(pBtCoexist, TRUE);\r
+               halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist);  //just print debug message\r
+       }\r
+       else\r
+       {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+\r
+               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x5);\r
+\r
+               halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+               halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); ////just print debug message\r
+       }\r
+       \r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+       if(pCoexSta->bC2hBtInquiryPage)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex],  BT Is Inquirying \n") );               \r
+               halbtc8723b1ant_ActionBtInquiry(pBtCoexist);\r
+               return;\r
+       }\r
+       else if(bBtHsOn)\r
+       {\r
+               halbtc8723b1ant_ActionHs(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       \r
+       if(!bWifiConnected)\r
+       {\r
+               BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE;\r
+               \r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is non connected-idle !!!\n"));\r
+\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);\r
+\r
+               if(bScan || bLink || bRoam)\r
+               {\r
+                        if (bScan)     \r
+                               halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist); \r
+                        else\r
+                               halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);     \r
+               }\r
+               else\r
+                       halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);\r
+       }\r
+       else    // wifi LPS/Busy\r
+       {\r
+               halbtc8723b1ant_ActionWifiConnected(pBtCoexist);\r
+       }\r
+}\r
+\r
+u4Byte\r
+halbtc8723b1ant_PSD_Log2Base(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u4Byte                          val\r
+       \r
+       )\r
+{\r
+       u1Byte  i,j;\r
+       u4Byte  tmp, tmp2, val_integerdB=0, tindex, shiftcount=0;\r
+       u4Byte  result,val_fractiondB=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
+       if (val == 0)\r
+        return 0;\r
+\r
+       tmp = val;\r
+\r
+       while(1)\r
+       {\r
+               if (tmp == 1)\r
+                       break;  \r
+               else\r
+               {\r
+                       tmp = (tmp >> 1);\r
+                       shiftcount++;                           \r
+               }\r
+       }\r
+       \r
+\r
+       val_integerdB = shiftcount+1;\r
+\r
+       tmp2=1;\r
+       for (j=1; j<= val_integerdB;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_fractiondB = Table_fraction[tindex];\r
+\r
+       result = val_integerdB*100 - val_fractiondB;                    \r
+\r
+       return (result);\r
+\r
+\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_InitCoexDm(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{      \r
+       // force to reset coex mechanism\r
+\r
+       // sw all off\r
+       halbtc8723b1ant_SwMechanism(pBtCoexist, FALSE);\r
+       \r
+       //halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);\r
+       //halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);\r
+\r
+       pCoexSta->popEventCnt = 0;\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_InitHwConfig(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bBackUp,\r
+       IN      BOOLEAN                         bWifiOnly\r
+       )\r
+{\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       u4Byte                          u4Tmp=0;//, fwVer;\r
+       u2Byte                          u2Tmp=0;\r
+       u1Byte                          u1Tmp=0, u1Tmpa=0, u1Tmpb=0;\r
+       u1Byte                          H2C_Parameter[2] ={0};\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n"));\r
+\r
+       pPsdScan->nAntDet_IsAntDetAvailable = FALSE;\r
+\r
+       //0xf0[15:12] --> Chip Cut information \r
+       pCoexSta->nCutVersion = (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xf1) & 0xf0) >> 4;\r
+       \r
+#if 0//move to BTC_MEDIA_CONNECT\r
+       if(bBackUp)\r
+       {\r
+               pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);\r
+               pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);\r
+               pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);\r
+               pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);\r
+       }\r
+#endif\r
+       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1);  //enable TBTT nterrupt\r
+\r
+       // 0x790[5:0]=0x5       \r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5);\r
+       \r
+       // Enable counter statistics\r
+       //pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1);\r
+       pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1);\r
+\r
+\r
+       //pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi\r
+\r
+       halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);\r
+       \r
+       //Antenna config\r
+       if(bWifiOnly)\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, TRUE, FALSE);\r
+       else\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, TRUE, FALSE);\r
+\r
+#if 0\r
+       if(bWifiOnly)\r
+       {\r
+               halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_WIFI, BTC_WIFI_STAT_INIT);\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);\r
+       }\r
+       else\r
+               halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_INIT);           \r
+#endif\r
+\r
+\r
+\r
+       // PTA parameter\r
+       halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);\r
+\r
+       u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);\r
+       u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);\r
+       u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);\r
+\r
+        RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+                       u4Tmp,  u1Tmpa, u1Tmpb));\r
+}\r
+\r
+\r
+\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_MechanismSwitch(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bSwitchTo2Antenna\r
+       )\r
+{\r
+\r
+       if (bSwitchTo2Antenna)  // 1-Ant -> 2-Ant\r
+       {\r
+               //un-lock TRx Mask setup for 8723b f-cut\r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x1);\r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x1);\r
+               //WiFi TRx Mask on                              \r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); \r
+\r
+               //BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1\r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c45); \r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c45); \r
+       \r
+               //BT TRx Mask on\r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x1); \r
+\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, FALSE);\r
+       }\r
+       else\r
+       {\r
+               //WiFi TRx Mask on                              \r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); \r
+\r
+               //lock TRx Mask setup for 8723b f-cut\r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x0);\r
+               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x0);\r
+\r
+               //BT TRx Mask on\r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); \r
+\r
+               //BT TRx Mask ock 0x2c[0], 0x30[0]  = 0\r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c44); \r
+               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c44); \r
+               \r
+\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+       }\r
+\r
+}\r
+\r
+\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_ShowAntennaDetectResult(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{      \r
+       pu1Byte         cliBuf=pBtCoexist->cliBuf;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n============[Antenna Detection info]  ============\n");\r
+       CL_PRINTF(cliBuf);\r
+\r
+       if (pPsdScan->nAntDet_Result == 1) \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", "Ant Det Result", "2-Antenna (Bad-Isolation)", \r
+                               BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);\r
+       else if (pPsdScan->nAntDet_Result == 2)\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", "Ant Det Result", "2-Antenna (Good-Isolation)", \r
+                               BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset, BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);\r
+       else\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", "Ant Det Result", "1-Antenna",\r
+                               BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset);\r
+\r
+       CL_PRINTF(cliBuf);\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "Antenna Detection Finish",\r
+                                                       (pBoardInfo->btdmAntDetFinish? "Yes":"No"));    \r
+       CL_PRINTF(cliBuf);\r
+\r
+       switch(pPsdScan->nAntDet_Result)\r
+       {\r
+               case 0:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is not available)");\r
+                       break;\r
+               case 1:  // 2-Ant bad-isolation\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)");\r
+                       break;\r
+               case 2:  // 2-Ant good-isolation\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)");\r
+                       break;\r
+               case 3:  // 1-Ant \r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is available)");\r
+                       break;\r
+               case 4:  \r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Uncertainty result)");\r
+                       break;\r
+               case 5:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)");\r
+                       break;  \r
+               case 6:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(WiFi is Scanning)");\r
+                       break;  \r
+               case 7:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is not idle)");\r
+                       break;  \r
+               case 8:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Abort by WiFi Scanning)");\r
+                       break;          \r
+               case 9:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(Antenna Init is not ready)");\r
+                       break;  \r
+               case 10:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is Inquiry or page)");\r
+                       break;  \r
+               case 11:\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "(BT is Disabled)");\r
+                       break;          \r
+}\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Ant Detect Total Count",pPsdScan->bAntDet_TryCount);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Ant Detect Fail Count",pPsdScan->bAntDet_FailCount);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       if ( (!pBoardInfo->btdmAntDetFinish) && (pPsdScan->nAntDet_Result != 5) )\r
+        return;        \r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response",(pPsdScan->nAntDet_Result? "ok":"fail"));\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", pPsdScan->nAntDet_BTTxTime);\r
+       CL_PRINTF(cliBuf);\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", pPsdScan->nAntDet_BTLEChannel);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "WiFi PSD Cent-Ch/Offset/Span", \r
+                               pPsdScan->nRealCentFreq, pPsdScan->nRealOffset, pPsdScan->nRealSpan);\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", "PSD Pre-Scan Peak Value", pPsdScan->nAntDet_PrePSDScanPeakVal/100);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", "PSD Pre-Scan result", \r
+                               (pPsdScan->nAntDet_Result != 5? "ok":"fail"), BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset);  \r
+       CL_PRINTF(cliBuf);\r
+       \r
+       if (pPsdScan->nAntDet_Result == 5)\r
+               return;\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", "PSD Scan Peak Value", pPsdScan->nAntDet_PeakVal);\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", "PSD Scan Peak Freq", pPsdScan->nAntDet_PeakFreq);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", \r
+                       (pBoardInfo->bTfbgaPackage)?  "Yes":"No");\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "PSD Threshold Offset", pPsdScan->nAntDet_ThresOffset);\r
+       CL_PRINTF(cliBuf);\r
+\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_ShowData(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       pu1Byte         cliBuf=pBtCoexist->cliBuf;\r
+       u4Byte          nDeltaFreqPerPoint;\r
+       u4Byte          freq,freq1,freq2,n=0,i=0, j=0, m=0, PsdRep1, PsdRep2;\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n\n============[PSD info]  (%d)============\n",\r
+                       pPsdScan->nPSDGenCount);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       if (pPsdScan->nPSDGenCount == 0)\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n No Data !!\n");\r
+               CL_PRINTF(cliBuf);\r
+               return;\r
+       }\r
+\r
+       if (pPsdScan->nPSDPoint == 0)\r
+               nDeltaFreqPerPoint = 0;\r
+       else                    \r
+               nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint;               \r
+\r
+       //if (pPsdScan->bIsPSDShowMaxOnly)\r
+       if (0)\r
+       {       \r
+               PsdRep1 = pPsdScan->nPSDMaxValue/100;\r
+               PsdRep2 = pPsdScan->nPSDMaxValue - PsdRep1 * 100;\r
+                               \r
+               freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + pPsdScan->nPSDMaxValuePoint * nDeltaFreqPerPoint);\r
+               freq1 = freq/1000000;\r
+               freq2 = freq/1000 - freq1 * 1000;\r
+\r
+               if (freq2 < 100)        \r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.0%d MHz",  \r
+                         freq1, freq2);\r
+               else\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq = %d.%d MHz",  \r
+                         freq1, freq2);\r
+\r
+               if (PsdRep2 < 10)       \r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.0%d dB, (%d) \n",  \r
+                         PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue);\r
+               else\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, ", Value = %d.%d dB, (%d)\n",  \r
+                         PsdRep1, PsdRep2, pPsdScan->nPSDMaxValue);\r
+               \r
+               CL_PRINTF(cliBuf);\r
+       }\r
+       else\r
+       {\r
+               m = pPsdScan->nPSDStartPoint;\r
+               n = pPsdScan->nPSDStartPoint;\r
+               i = 1;\r
+               j = 1;                          \r
+\r
+        while(1)\r
+        {\r
+               do\r
+               {\r
+                       freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + m * nDeltaFreqPerPoint);\r
+                       freq1 = freq/1000000;\r
+                       freq2 = freq/1000 - freq1 * 1000;\r
+                       \r
+                       if (i ==1)\r
+                       {\r
+                               if (freq2 == 0)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.000", freq1);\r
+                               else if (freq2 < 100)   \r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.0%2d", freq1,freq2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Freq%6d.%3d", freq1,freq2);\r
+                       }\r
+                       else if  ( (i%8 == 0) || (m == pPsdScan->nPSDStopPoint) )\r
+                       {\r
+                               if (freq2 == 0)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000\n", freq1);\r
+                               else if (freq2 < 100)   \r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d\n", freq1,freq2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d\n", freq1,freq2);\r
+                       }                       \r
+                       else\r
+                       {\r
+                               if (freq2 == 0)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.000", freq1);\r
+                               else if (freq2 < 100)   \r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.0%2d", freq1,freq2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%6d.%3d", freq1,freq2);\r
+                       }\r
+\r
+                       i++;                                    \r
+                       m++;\r
+                       CL_PRINTF(cliBuf);\r
+\r
+               }while(  (i <= 8) && (m <= pPsdScan->nPSDStopPoint));   \r
+               \r
+               \r
+               do\r
+               {\r
+                       PsdRep1 = pPsdScan->nPSDReport_MaxHold[n]/100;\r
+                       PsdRep2 = pPsdScan->nPSDReport_MaxHold[n] - PsdRep1 * 100;\r
+                               \r
+                       if (j ==1)\r
+                       {\r
+                               if (PsdRep2 <10)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.0%d", PsdRep1,PsdRep2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n Val %7d.%d", PsdRep1,PsdRep2);\r
+                       }\r
+                       else if ( (j%8 == 0)  || (n == pPsdScan->nPSDStopPoint) )\r
+                       {\r
+                               if (PsdRep2 <10)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d\n", PsdRep1,PsdRep2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d\n", PsdRep1,PsdRep2);\r
+                       }\r
+                       else\r
+                       {\r
+                               if (PsdRep2 <10)\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.0%d", PsdRep1,PsdRep2);\r
+                               else\r
+                                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "%7d.%d", PsdRep1,PsdRep2);\r
+                       }\r
+\r
+                       j++;\r
+                       n++;\r
+                       CL_PRINTF(cliBuf);\r
+                       \r
+               } while(  (j <= 8) && (n <= pPsdScan->nPSDStopPoint));          \r
+\r
+               if  ( (m > pPsdScan->nPSDStopPoint) || (n > pPsdScan->nPSDStopPoint) )\r
+                break;\r
+               else\r
+               {\r
+                       i = 1;\r
+                       j = 1;\r
+               }\r
+               \r
+        }      \r
+       }\r
+\r
+\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_MaxHoldData(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u4Byte                          GenCount\r
+       )\r
+{\r
+                u4Byte i=0, i_max=0, val_max=0, j;\r
+                \r
+               if (GenCount== 1)\r
+               {\r
+                       memcpy(pPsdScan->nPSDReport_MaxHold, pPsdScan->nPSDReport, BT_8723B_1ANT_ANTDET_PSD_POINTS*sizeof(u4Byte));\r
+\r
+                       for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++)\r
+                       {\r
+                               //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i,  pPsdScan->nPSDReport_MaxHold[i]));\r
+                       }\r
+\r
+                       pPsdScan->nPSDMaxValuePoint = 0;\r
+                       pPsdScan->nPSDMaxValue = 0;\r
+\r
+               }       \r
+               else\r
+               {\r
+                       for (i= pPsdScan->nPSDStartPoint; i<=pPsdScan->nPSDStopPoint; i++)\r
+                       {\r
+                               if (pPsdScan->nPSDReport[i] > pPsdScan->nPSDReport_MaxHold[i])\r
+                                       pPsdScan->nPSDReport_MaxHold[i] = pPsdScan->nPSDReport[i];\r
+\r
+                               //search Max Value\r
+                               if (i ==pPsdScan->nPSDStartPoint )\r
+                               {\r
+                                       i_max = i;\r
+                                       val_max = pPsdScan->nPSDReport_MaxHold[i];\r
+                               }\r
+                               else\r
+                               {\r
+                                       if (pPsdScan->nPSDReport_MaxHold[i] > val_max)\r
+                                       {\r
+                                               i_max = i;\r
+                                               val_max = pPsdScan->nPSDReport_MaxHold[i];\r
+                                       }\r
+                               }\r
+\r
+                               //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i = %d, PSDReport = %d dB\n", i,  pPsdScan->nPSDReport_MaxHold[i]));\r
+\r
+                       }\r
+       \r
+                       pPsdScan->nPSDMaxValuePoint = i_max;\r
+                       pPsdScan->nPSDMaxValue = val_max;\r
+\r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Max_Hold i_Max = %d, PSDReport_Max = %d dB\n", pPsdScan->nPSDMaxValuePoint\r
+                       //              ,pPsdScan->nPSDMaxValue));\r
+               }\r
+\r
+\r
+}\r
+\r
+u4Byte\r
+halbtc8723b1ant_PSD_GetData(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u4Byte                          nPoint\r
+       )\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
+       u4Byte val = 0, psd_report =0;\r
+       \r
+       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808);\r
+\r
+       val &= 0xffbffc00;\r
+       val |= nPoint;\r
+       \r
+        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val);\r
+\r
+       val |= 0x00400000;\r
+        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val);\r
+\r
+\r
+       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x8b4);\r
+\r
+       psd_report = val & 0x0000ffff;\r
+        \r
+       return psd_report;\r
+}\r
+\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_SweepPoint(\r
+IN     PBTC_COEXIST                    pBtCoexist,\r
+       IN      u4Byte                          centFreq,\r
+       IN      s4Byte                          offset,\r
+       IN      u4Byte                          span,\r
+       IN      u4Byte                          points,\r
+       IN      u4Byte                          avgnum\r
+       )\r
+{\r
+       u4Byte   i,val,n,k=0;\r
+       u4Byte  nPoints=0, psd_report=0;\r
+       u4Byte  nStartP=0, nStopP=0, nDeltaFreqPerPoint=156250;\r
+       u4Byte    nPSDCenterFreq=20*10^6, freq,freq1,freq2;     \r
+       BOOLEAN outloop = FALSE;\r
+       u1Byte   flag = 0;      \r
+       u4Byte  tmp, PsdRep1, PsdRep2;\r
+       u4Byte  WiFi_OriginalChannel = 1;\r
+\r
+       pPsdScan->bIsPSDRunning = TRUE;\r
+       \r
+       do\r
+       {\r
+               switch(flag)\r
+               {\r
+                  case 0:  //Get PSD parameters\r
+                  default:     \r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), centFreq=0x%x, offset=0x%x, span=0x%x\n", \r
+                      //     centFreq, offset, span));\r
+\r
+                       pPsdScan->nPSDBandWidth = 40*1000000;\r
+                       pPsdScan->nPSDPoint = points;\r
+                       pPsdScan->nPSDStartBase = points/2; \r
+                       pPsdScan->nPSDAvgNum = avgnum;\r
+                       pPsdScan->nRealCentFreq = centFreq;\r
+                       pPsdScan->nRealOffset = offset;\r
+                       pPsdScan->nRealSpan = span;\r
+               \r
+                       \r
+                       nPoints = pPsdScan->nPSDPoint;\r
+                       nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint;\r
+\r
+                       //PSD point setup\r
+                       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808);\r
+                       val &= 0xffff0fff;                              \r
+                       \r
+                       switch(pPsdScan->nPSDPoint)\r
+                       {\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(pPsdScan->nPSDAvgNum)\r
+                       {\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
+                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x808, val);\r
+\r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD BW= %d, DeltaFreq=%d\n"\r
+                       //      , pPsdScan->nPSDBandWidth, nDeltaFreqPerPoint));\r
+                       flag = 1;\r
+                       break;\r
+                 case 1:         //calculate the PSD point index from freq/offset/span\r
+                       nPSDCenterFreq = pPsdScan->nPSDBandWidth /2 +offset*(1000000);\r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), PSD Center Freq = %d\n", (centFreq + offset)));\r
+                       \r
+                       nStartP = pPsdScan->nPSDStartBase + (nPSDCenterFreq - span *(1000000)/2) /nDeltaFreqPerPoint;\r
+                       pPsdScan->nPSDStartPoint = nStartP - pPsdScan->nPSDStartBase;\r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Start PSD Poin Matrix Index = %d\n", pPsdScan->nPSDStartPoint));\r
+\r
+                       nStopP = pPsdScan->nPSDStartBase + (nPSDCenterFreq + span *(1000000)/2) /nDeltaFreqPerPoint;\r
+                       pPsdScan->nPSDStopPoint = nStopP - pPsdScan->nPSDStartBase-1;\r
+                       //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), Stop PSD Poin Matrix Index = %d\n",pPsdScan->nPSDStopPoint));\r
+\r
+                       flag = 2;\r
+                       break;\r
+                 case 2:  //set RF channel/BW/Mode\r
+\r
+                       //set 3-wire off\r
+                       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c);\r
+                       val |= 0x00300000;\r
+                        pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val);\r
+\r
+                       //CCK off\r
+                       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800);\r
+                       val &= 0xfeffffff;\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val);               \r
+\r
+                       //store WiFi original channel\r
+                       WiFi_OriginalChannel = pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff);\r
+\r
+                       //Set RF channel\r
+                      if (centFreq == 2484)\r
+                               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, 0xe); \r
+                       else\r
+                               pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, (centFreq-2412)/5 + 1); //WiFi TRx Mask on\r
+\r
+                       //Set  RF mode = Rx, RF Gain = 0x8a0\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x0, 0xfffff, 0x308a0);\r
+\r
+                       //Set RF Rx filter corner\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x3e4);\r
+\r
+                       //Set TRx mask off\r
+                       //un-lock TRx Mask setup\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x1);\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x1);\r
+\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0);\r
+\r
+                       flag = 3;\r
+                       break;\r
+                 case 3:\r
+                       memset(pPsdScan->nPSDReport,0, pPsdScan->nPSDPoint*sizeof(u4Byte));\r
+                       nStartP = pPsdScan->nPSDStartPoint + pPsdScan->nPSDStartBase;\r
+                       nStopP = pPsdScan->nPSDStopPoint +  pPsdScan->nPSDStartBase + 1;\r
+                               \r
+                       i = nStartP;\r
+\r
+                       while (i < nStopP)\r
+                       {\r
+                               if (i >= nPoints)\r
+                               {\r
+                                       psd_report = halbtc8723b1ant_PSD_GetData(pBtCoexist,i-nPoints);\r
+                               }\r
+                               else\r
+                               {\r
+                                       psd_report = halbtc8723b1ant_PSD_GetData(pBtCoexist,i);\r
+                               }\r
+\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(pBtCoexist, psd_report);                         \r
+\r
+                               n = i-pPsdScan->nPSDStartBase;\r
+                               pPsdScan->nPSDReport[n] =  tmp;\r
+                               PsdRep1 = pPsdScan->nPSDReport[n] /100;\r
+                               PsdRep2 = pPsdScan->nPSDReport[n] - PsdRep1 * 100;\r
+                               \r
+                               freq =  ((centFreq-20) * 1000000 + n * nDeltaFreqPerPoint);\r
+                               freq1 = freq/1000000;\r
+                               freq2 = freq/1000 - freq1 * 1000;\r
+/*\r
+                               if (freq2 < 100)\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.0%d MHz)", n, freq1, freq2));\r
+                               else\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint(), i = %d (%d.%d MHz)", n, freq1, freq2));\r
+\r
+                               if (PsdRep2 < 10)\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.0%d dB)\n",psd_report, PsdRep1, PsdRep2));\r
+                               else\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, (", PSDReport = %d (%d.%d dB)\n",psd_report, PsdRep1,PsdRep2));   \r
+*/\r
+                               i++;\r
+\r
+                               k=0;\r
+\r
+                               //Add Delay between PSD point\r
+                               while(1)\r
+                               {\r
+                                       if (k++ > 20000)\r
+                                        break;\r
+                               }\r
+\r
+                               //RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx SweepPSDPoint()==============\n"));\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 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x88c);\r
+                       val &=0xffcfffff;\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x88c,val);\r
+\r
+                       //CCK on\r
+                       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x800);\r
+                       val |= 0x01000000;\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x800,val);       \r
+\r
+                       //PSD off\r
+                       val = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x808);\r
+                       val &=0xffbfffff;\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist,0x808,val);\r
+                       \r
+                       //TRx Mask on\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780);\r
+\r
+                       //lock TRx Mask setup\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdd, 0x80, 0x0);\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0xdf, 0x1, 0x0);\r
+\r
+                       //Set RF Rx filter corner\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0x0);\r
+\r
+                       //restore WiFi original channel\r
+                       pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x18, 0x3ff, WiFi_OriginalChannel); \r
+                       \r
+                       outloop = TRUE;\r
+                       break;\r
+\r
+               }               \r
+                       \r
+       }while (!outloop);\r
+\r
+\r
+\r
+       pPsdScan->bIsPSDRunning = FALSE;\r
+\r
+\r
+}\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_AntennaDetection(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u4Byte                                  BTTxTime,\r
+       IN      u4Byte                                  BTLEChannel\r
+       )\r
+{\r
+       u4Byte  realseconds = 0, i=0, j=0;\r
+       u4Byte  WLPSD_CentFreq = 2484, WLPSD_Span = 2, WLPSD_SweepCount = 50; \r
+       s4Byte  WLPSD_Offset = -4;\r
+       u1Byte  BTLECh[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33};\r
+\r
+       u1Byte  H2C_Parameter[3] ={0},u1Tmpa,u1Tmpb;\r
+       \r
+       u1Byte  state=0;\r
+       BOOLEAN         outloop = FALSE, BTResp = FALSE, bScan ,bRoam;\r
+       u4Byte          freq,freq1,freq2,PsdRep1, PsdRep2, nDeltaFreqPerPoint,u4Tmp;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+\r
+       pBoardInfo->btdmAntDetFinish = FALSE;   \r
+       memset(pPsdScan->nAntDet_PeakVal, 0, 16*sizeof(UCHAR));\r
+       memset(pPsdScan->nAntDet_PeakFreq, 0, 16*sizeof(UCHAR));\r
+\r
+       if (pBoardInfo->bTfbgaPackage) //for TFBGA\r
+               pPsdScan->nAntDet_ThresOffset = 5;\r
+       else\r
+               pPsdScan->nAntDet_ThresOffset = 0;\r
+\r
+       do\r
+       {\r
+               switch(state)\r
+               {\r
+                       case 0:\r
+                               if (BTLEChannel == 39)\r
+                                WLPSD_CentFreq = 2484;\r
+                               else\r
+                               {\r
+                                       for (i=1; i<=13; i++)\r
+                                       {\r
+                                               if (BTLECh[i-1] == BTLEChannel)\r
+                                               {\r
+                                                        WLPSD_CentFreq = 2412 + (i-1) * 5;\r
+                                                        break;\r
+                                               }\r
+                                       }\r
+\r
+                                       if (i == 14)\r
+                                       {\r
+\r
+                                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ",  BTLEChannel));\r
+                                               outloop = TRUE;\r
+                                               break;                                  \r
+                                       }\r
+                               }\r
+                               \r
+                               WLPSD_SweepCount = BTTxTime * 238 /100;  //BTTxTime/0.42                                                                \r
+\r
+                               if (WLPSD_SweepCount % 5 != 0)\r
+                                       WLPSD_SweepCount = (WLPSD_SweepCount/5 + 1) * 5;\r
+\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d,  BT_LECh = %d\n", BTTxTime, BTLEChannel));\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), WLPSD_CentFreq=%d,  WLPSD_Offset = %d, WLPSD_Span = %d, WLPSD_SweepCount = %d\n",\r
+                                                                       WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span,WLPSD_SweepCount));\r
+                               \r
+                               state = 1;\r
+                               break;\r
+                       case 1: //stop coex DM & set antenna path\r
+       //Stop Coex DM\r
+       pBtCoexist->bStopCoexDm = TRUE;\r
+\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"));\r
+\r
+                               //set native power save\r
+                               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+\r
+                               //Set TDMA off,                                 \r
+                               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0);                               \r
+\r
+                               //Set coex table\r
+                               halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);\r
+\r
+                               if(pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"));\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"));\r
+                               }\r
+               \r
+       //Set Antenna path, switch WiFi to un-certain antenna port\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, FALSE);\r
+\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"));\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
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",\r
+                                                                       H2C_Parameter[1],H2C_Parameter[2]));\r
+       \r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter);\r
+\r
+                               u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);\r
+                               u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);\r
+                               u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778);\r
+       \r
+                                RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n",\r
+                                               u4Tmp,  u1Tmpa, u1Tmpb));\r
+\r
+                               state =2;\r
+                               break;\r
+                       case 2: //Pre-sweep background psd\r
+                               for (pPsdScan->nPSDGenCount=1; pPsdScan->nPSDGenCount<=3; pPsdScan->nPSDGenCount++)\r
+       {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), PSDGenCount = %d\n ",  pPsdScan->nPSDGenCount));\r
+                                       halbtc8723b1ant_PSD_SweepPoint(pBtCoexist, WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span, BT_8723B_1ANT_ANTDET_PSD_POINTS, BT_8723B_1ANT_ANTDET_PSD_AVGNUM);                         \r
+                                       halbtc8723b1ant_PSD_MaxHoldData(pBtCoexist,  pPsdScan->nPSDGenCount);                                   \r
+                               }\r
+               \r
+                               pPsdScan->nAntDet_PrePSDScanPeakVal = pPsdScan->nPSDMaxValue;\r
+       \r
+                               if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset)*100)\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n",\r
+                                               pPsdScan->nPSDMaxValue/100, BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset));\r
+                                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 1;\r
+                                       pPsdScan->nAntDet_Result = 5;\r
+                                       state = 99;\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n",\r
+                                               pPsdScan->nPSDMaxValue/100, BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND+pPsdScan->nAntDet_ThresOffset));\r
+                                       state = 3;\r
+                               }\r
+                               break;\r
+                       case 3: \r
+                               BTResp = pBtCoexist->fBtcSetBtAntDetection(pBtCoexist, (u1Byte)(BTTxTime&0xff), (u1Byte)(BTLEChannel&0xff)); \r
+       \r
+                               for (pPsdScan->nPSDGenCount=1; pPsdScan->nPSDGenCount<=WLPSD_SweepCount; pPsdScan->nPSDGenCount++)\r
+               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), PSDGenCount = %d\n ",  pPsdScan->nPSDGenCount));\r
+                                       halbtc8723b1ant_PSD_SweepPoint(pBtCoexist, WLPSD_CentFreq, WLPSD_Offset, WLPSD_Span, BT_8723B_1ANT_ANTDET_PSD_POINTS, BT_8723B_1ANT_ANTDET_PSD_AVGNUM);                         \r
+                                       halbtc8723b1ant_PSD_MaxHoldData(pBtCoexist,  pPsdScan->nPSDGenCount);   \r
+\r
+                                       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);\r
+                                       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);\r
+\r
+                                       if (bScan ||bRoam)\r
+                       {\r
+                                               pBoardInfo->btdmAntDetFinish = FALSE;\r
+                                               pBoardInfo->btdmAntNumByAntDet = 1;\r
+                                               pPsdScan->nAntDet_Result = 8;\r
+                                               state = 99;     \r
+                                               break;\r
+                       }\r
+               }       \r
+\r
+                               pPsdScan->nAntDet_PSDScanPeakVal = pPsdScan->nPSDMaxValue;\r
+                               pPsdScan->nAntDet_PSDScanPeakFreq = pPsdScan->nPSDMaxValuePoint;\r
+                               state = 4;\r
+                               break;\r
+                       case 4:                         \r
+\r
+                               if (pPsdScan->nPSDPoint == 0)\r
+                                       nDeltaFreqPerPoint = 0;\r
+               else\r
+                                       nDeltaFreqPerPoint = pPsdScan->nPSDBandWidth/pPsdScan->nPSDPoint;               \r
+\r
+                               PsdRep1 = pPsdScan->nPSDMaxValue/100;\r
+                               PsdRep2 = pPsdScan->nPSDMaxValue - PsdRep1 * 100;\r
+                               \r
+                               freq = ((pPsdScan->nRealCentFreq-20) * 1000000 + pPsdScan->nPSDMaxValuePoint * nDeltaFreqPerPoint);\r
+                               freq1 = freq/1000000;\r
+                               freq2 = freq/1000 - freq1 * 1000;\r
+\r
+                               if (freq2 < 100)\r
+               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", freq1, freq2));\r
+                                       CL_SPRINTF(pPsdScan->nAntDet_PeakFreq, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.0%d", freq1,freq2);\r
+                               }\r
+                               else\r
+                       {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz",  freq1, freq2));\r
+                                       CL_SPRINTF(pPsdScan->nAntDet_PeakFreq, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.%d", freq1,freq2);\r
+                               }\r
+\r
+                               if (PsdRep2 < 10)       \r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, (", Value = %d.0%d dB\n",   PsdRep1, PsdRep2));\r
+                                       CL_SPRINTF(pPsdScan->nAntDet_PeakVal, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.0%d", PsdRep1,PsdRep2);\r
+                               }\r
+                               else\r
+                               {\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, (", Value = %d.%d dB\n",PsdRep1, PsdRep2));\r
+                                       CL_SPRINTF(pPsdScan->nAntDet_PeakVal, BT_8723B_1ANT_ANTDET_BUF_LEN, "%d.%d", PsdRep1,PsdRep2);\r
+                               }\r
+\r
+                               pPsdScan->nAntDet_IsBTReplyAvailable = TRUE;\r
+                               \r
+                               if (BTResp == FALSE)\r
+                               {\r
+                                       pPsdScan->nAntDet_IsBTReplyAvailable = FALSE;\r
+                                       pPsdScan->nAntDet_Result = 0;\r
+                                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 1;\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail \n "));\r
+                               }\r
+                               else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)*100)\r
+                               {\r
+                                       pPsdScan->nAntDet_Result = 1;\r
+                                       pBoardInfo->btdmAntDetFinish = TRUE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 2;\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!! \n"));\r
+                               }\r
+                               else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION+pPsdScan->nAntDet_ThresOffset)*100)\r
+                                       {\r
+                                       pPsdScan->nAntDet_Result = 2;\r
+                                       pBoardInfo->btdmAntDetFinish = TRUE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 2;\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!! \n"));\r
+                               }\r
+                               else if (pPsdScan->nPSDMaxValue > (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT)*100)\r
+                               {\r
+                                       pPsdScan->nAntDet_Result = 3;\r
+                                       pBoardInfo->btdmAntDetFinish = TRUE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 1;\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"));\r
+                                       }\r
+                               else\r
+                               {\r
+                                       pPsdScan->nAntDet_Result = 4;\r
+                                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                                       pBoardInfo->btdmAntNumByAntDet = 1;\r
+                                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"));\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
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d,  Mask=%d\n",\r
+                                       H2C_Parameter[1],H2C_Parameter[2]));            \r
+\r
+                               pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter);\r
+                               \r
+                               //Set Antenna Path                                      \r
+                               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"));\r
+\r
+                               //Resume Coex DM\r
+                               pBtCoexist->bStopCoexDm = FALSE;\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"));\r
+\r
+                               //stimulate coex running\r
+                               halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"));\r
+\r
+                               outloop = TRUE;\r
+                               break;\r
+                       }\r
+       \r
+       }while(!outloop);\r
+       \r
+\r
+\r
+               }\r
+\r
+VOID\r
+halbtc8723b1ant_PSD_AntennaDetectionCheck(\r
+       IN      PBTC_COEXIST                    pBtCoexist\r
+       )\r
+{\r
+       static u4Byte AntDetCount = 0, AntDetFailCount = 0;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       \r
+       BOOLEAN bScan, bRoam;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);  \r
+\r
+\r
+       pPsdScan->nAntDet_BTTxTime = 20;  //0.42ms*50 = 20ms\r
+       pPsdScan->nAntDet_BTLEChannel = 39;             \r
+\r
+       AntDetCount++;\r
+       \r
+       pPsdScan->bAntDet_TryCount = AntDetCount;       \r
+                       \r
+       if (bScan ||bRoam)\r
+               {\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pPsdScan->nAntDet_Result = 6;\r
+       }\r
+       else if(pBtCoexist->btInfo.bBtDisabled)\r
+       {\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pPsdScan->nAntDet_Result = 11;\r
+       }\r
+       else if (pCoexSta->nNumOfProfile >= 1) \r
+       {\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pPsdScan->nAntDet_Result = 7;\r
+       }\r
+       else if (!pPsdScan->nAntDet_IsAntDetAvailable)  //Antenna initial setup is not ready\r
+       {\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pPsdScan->nAntDet_Result = 9;\r
+       }\r
+       else if (pCoexSta->bC2hBtInquiryPage)\r
+               {\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pPsdScan->nAntDet_Result = 10;\r
+               }\r
+               else\r
+               {\r
+               halbtc8723b1ant_PSD_AntennaDetection(pBtCoexist,  pPsdScan->nAntDet_BTTxTime, pPsdScan->nAntDet_BTLEChannel);                   \r
+               }\r
+\r
+       if (!pBoardInfo->btdmAntDetFinish)\r
+               AntDetFailCount++;\r
+\r
+       pPsdScan->bAntDet_FailCount = AntDetFailCount;\r
+\r
+}\r
+\r
+\r
+//============================================================\r
+// work around function start with wa_halbtc8723b1ant_\r
+//============================================================\r
+//============================================================\r
+// extern function start with EXhalbtc8723b1ant_\r
+//============================================================\r
+VOID\r
+EXhalbtc8723b1ant_PowerOnSetting(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       u1Byte u1Tmp=0x0;\r
+       u2Byte u2Tmp=0x0;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"));\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("Ant Det Finish = %s, Ant Det Number  = %d\n",  \r
+                (pBoardInfo->btdmAntDetFinish? "Yes":"No"), pBoardInfo->btdmAntNumByAntDet));\r
+\r
+       pBtCoexist->bStopCoexDm = TRUE;\r
+\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20);\r
+\r
+       // enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly.\r
+       u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2);\r
+       pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1);\r
+\r
+       // set GRAN_BT = 1\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);\r
+       // set WLAN_ACT = 0\r
+       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 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(pBtCoexist->chipInterface == BTC_INTF_USB)\r
+       {\r
+               // fixed at S0 for USB interface\r
+               pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);\r
+\r
+               u1Tmp |= 0x1;   // antenna inverse\r
+               pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp);\r
+\r
+               pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;\r
+       }\r
+       else\r
+       {\r
+               // for PCIE and SDIO interface, we check efuse 0xc3[6]\r
+               if(pBoardInfo->singleAntPath == 0)\r
+               {\r
+                       // set to S1\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);\r
+                       pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT;\r
+               }\r
+               else if(pBoardInfo->singleAntPath == 1)\r
+               {\r
+                       // set to S0\r
+                       pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);\r
+                       u1Tmp |= 0x1;   // antenna inverse\r
+                       pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;\r
+               }\r
+\r
+               if(pBtCoexist->chipInterface == BTC_INTF_PCI)\r
+               {       \r
+                       pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp);\r
+               }\r
+               else if(pBtCoexist->chipInterface == BTC_INTF_SDIO)\r
+               {\r
+                       pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp);\r
+               }                       \r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_PreLoadFirmware(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_InitHwConfig(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      BOOLEAN                         bWifiOnly\r
+       )\r
+{\r
+       halbtc8723b1ant_InitHwConfig(pBtCoexist, TRUE, bWifiOnly);\r
+       pBtCoexist->bStopCoexDm = FALSE;\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_InitCoexDm(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n"));\r
+\r
+       pBtCoexist->bStopCoexDm = FALSE;\r
+       \r
+       halbtc8723b1ant_InitCoexDm(pBtCoexist);\r
+\r
+       halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_DisplayCoexInfo(\r
+       IN      PBTC_COEXIST            pBtCoexist\r
+       )\r
+{\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       PBTC_STACK_INFO         pStackInfo=&pBtCoexist->stackInfo;\r
+       PBTC_BT_LINK_INFO       pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       pu1Byte                         cliBuf=pBtCoexist->cliBuf;\r
+       u1Byte                          u1Tmp[4], i, btInfoExt, psTdmaCase=0;\r
+       u2Byte                          u2Tmp[4];\r
+       u4Byte                          u4Tmp[4];\r
+       u4Byte                          faOfdm, faCck;\r
+       u4Byte                          fwVer=0, btPatchVer=0;\r
+       static u1Byte                   PopReportIn10s = 0;     \r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============");\r
+       CL_PRINTF(cliBuf);\r
+\r
+       if(pBtCoexist->bManualControl)\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Under Manual Control]============");\r
+               CL_PRINTF(cliBuf);\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ==========================================");\r
+               CL_PRINTF(cliBuf);\r
+       }\r
+       if(pBtCoexist->bStopCoexDm)\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[Coex is STOPPED]============");\r
+               CL_PRINTF(cliBuf);\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ==========================================");\r
+               CL_PRINTF(cliBuf);\r
+       }\r
+\r
+       if (pPsdScan->bAntDet_TryCount == 0)\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Mech/ Pos",\r
+               pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos);\r
+       CL_PRINTF(cliBuf);      \r
+       }\r
+       else\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d  (%d/%d/%d)", "Ant PG Num/ Mech(Ant_Det)/ Pos", \r
+               pBoardInfo->pgAntNum, pBoardInfo->btdmAntNumByAntDet, pBoardInfo->btdmAntPos, \r
+               pPsdScan->bAntDet_TryCount, pPsdScan->bAntDet_FailCount, pPsdScan->nAntDet_Result);             \r
+               CL_PRINTF(cliBuf);\r
+\r
+               if (pBoardInfo->btdmAntDetFinish)\r
+               {\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "Ant Det PSD Value",  pPsdScan->nAntDet_PeakVal);                \r
+                       CL_PRINTF(cliBuf);\r
+               }\r
+       }\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \\r
+               ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", "Version Coex/ Fw/ Patch/ Cut", \\r
+               GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer, pCoexSta->nCutVersion+65);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \\r
+               pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1],\r
+               pCoexDm->wifiChnlInfo[2]);\r
+       CL_PRINTF(cliBuf);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", "WifibHiPri/ Ccklock/ CckEverLock", \\r
+               (pCoexSta->bWiFiIsHighPriTask? "Yes":"No"),\r
+               (pCoexSta->bCCKLock? "Yes":"No"),\r
+               (pCoexSta->bCCKEverLock? "Yes":"No"));\r
+       CL_PRINTF(cliBuf);\r
+\r
+       // wifi status\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============");\r
+       CL_PRINTF(cliBuf);\r
+       pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============");\r
+       CL_PRINTF(cliBuf);\r
+       \r
+       PopReportIn10s++;\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \\r
+               ((pBtCoexist->btInfo.bBtDisabled)? ("disabled"):        ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)? "non-connected idle":\r
+               (  (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy")))),\r
+               pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt);\r
+       CL_PRINTF(cliBuf);\r
+       \r
+       if (PopReportIn10s >= 5)\r
+       {\r
+               pCoexSta->popEventCnt = 0;      \r
+               PopReportIn10s = 0;\r
+       }\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d / %d / %d", "SCO/HID/PAN/A2DP/NameReq/WHQL", \\r
+               pBtLinkInfo->bScoExist, pBtLinkInfo->bHidExist, pBtLinkInfo->bPanExist, pBtLinkInfo->bA2dpExist, pCoexSta->bC2hBtRemoteNameReq, pCoexSta->bBtWhckTest );\r
+       CL_PRINTF(cliBuf);\r
+\r
+       if (pStackInfo->bProfileNotified)\r
+       {\r
+       pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO);      \r
+       }\r
+       else\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \\r
+               (pBtLinkInfo->bSlaveRole )? "Slave":"Master");\r
+               CL_PRINTF(cliBuf);      \r
+       }       \r
+\r
+       btInfoExt = pCoexSta->btInfoExt;\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", "A2DP Rate/Bitpool", \\r
+               (btInfoExt&BIT0)? "BR":"EDR", pCoexSta->nA2DPBitPool);\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       for(i=0; i<BT_INFO_SRC_8723B_1ANT_MAX; i++)\r
+       {\r
+               if(pCoexSta->btInfoC2hCnt[i])\r
+               {                               \r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b1Ant[i], \\r
+                               pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1],\r
+                               pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3],\r
+                               pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5],\r
+                               pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]);\r
+                       CL_PRINTF(cliBuf);\r
+               }\r
+       }\r
+\r
+       \r
+       if(pBtCoexist->bManualControl)\r
+       {                       \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism] (before Manual)============");                    \r
+       }\r
+       else\r
+       {\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============");\r
+       }       \r
+\r
+               CL_PRINTF(cliBuf);\r
+       \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "SM[LowPenaltyRA]", \\r
+                       pCoexDm->bCurLowPenaltyRa);\r
+               CL_PRINTF(cliBuf);\r
+\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \\r
+                       (pBtCoexist->btInfo.bRejectAggPkt? "Yes":"No"), (pBtCoexist->btInfo.bBtCtrlAggBufSize? "Yes":"No"),\r
+                               pBtCoexist->btInfo.aggBufSize);\r
+               CL_PRINTF(cliBuf);\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", \\r
+                               pBtCoexist->btInfo.raMask);\r
+               CL_PRINTF(cliBuf);\r
+\r
+               // Fw mechanism         \r
+               if(pBtCoexist->bManualControl)\r
+               {\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism] (before Manual) ============");                   \r
+               }\r
+               else\r
+               {\r
+                       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============");\r
+               }\r
+               \r
+               CL_PRINTF(cliBuf);      \r
+\r
+               psTdmaCase = pCoexDm->curPsTdma;\r
+               if (pBoardInfo->btdmAntNumByAntDet == 2)\r
+               {\r
+                       if (pCoexDm->bCurPsTdmaOn)\r
+                               psTdmaCase = psTdmaCase +100;  //for WiFi RSSI low or BT RSSI low\r
+                       else\r
+                               psTdmaCase = 1; //always translate to TDMA(off,1) for TDMA-off case\r
+               }\r
+               \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", "PS TDMA", \\r
+                       pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1],\r
+                       pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3],\r
+                       pCoexDm->psTdmaPara[4], psTdmaCase, \r
+                       (pCoexDm->bCurPsTdmaOn? "On":"Off"),\r
+                       (pCoexDm->bAutoTdmaAdjust? "Adj":"Fix") );\r
+               \r
+               CL_PRINTF(cliBuf);\r
+               \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \\r
+                       pCoexSta->nCoexTableType);\r
+               CL_PRINTF(cliBuf);\r
+               \r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "IgnWlanAct", \\r
+                       pCoexDm->bCurIgnoreWlanAct);\r
+               CL_PRINTF(cliBuf);\r
+       \r
+               /*\r
+               CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \\r
+                       pCoexDm->errorCondition);\r
+               CL_PRINTF(cliBuf);\r
+               */\r
+\r
+       // Hw setting           \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============");\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \\r
+               pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);\r
+       u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \\r
+               u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778);\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/0x880[29:25]", \\r
+               u1Tmp[0], u4Tmp[0],  (u4Tmp[1]&0x3e000000) >> 25);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x764);\r
+       u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x764 / 0x76e", \\r
+               u4Tmp[0], ((u1Tmp[0]&0x20)>> 5), (u4Tmp[1] & 0xffff), u1Tmp[1]);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930);\r
+       u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944);        \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \\r
+               u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39);\r
+       u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40);\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);\r
+       u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \\r
+               ((u1Tmp[0] & 0x8)>>3), u1Tmp[1], ((u4Tmp[0]&0x01800000)>>23), u1Tmp[2]&0x1);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550);\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \\r
+               u4Tmp[0], u1Tmp[0]);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50);\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \\r
+               u4Tmp[0]&0xff, u1Tmp[0]);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4);\r
+       u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8);\r
+       u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0);\r
+\r
+       u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b);\r
+       u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c);\r
+\r
+       faOfdm = ((u4Tmp[0]&0xffff0000) >> 16) +  ((u4Tmp[1]&0xffff0000) >> 16) + (u4Tmp[1] & 0xffff) +  (u4Tmp[2] & 0xffff) + \\r
+                            ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff) ;\r
+       faCck = (u1Tmp[0] << 8) + u1Tmp[1];\r
+       \r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \\r
+               u4Tmp[0]&0xffff, faOfdm, faCck);\r
+       CL_PRINTF(cliBuf);\r
+\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \\r
+               pCoexSta->nCRCOK_CCK, pCoexSta->nCRCOK_11g, pCoexSta->nCRCOK_11n, pCoexSta->nCRCOK_11nAgg);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \\r
+               pCoexSta->nCRCErr_CCK, pCoexSta->nCRCErr_11g, pCoexSta->nCRCErr_11n, pCoexSta->nCRCErr_11nAgg);\r
+       CL_PRINTF(cliBuf);      \r
+\r
+       u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0);\r
+       u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4);\r
+       u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \\r
+               u4Tmp[0], u4Tmp[1], u4Tmp[2]);\r
+       CL_PRINTF(cliBuf);\r
+\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \\r
+               pCoexSta->highPriorityRx, pCoexSta->highPriorityTx);\r
+       CL_PRINTF(cliBuf);\r
+       CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \\r
+               pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx);\r
+       CL_PRINTF(cliBuf);\r
+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 1)\r
+       //halbtc8723b1ant_MonitorBtCtr(pBtCoexist);\r
+#endif\r
+       pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS);\r
+}\r
+\r
+\r
+VOID\r
+EXhalbtc8723b1ant_IpsNotify(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  type\r
+       )\r
+{\r
+       u4Byte  u4Tmp=0;\r
+\r
+       if(pBtCoexist->bManualControl ||        pBtCoexist->bStopCoexDm)\r
+               return;\r
+\r
+       if(BTC_IPS_ENTER == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n"));\r
+               pCoexSta->bUnderIps = TRUE;\r
+               \r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);\r
+               //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF);\r
+       }\r
+       else if(BTC_IPS_LEAVE == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n"));\r
+\r
+               halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE);\r
+               halbtc8723b1ant_InitCoexDm(pBtCoexist);\r
+               halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+\r
+               pCoexSta->bUnderIps = FALSE;\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_LpsNotify(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  type\r
+       )\r
+{\r
+       if(pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm)\r
+               return;\r
+\r
+       if(BTC_LPS_ENABLE == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n"));\r
+               pCoexSta->bUnderLps = TRUE;\r
+       }\r
+       else if(BTC_LPS_DISABLE == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n"));\r
+               pCoexSta->bUnderLps = FALSE;\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_ScanNotify(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  type\r
+       )\r
+{\r
+       BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE;    \r
+       u4Byte  wifiLinkStatus=0;\r
+       u4Byte  numOfWifiLink=0;\r
+       BOOLEAN bBtCtrlAggBufSize=FALSE;\r
+       u1Byte  aggBufSize=5;\r
+\r
+       u1Byte u1Tmpa, u1Tmpb;\r
+       u4Byte u4Tmp;\r
+\r
+       if(pBtCoexist->bManualControl ||\r
+               pBtCoexist->bStopCoexDm )\r
+               return;\r
+\r
+       if(BTC_SCAN_START == type)\r
+       {\r
+               pCoexSta->bWiFiIsHighPriTask = TRUE;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n"));\r
+               pPsdScan->nAntDet_IsAntDetAvailable = TRUE;\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);  //Force antenna setup for no scan result issue\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+               u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);\r
+               u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);\r
+               u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);\r
+          \r
+          \r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n",\r
+                       u4Tmp,  u1Tmpa, u1Tmpb));\r
+       }\r
+       else\r
+       {\r
+               pCoexSta->bWiFiIsHighPriTask = FALSE;   \r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n"));\r
+\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum);              \r
+       }\r
+\r
+       if(pBtCoexist->btInfo.bBtDisabled)\r
+               return;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+\r
+       halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+       \r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);\r
+       numOfWifiLink = wifiLinkStatus>>16;\r
+       if(numOfWifiLink >= 2)\r
+       {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize);\r
+               halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);\r
+               return;\r
+       }\r
+       \r
+       if(pCoexSta->bC2hBtInquiryPage)\r
+       {\r
+               halbtc8723b1ant_ActionBtInquiry(pBtCoexist);\r
+               return;\r
+       }\r
+       else if(bBtHsOn)\r
+       {\r
+               halbtc8723b1ant_ActionHs(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       if(BTC_SCAN_START == type)\r
+       {       \r
+               //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n"));\r
+               if(!bWifiConnected)     // non-connected scan\r
+               {\r
+                       halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist);\r
+               }\r
+               else    // wifi is connected\r
+               {\r
+                       halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);\r
+               }\r
+       }\r
+       else if(BTC_SCAN_FINISH == type)\r
+       {\r
+               //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n"));\r
+               if(!bWifiConnected)     // non-connected scan\r
+               {\r
+                       halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);\r
+               }\r
+               else\r
+               {\r
+                       halbtc8723b1ant_ActionWifiConnected(pBtCoexist);\r
+               }\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_ConnectNotify(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      u1Byte                  type\r
+       )\r
+{\r
+       BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE;    \r
+       u4Byte  wifiLinkStatus=0;\r
+       u4Byte  numOfWifiLink=0;\r
+       BOOLEAN bBtCtrlAggBufSize=FALSE;\r
+       u1Byte  aggBufSize=5;\r
+\r
+       if(pBtCoexist->bManualControl ||\r
+               pBtCoexist->bStopCoexDm ||\r
+               pBtCoexist->btInfo.bBtDisabled )\r
+               return;\r
+\r
+       if(BTC_ASSOCIATE_START == type)\r
+       {\r
+               pCoexSta->bWiFiIsHighPriTask = TRUE;\r
+                pPsdScan->nAntDet_IsAntDetAvailable = TRUE;\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);  //Force antenna setup for no scan result issue\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+                RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n"));   \r
+                pCoexDm->nArpCnt = 0;\r
+       }\r
+       else\r
+       {\r
+               pCoexSta->bWiFiIsHighPriTask = FALSE;   \r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n"));   \r
+               //pCoexDm->nArpCnt = 0;\r
+       }\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);\r
+       numOfWifiLink = wifiLinkStatus>>16;\r
+       if(numOfWifiLink >= 2)\r
+       {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize);\r
+               halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+       if(pCoexSta->bC2hBtInquiryPage)\r
+       {\r
+               halbtc8723b1ant_ActionBtInquiry(pBtCoexist);\r
+               return;\r
+       }\r
+       else if(bBtHsOn)\r
+       {\r
+               halbtc8723b1ant_ActionHs(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       if(BTC_ASSOCIATE_START == type)\r
+       {\r
+               //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n"));          \r
+               halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);\r
+       }\r
+       else if(BTC_ASSOCIATE_FINISH == type)\r
+       {\r
+               //RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n"));\r
+               \r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+               if(!bWifiConnected) // non-connected scan\r
+               {\r
+                       halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);\r
+               }\r
+               else\r
+               {\r
+                       halbtc8723b1ant_ActionWifiConnected(pBtCoexist);\r
+               }\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_MediaStatusNotify(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       u1Byte                  H2C_Parameter[3] ={0};\r
+       u4Byte                  wifiBw;\r
+       u1Byte                  wifiCentralChnl;\r
+       BOOLEAN                 bWifiUnderBMode = FALSE;\r
+\r
+       if(pBtCoexist->bManualControl ||\r
+               pBtCoexist->bStopCoexDm ||\r
+               pBtCoexist->btInfo.bBtDisabled )\r
+               return;\r
+\r
+       if(BTC_MEDIA_CONNECT == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n"));\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 8);  //Force antenna setup for no scan result issue\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, FALSE);\r
+               pPsdScan->nAntDet_IsAntDetAvailable = TRUE;\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode);\r
+\r
+               //Set CCK Tx/Rx high Pri except 11b mode\r
+               if (bWifiUnderBMode)\r
+               {\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); //CCK Tx\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); //CCK Rx\r
+               }\r
+               else\r
+               {\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); //CCK Tx\r
+                       pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); //CCK Rx\r
+               }\r
+               \r
+               pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);\r
+               pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);\r
+               pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);\r
+               pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);\r
+       }\r
+       else\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n"));\r
+               pCoexDm->nArpCnt = 0;\r
+\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); //CCK Tx\r
+               pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); //CCK Rx\r
+\r
+               pCoexSta->bCCKEverLock = FALSE;\r
+       }\r
+\r
+       // only 2.4G we need to inform bt the chnl mask\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl);\r
+       if( (BTC_MEDIA_CONNECT == type) &&\r
+               (wifiCentralChnl <= 14) )\r
+       {\r
+               //H2C_Parameter[0] = 0x1;\r
+               H2C_Parameter[0] = 0x0;\r
+               H2C_Parameter[1] = wifiCentralChnl;\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);\r
+               if(BTC_WIFI_BW_HT40 == wifiBw)\r
+                       H2C_Parameter[2] = 0x30;\r
+               else\r
+                       H2C_Parameter[2] = 0x20;\r
+       }\r
+               \r
+       pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0];\r
+       pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1];\r
+       pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2];\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x66=0x%x\n", \r
+               H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]));\r
+\r
+       pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter);\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_SpecialPacketNotify(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u1Byte                          type\r
+       )\r
+{\r
+       BOOLEAN bBtHsOn=FALSE;\r
+       u4Byte  wifiLinkStatus=0;\r
+       u4Byte  numOfWifiLink=0;\r
+       BOOLEAN bBtCtrlAggBufSize=FALSE, bUnder4way=FALSE;\r
+       u1Byte  aggBufSize=5;\r
+       \r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way);\r
+\r
+       if(pBtCoexist->bManualControl ||\r
+               pBtCoexist->bStopCoexDm ||\r
+               pBtCoexist->btInfo.bBtDisabled )\r
+               return;\r
+\r
+       if( BTC_PACKET_DHCP == type || \r
+               BTC_PACKET_EAPOL == type ||\r
+               BTC_PACKET_ARP == type )\r
+       {\r
+               if (BTC_PACKET_ARP == type)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet ARP notify\n"));                \r
+\r
+                       pCoexDm->nArpCnt++;\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt));\r
+                       \r
+                       if((pCoexDm->nArpCnt >= 10) && (!bUnder4way)) // if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) \r
+                       {\r
+                               pCoexSta->bWiFiIsHighPriTask = FALSE;                                   \r
+                       }                       \r
+                       else\r
+                       {\r
+                               pCoexSta->bWiFiIsHighPriTask = TRUE;\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       pCoexSta->bWiFiIsHighPriTask = TRUE;\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet DHCP or EAPOL notify\n"));              \r
+               }\r
+       } \r
+       else\r
+       {\r
+               pCoexSta->bWiFiIsHighPriTask = FALSE;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], special Packet [Type = %d] notify\n", type));\r
+       }\r
+\r
+       pCoexSta->specialPktPeriodCnt = 0;\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);\r
+       numOfWifiLink = wifiLinkStatus>>16;\r
+       if(numOfWifiLink >= 2)\r
+       {\r
+               halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);\r
+               halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, FALSE, bBtCtrlAggBufSize, aggBufSize);\r
+               halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);\r
+       if(pCoexSta->bC2hBtInquiryPage)\r
+       {\r
+               halbtc8723b1ant_ActionBtInquiry(pBtCoexist);\r
+               return;\r
+       }\r
+       else if(bBtHsOn)\r
+       {\r
+               halbtc8723b1ant_ActionHs(pBtCoexist);\r
+               return;\r
+       }\r
+\r
+       if( BTC_PACKET_DHCP == type ||\r
+               BTC_PACKET_EAPOL == type || \r
+               ( (BTC_PACKET_ARP == type ) && (pCoexSta->bWiFiIsHighPriTask) ) )\r
+               {\r
+               halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_BtInfoNotify(\r
+       IN      PBTC_COEXIST            pBtCoexist,\r
+       IN      pu1Byte                 tmpBuf,\r
+       IN      u1Byte                  length\r
+       )\r
+{\r
+       PBTC_BT_LINK_INFO       pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+       u1Byte                          btInfo=0;\r
+       u1Byte                          i, rspSource=0;\r
+       BOOLEAN                         bWifiConnected=FALSE;\r
+       BOOLEAN                         bBtBusy=FALSE;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       \r
+       pCoexSta->bC2hBtInfoReqSent = FALSE;\r
+\r
+       rspSource = tmpBuf[0]&0xf;\r
+       if(rspSource >= BT_INFO_SRC_8723B_1ANT_MAX)\r
+               rspSource = BT_INFO_SRC_8723B_1ANT_WIFI_FW;\r
+       pCoexSta->btInfoC2hCnt[rspSource]++;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length));\r
+       for(i=0; i<length; i++)\r
+       {\r
+               pCoexSta->btInfoC2h[rspSource][i] = tmpBuf[i];\r
+               if(i == 1)\r
+                       btInfo = tmpBuf[i];\r
+               if(i == length-1)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i]));\r
+               }\r
+               else\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i]));\r
+               }\r
+       }\r
+\r
+       // if 0xff, it means BT is under WHCK test\r
+       if (btInfo == 0xff)\r
+               pCoexSta->bBtWhckTest = TRUE;\r
+       else\r
+               pCoexSta->bBtWhckTest = FALSE;\r
+\r
+       if(BT_INFO_SRC_8723B_1ANT_WIFI_FW != rspSource)\r
+       {\r
+               pCoexSta->btRetryCnt =  // [3:0]\r
+                       pCoexSta->btInfoC2h[rspSource][2]&0xf;\r
+\r
+               if (pCoexSta->btRetryCnt >= 1)\r
+                       pCoexSta->popEventCnt++;\r
+\r
+               if (pCoexSta->btInfoC2h[rspSource][2]&0x20)\r
+                       pCoexSta->bC2hBtRemoteNameReq = TRUE;\r
+               else\r
+                       pCoexSta->bC2hBtRemoteNameReq = FALSE;                  \r
+\r
+               pCoexSta->btRssi =\r
+                       pCoexSta->btInfoC2h[rspSource][3]*2-90;\r
+                       //pCoexSta->btInfoC2h[rspSource][3]*2+10;\r
+\r
+               pCoexSta->btInfoExt = \r
+                       pCoexSta->btInfoC2h[rspSource][4];\r
+               \r
+               if (pCoexSta->btInfoC2h[rspSource][1] == 0x49)\r
+               {\r
+                       pCoexSta->nA2DPBitPool = \r
+                               pCoexSta->btInfoC2h[rspSource][6]; \r
+               }\r
+               else\r
+                       pCoexSta->nA2DPBitPool = 0;\r
+\r
+               pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40);\r
+               pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask);\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE\r
+               if ((pBoardInfo->btdmAntDetFinish) && (pBoardInfo->btdmAntNumByAntDet == 2))\r
+               {\r
+                       if(pCoexSta->bBtTxRxMask)\r
+                       {\r
+                               /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */                            \r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n"));\r
+\r
+                               //BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1\r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c45); \r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x30, 0x7c45); \r
+       \r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x1);\r
+                       }       \r
+               }\r
+               else    \r
+#endif                 \r
+#endif\r
+\r
+               {\r
+                       if(!pCoexSta->bBtTxRxMask)\r
+                       {\r
+                               /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */                            \r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"));\r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15);\r
+\r
+                               //BT TRx Mask lock 0x2c[0], 0x30[0] = 0\r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x2c, 0x7c44); \r
+                               pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 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(pCoexSta->btInfoExt & BIT1)\r
+               {                       \r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"));\r
+                       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);\r
+                       if(bWifiConnected)\r
+                       {\r
+                               EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT);\r
+                       }\r
+                       else\r
+                       {\r
+                               EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);\r
+                       }\r
+               }\r
+                               \r
+               if(pCoexSta->btInfoExt & BIT3)\r
+               {\r
+                       if(!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"));\r
+                               halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE);\r
+                       }\r
+               }\r
+               else\r
+               {\r
+                       // BT already NOT ignore Wlan active, do nothing here.\r
+               }\r
+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0)\r
+               if( (pCoexSta->btInfoExt & BIT4) )\r
+               {\r
+                       // BT auto report already enabled, do nothing\r
+               }\r
+               else\r
+               {\r
+                       halbtc8723b1ant_BtAutoReport(pBtCoexist, FORCE_EXEC, TRUE);\r
+               }\r
+#endif\r
+       }\r
+               \r
+       // check BIT2 first ==> check if bt is under inquiry or page scan\r
+       if(btInfo & BT_INFO_8723B_1ANT_B_INQ_PAGE)\r
+               pCoexSta->bC2hBtInquiryPage = TRUE;\r
+       else\r
+               pCoexSta->bC2hBtInquiryPage = FALSE;\r
+\r
+       pCoexSta->nNumOfProfile = 0;\r
+\r
+       // set link exist status\r
+       if(!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION))\r
+       {\r
+               pCoexSta->bBtLinkExist = FALSE;\r
+               pCoexSta->bPanExist = FALSE;\r
+               pCoexSta->bA2dpExist = FALSE;\r
+               pCoexSta->bHidExist = FALSE;\r
+               pCoexSta->bScoExist = FALSE;\r
+\r
+               pCoexSta->bBtHiPriLinkExist = FALSE;\r
+       }\r
+       else    // connection exists\r
+       {\r
+               pCoexSta->bBtLinkExist = TRUE;\r
+               if(btInfo & BT_INFO_8723B_1ANT_B_FTP)\r
+               {\r
+                       pCoexSta->bPanExist = TRUE;\r
+                       pCoexSta->nNumOfProfile++;\r
+               }\r
+               else\r
+                       pCoexSta->bPanExist = FALSE;\r
+               if(btInfo & BT_INFO_8723B_1ANT_B_A2DP)\r
+               {\r
+                       pCoexSta->bA2dpExist = TRUE;\r
+                       pCoexSta->nNumOfProfile++;\r
+               }\r
+               else\r
+                       pCoexSta->bA2dpExist = FALSE;\r
+               if(btInfo & BT_INFO_8723B_1ANT_B_HID)\r
+               {\r
+                       pCoexSta->bHidExist = TRUE;\r
+                       pCoexSta->nNumOfProfile++;\r
+               }\r
+               else\r
+                       pCoexSta->bHidExist = FALSE;\r
+               if(btInfo & BT_INFO_8723B_1ANT_B_SCO_ESCO)\r
+               {\r
+                       pCoexSta->bScoExist = TRUE;\r
+                       pCoexSta->nNumOfProfile++;\r
+               }\r
+               else\r
+                       pCoexSta->bScoExist = FALSE;\r
+\r
+               if ((pCoexSta->bHidExist == FALSE) && (pCoexSta->bC2hBtInquiryPage == FALSE) &&( pCoexSta->bScoExist == FALSE))\r
+               {\r
+                       if (pCoexSta->highPriorityTx  + pCoexSta->highPriorityRx >= 160)                \r
+                       {\r
+                               pCoexSta->bHidExist = TRUE;\r
+                               pCoexSta->wrongProfileNotification++;\r
+                               pCoexSta->nNumOfProfile++;\r
+                               btInfo = btInfo | 0x28;\r
+                       }\r
+               }\r
+\r
+               //Add Hi-Pri Tx/Rx counter to avoid false detection\r
+               if (((pCoexSta->bHidExist) || (pCoexSta->bScoExist)) && (pCoexSta->highPriorityTx + pCoexSta->highPriorityRx >= 160)\r
+                        && (!pCoexSta->bC2hBtInquiryPage))\r
+                       pCoexSta->bBtHiPriLinkExist = TRUE;\r
+                       \r
+               if((btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) && (pCoexSta->nNumOfProfile == 0))\r
+               {\r
+                       if (pCoexSta->lowPriorityTx + pCoexSta->lowPriorityRx >= 160)\r
+                       {\r
+                               pCoexSta->bPanExist = TRUE;\r
+                               pCoexSta->nNumOfProfile++;\r
+                               pCoexSta->wrongProfileNotification++;\r
+                               btInfo = btInfo | 0x88;\r
+                       }\r
+               }\r
+       }\r
+\r
+       halbtc8723b1ant_UpdateBtLinkInfo(pBtCoexist);\r
+       \r
+       btInfo = btInfo & 0x1f;  //mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41)\r
+       \r
+       if(!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION))\r
+       {\r
+               pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"));\r
+       }\r
+       else if(btInfo == BT_INFO_8723B_1ANT_B_CONNECTION)      // connection exists but no busy\r
+       {\r
+               pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"));\r
+       }\r
+       else if((btInfo&BT_INFO_8723B_1ANT_B_SCO_ESCO) ||\r
+               (btInfo&BT_INFO_8723B_1ANT_B_SCO_BUSY))\r
+       {\r
+               pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_SCO_BUSY;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"));\r
+       }\r
+       else if(btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY)\r
+       {\r
+               if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus)\r
+                       pCoexDm->bAutoTdmaAdjust = FALSE;\r
+               pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_ACL_BUSY;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"));\r
+       }\r
+       else\r
+       {\r
+               pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_MAX;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"));\r
+       }\r
+\r
+       if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||\r
+               (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||\r
+               (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus) )\r
+               bBtBusy = TRUE;\r
+       else\r
+               bBtBusy = FALSE;\r
+       pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);\r
+\r
+       halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_RfStatusNotify(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u1Byte                                  type\r
+       )\r
+{\r
+       u4Byte  u4Tmp;\r
+       u1Byte  u1Tmpa,u1Tmpb, u1Tmpc;\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF Status notify\n"));\r
+\r
+       if(BTC_RF_ON == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned ON!!\n"));\r
+               pBtCoexist->bStopCoexDm = FALSE;\r
+       }\r
+       else if(BTC_RF_OFF == type)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], RF is turned OFF!!\n"));\r
+               \r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE);\r
+               //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF);\r
+               \r
+               halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE);\r
+               pBtCoexist->bStopCoexDm = TRUE;\r
+\r
+               u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);\r
+               u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);\r
+               u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);\r
+               u1Tmpc = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e);\r
+\r
+\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n",\r
+                       u4Tmp,  u1Tmpa, u1Tmpb, u1Tmpc));\r
+\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_HaltNotify(\r
+       IN      PBTC_COEXIST                    pBtCoexist\r
+       )\r
+{\r
+       u4Byte  u4Tmp;\r
+       \r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n"));\r
+\r
+       halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+       halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0);\r
+       halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE);\r
+       //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF);\r
+\r
+       halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE);\r
+\r
+       EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);\r
+\r
+       pBtCoexist->bStopCoexDm = TRUE; \r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_PnpNotify(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u1Byte                          pnpState\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify\n"));\r
+\r
+       if(BTC_WIFI_PNP_SLEEP == pnpState)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to SLEEP\n"));\r
+\r
+               halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);\r
+               halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0);\r
+               halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, TRUE);\r
+               halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);\r
+               //halbtc8723b1ant_SetAntPathDCut(pBtCoexist, FALSE, FALSE, FALSE, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF);\r
+\r
+               pBtCoexist->bStopCoexDm = TRUE;\r
+       }\r
+       else if(BTC_WIFI_PNP_WAKE_UP == pnpState)\r
+       {\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Pnp notify to WAKE UP\n"));\r
+               pBtCoexist->bStopCoexDm = FALSE;\r
+               halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE);\r
+               halbtc8723b1ant_InitCoexDm(pBtCoexist);\r
+               halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+       }\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_CoexDmReset(\r
+       IN      PBTC_COEXIST                    pBtCoexist\r
+       )\r
+{\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], *****************Coex DM Reset*****************\n"));\r
+\r
+       halbtc8723b1ant_InitHwConfig(pBtCoexist, FALSE, FALSE);\r
+       //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x0);\r
+       //pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x2, 0xfffff, 0x0);\r
+       halbtc8723b1ant_InitCoexDm(pBtCoexist);\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_Periodical(\r
+       IN      PBTC_COEXIST                    pBtCoexist\r
+       )\r
+{\r
+       static u1Byte           disVerInfoCnt=0;\r
+       u4Byte                          fwVer=0, btPatchVer=0;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+       PBTC_STACK_INFO         pStackInfo=&pBtCoexist->stackInfo;\r
+       PBTC_BT_LINK_INFO       pBtLinkInfo=&pBtCoexist->btLinkInfo;\r
+\r
+       RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ==========================Periodical===========================\n"));\r
+\r
+       if(disVerInfoCnt <= 5)\r
+       {\r
+               disVerInfoCnt += 1;\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n"));\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", \r
+                       pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum, pBoardInfo->btdmAntPos));\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT stack/ hci ext ver = %s / %d\n", \r
+                       ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion));\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);\r
+               pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n",\r
+                       GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer));\r
+               RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ****************************************************************\n"));\r
+       }\r
+\r
+#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0)\r
+       halbtc8723b1ant_QueryBtInfo(pBtCoexist);\r
+       halbtc8723b1ant_MonitorBtEnableDisable(pBtCoexist);\r
+#else\r
+       halbtc8723b1ant_MonitorBtCtr(pBtCoexist);\r
+       halbtc8723b1ant_MonitorWiFiCtr(pBtCoexist);\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+       halbtc8723b1ant_MonitorBtEnableDisable(pBtCoexist);\r
+#endif\r
+\r
+       if ( (pCoexSta->highPriorityTx  + pCoexSta->highPriorityRx < 50) && (pBtLinkInfo->bHidExist == TRUE))\r
+       {\r
+               pBtLinkInfo->bHidExist  = FALSE;\r
+       }\r
+\r
+       if( halbtc8723b1ant_IsWifiStatusChanged(pBtCoexist) ||\r
+               pCoexDm->bAutoTdmaAdjust )\r
+       {\r
+               halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);        \r
+       }\r
+\r
+       pCoexSta->specialPktPeriodCnt++;\r
+\r
+       // sample to set bt to execute Ant detection\r
+       //pBtCoexist->fBtcSetBtAntDetection(pBtCoexist, 20, 14);\r
+/*\r
+       if (pPsdScan->bIsAntDetEnable)\r
+       {\r
+                if (pPsdScan->nPSDGenCount > pPsdScan->realseconds)\r
+                       pPsdScan->nPSDGenCount = 0;\r
+                \r
+               halbtc8723b1ant_AntennaDetection(pBtCoexist, pPsdScan->realcentFreq,  pPsdScan->realoffset, pPsdScan->realspan,  pPsdScan->realseconds);        \r
+               pPsdScan->nPSDGenTotalCount +=2;\r
+               pPsdScan->nPSDGenCount += 2;\r
+       }\r
+*/             \r
+#endif\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_AntennaDetection(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u4Byte                                  centFreq,\r
+       IN      u4Byte                                  offset,\r
+       IN      u4Byte                                  span,\r
+       IN      u4Byte                                  seconds\r
+       )\r
+{\r
+       static u4Byte AntDetCount = 0, AntDetFailCount = 0;\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;      \r
+       BOOLEAN bScan, bRoam;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE        \r
+\r
+       if (seconds == 0)\r
+       {\r
+               pPsdScan->bAntDet_TryCount      = 0;\r
+               pPsdScan->bAntDet_FailCount     = 0;\r
+               AntDetCount = 0;\r
+               AntDetFailCount = 0;\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pBoardInfo->btdmAntNumByAntDet = 1;\r
+               return;\r
+       }\r
+\r
+       if (!pBoardInfo->btdmAntDetFinish)\r
+       {\r
+               pPsdScan->nAntDet_IntevalCount = pPsdScan->nAntDet_IntevalCount+2;\r
+\r
+               if (pPsdScan->nAntDet_IntevalCount >= BT_8723B_1ANT_ANTDET_RETRY_INTERVAL)\r
+               {\r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"));\r
+                       halbtc8723b1ant_PSD_AntennaDetectionCheck(pBtCoexist);  \r
+                       \r
+                       if (pBoardInfo->btdmAntDetFinish)\r
+                       {\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"));\r
+#if 1\r
+                               if (pBoardInfo->btdmAntNumByAntDet == 2)\r
+                                       halbtc8723b1ant_MechanismSwitch(pBtCoexist, TRUE);\r
+                               else\r
+                                       halbtc8723b1ant_MechanismSwitch(pBtCoexist, FALSE);     \r
+#endif\r
+                       }\r
+                       else\r
+                               RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"));\r
+                               \r
+                       pPsdScan->nAntDet_IntevalCount = 0;\r
+               }\r
+       else\r
+       {       \r
+                       RT_TRACE(COMP_COEX, DBG_LOUD, ("xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", pPsdScan->nAntDet_IntevalCount));\r
+               }\r
+                       \r
+       }\r
+#endif\r
+               \r
+               \r
+/*\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);\r
+       pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);  \r
+\r
+\r
+       pPsdScan->nAntDet_BTTxTime = seconds;  //0.42ms*50 = 20ms\r
+       pPsdScan->nAntDet_BTLEChannel = centFreq;               \r
+               \r
+       if (seconds == 0)\r
+               {\r
+               pPsdScan->bAntDet_TryCount      = 0;\r
+               pPsdScan->bAntDet_FailCount     = 0;\r
+               AntDetCount = 0;\r
+               AntDetFailCount = 0;\r
+               pBoardInfo->btdmAntDetFinish = FALSE;\r
+               pBoardInfo->btdmAntNumByAntDet = 1;\r
+                        return;\r
+       }\r
+       else\r
+       {\r
+               AntDetCount++;\r
+       \r
+               pPsdScan->bAntDet_TryCount = AntDetCount;       \r
+                               \r
+               if (bScan ||bRoam)\r
+               {\r
+                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                       pPsdScan->nAntDet_Result = 6;\r
+               }\r
+               else if (pCoexSta->nNumOfProfile >= 1) \r
+               {\r
+                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                       pPsdScan->nAntDet_Result = 7;\r
+               }                       \r
+               else if (!pPsdScan->nAntDet_IsAntDetAvailable)  //Antenna initial setup is not ready\r
+               {\r
+                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                       pPsdScan->nAntDet_Result = 9;\r
+               }                               \r
+               else if (pCoexSta->bC2hBtInquiryPage)\r
+               {\r
+                       pBoardInfo->btdmAntDetFinish = FALSE;\r
+                       pPsdScan->nAntDet_Result = 10;\r
+               }       \r
+               else\r
+               {\r
+                       //halbtc8723b1ant_PSD_AntennaDetection(pBtCoexist,  pPsdScan->nAntDet_BTTxTime, pPsdScan->nAntDet_BTLEChannel);                 \r
+       }\r
+\r
+               if (!pBoardInfo->btdmAntDetFinish)\r
+                       AntDetFailCount++;\r
+\r
+               pPsdScan->bAntDet_FailCount = AntDetFailCount;\r
+       }\r
+*/\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_AntennaIsolation(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u4Byte                                  centFreq,\r
+       IN      u4Byte                                  offset,\r
+       IN      u4Byte                                  span,\r
+       IN      u4Byte                                  seconds\r
+       )\r
+{\r
+\r
+\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_PSDScan(\r
+       IN      PBTC_COEXIST                    pBtCoexist,\r
+       IN      u4Byte                                  centFreq,\r
+       IN      u4Byte                                  offset,\r
+       IN      u4Byte                                  span,\r
+       IN      u4Byte                                  seconds\r
+       )\r
+{\r
+\r
+\r
+}\r
+\r
+VOID\r
+EXhalbtc8723b1ant_DisplayAntDetection(\r
+       IN      PBTC_COEXIST                    pBtCoexist\r
+       )\r
+{\r
+       PBTC_BOARD_INFO         pBoardInfo=&pBtCoexist->boardInfo;\r
+\r
+#if BT_8723B_1ANT_ANTDET_ENABLE\r
+       if (pPsdScan->bAntDet_TryCount != 0)\r
+       {\r
+               halbtc8723b1ant_PSD_ShowAntennaDetectResult(pBtCoexist);\r
+\r
+               if (pBoardInfo->btdmAntDetFinish)\r
+                       halbtc8723b1ant_PSD_ShowData(pBtCoexist);\r
+               return;\r
+       }\r
+#endif\r
+       \r
+       //halbtc8723b1ant_ShowPSDData(pBtCoexist);\r
+}\r
+\r
+\r
+#endif\r
+\r