drivers/staging/rtl8723bs/hal/HalBtc8723b1Ant.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /******************************************************************************
   3  *
   4  * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
   5  *
   6  ******************************************************************************/
   7
   8 #include "Mp_Precomp.h"
   9
  10 /*  Global variables, these are static variables */
  11 static COEX_DM_8723B_1ANT GLCoexDm8723b1Ant;
  12 static PCOEX_DM_8723B_1ANT pCoexDm = &GLCoexDm8723b1Ant;
  13 static COEX_STA_8723B_1ANT GLCoexSta8723b1Ant;
  14 static PCOEX_STA_8723B_1ANT     pCoexSta = &GLCoexSta8723b1Ant;
  15
  16 static const char *const GLBtInfoSrc8723b1Ant[] = {
  17         "BT Info[wifi fw]",
  18         "BT Info[bt rsp]",
  19         "BT Info[bt auto report]",
  20 };
  21
  22 static u32 GLCoexVerDate8723b1Ant = 20140507;
  23 static u32 GLCoexVer8723b1Ant = 0x4e;
  24
  25 /*  local function proto type if needed */
  26 /*  local function start with halbtc8723b1ant_ */
  27 static u8 halbtc8723b1ant_BtRssiState(
  28         u8 levelNum, u8 rssiThresh, u8 rssiThresh1
  29 )
  30 {
  31         s32 btRssi = 0;
  32         u8 btRssiState = pCoexSta->preBtRssiState;
  33
  34         btRssi = pCoexSta->btRssi;
  35
  36         if (levelNum == 2) {
  37                 if (
  38                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||
  39                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)
  40                 ) {
  41                         if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
  42
  43                                 btRssiState = BTC_RSSI_STATE_HIGH;
  44                                 BTC_PRINT(
  45                                         BTC_MSG_ALGORITHM,
  46                                         ALGO_BT_RSSI_STATE,
  47                                         ("[BTCoex], BT Rssi state switch to High\n")
  48                                 );
  49                         } else {
  50                                 btRssiState = BTC_RSSI_STATE_STAY_LOW;
  51                                 BTC_PRINT(
  52                                         BTC_MSG_ALGORITHM,
  53                                         ALGO_BT_RSSI_STATE,
  54                                         ("[BTCoex], BT Rssi state stay at Low\n")
  55                                 );
  56                         }
  57                 } else {
  58                         if (btRssi < rssiThresh) {
  59                                 btRssiState = BTC_RSSI_STATE_LOW;
  60                                 BTC_PRINT(
  61                                         BTC_MSG_ALGORITHM,
  62                                         ALGO_BT_RSSI_STATE,
  63                                         ("[BTCoex], BT Rssi state switch to Low\n")
  64                                 );
  65                         } else {
  66                                 btRssiState = BTC_RSSI_STATE_STAY_HIGH;
  67                                 BTC_PRINT(
  68                                         BTC_MSG_ALGORITHM,
  69                                         ALGO_BT_RSSI_STATE,
  70                                         ("[BTCoex], BT Rssi state stay at High\n")
  71                                 );
  72                         }
  73                 }
  74         } else if (levelNum == 3) {
  75                 if (rssiThresh > rssiThresh1) {
  76                         BTC_PRINT(
  77                                 BTC_MSG_ALGORITHM,
  78                                 ALGO_BT_RSSI_STATE,
  79                                 ("[BTCoex], BT Rssi thresh error!!\n")
  80                         );
  81                         return pCoexSta->preBtRssiState;
  82                 }
  83
  84                 if (
  85                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||
  86                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)
  87                 ) {
  88                         if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
  89                                 btRssiState = BTC_RSSI_STATE_MEDIUM;
  90                                 BTC_PRINT(
  91                                         BTC_MSG_ALGORITHM,
  92                                         ALGO_BT_RSSI_STATE,
  93                                         ("[BTCoex], BT Rssi state switch to Medium\n")
  94                                 );
  95                         } else {
  96                                 btRssiState = BTC_RSSI_STATE_STAY_LOW;
  97                                 BTC_PRINT(
  98                                         BTC_MSG_ALGORITHM,
  99                                         ALGO_BT_RSSI_STATE,
 100                                         ("[BTCoex], BT Rssi state stay at Low\n")
 101                                 );
 102                         }
 103                 } else if (
 104                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) ||
 105                         (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)
 106                 ) {
 107                         if (btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
 108                                 btRssiState = BTC_RSSI_STATE_HIGH;
 109                                 BTC_PRINT(
 110                                         BTC_MSG_ALGORITHM,
 111                                         ALGO_BT_RSSI_STATE,
 112                                         ("[BTCoex], BT Rssi state switch to High\n")
 113                                 );
 114                         } else if (btRssi < rssiThresh) {
 115                                 btRssiState = BTC_RSSI_STATE_LOW;
 116                                 BTC_PRINT(
 117                                         BTC_MSG_ALGORITHM,
 118                                         ALGO_BT_RSSI_STATE,
 119                                         ("[BTCoex], BT Rssi state switch to Low\n")
 120                                 );
 121                         } else {
 122                                 btRssiState = BTC_RSSI_STATE_STAY_MEDIUM;
 123                                 BTC_PRINT(
 124                                         BTC_MSG_ALGORITHM,
 125                                         ALGO_BT_RSSI_STATE,
 126                                         ("[BTCoex], BT Rssi state stay at Medium\n")
 127                                 );
 128                         }
 129                 } else {
 130                         if (btRssi < rssiThresh1) {
 131                                 btRssiState = BTC_RSSI_STATE_MEDIUM;
 132                                 BTC_PRINT(
 133                                         BTC_MSG_ALGORITHM,
 134                                         ALGO_BT_RSSI_STATE,
 135                                         ("[BTCoex], BT Rssi state switch to Medium\n")
 136                                 );
 137                         } else {
 138                                 btRssiState = BTC_RSSI_STATE_STAY_HIGH;
 139                                 BTC_PRINT(
 140                                         BTC_MSG_ALGORITHM,
 141                                         ALGO_BT_RSSI_STATE,
 142                                         ("[BTCoex], BT Rssi state stay at High\n")
 143                                 );
 144                         }
 145                 }
 146         }
 147
 148         pCoexSta->preBtRssiState = btRssiState;
 149
 150         return btRssiState;
 151 }
 152
 153 static void halbtc8723b1ant_UpdateRaMask(
 154         PBTC_COEXIST pBtCoexist, bool bForceExec, u32 disRateMask
 155 )
 156 {
 157         pCoexDm->curRaMask = disRateMask;
 158
 159         if (bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask))
 160                 pBtCoexist->fBtcSet(
 161                         pBtCoexist,
 162                         BTC_SET_ACT_UPDATE_RAMASK,
 163                         &pCoexDm->curRaMask
 164                 );
 165         pCoexDm->preRaMask = pCoexDm->curRaMask;
 166 }
 167
 168 static void halbtc8723b1ant_AutoRateFallbackRetry(
 169         PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 170 )
 171 {
 172         bool bWifiUnderBMode = false;
 173
 174         pCoexDm->curArfrType = type;
 175
 176         if (bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) {
 177                 switch (pCoexDm->curArfrType) {
 178                 case 0: /*  normal mode */
 179                         pBtCoexist->fBtcWrite4Byte(
 180                                 pBtCoexist, 0x430, pCoexDm->backupArfrCnt1
 181                         );
 182                         pBtCoexist->fBtcWrite4Byte(
 183                                 pBtCoexist, 0x434, pCoexDm->backupArfrCnt2
 184                         );
 185                         break;
 186                 case 1:
 187                         pBtCoexist->fBtcGet(
 188                                 pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
 189                         );
 190                         if (bWifiUnderBMode) {
 191                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);
 192                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101);
 193                         } else {
 194                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);
 195                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201);
 196                         }
 197                         break;
 198                 default:
 199                         break;
 200                 }
 201         }
 202
 203         pCoexDm->preArfrType = pCoexDm->curArfrType;
 204 }
 205
 206 static void halbtc8723b1ant_RetryLimit(
 207         PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 208 )
 209 {
 210         pCoexDm->curRetryLimitType = type;
 211
 212         if (
 213                 bForceExec ||
 214                 (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)
 215         ) {
 216                 switch (pCoexDm->curRetryLimitType) {
 217                 case 0: /*  normal mode */
 218                         pBtCoexist->fBtcWrite2Byte(
 219                                 pBtCoexist, 0x42a, pCoexDm->backupRetryLimit
 220                         );
 221                         break;
 222                 case 1: /*  retry limit =8 */
 223                         pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808);
 224                         break;
 225                 default:
 226                         break;
 227                 }
 228         }
 229
 230         pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType;
 231 }
 232
 233 static void halbtc8723b1ant_AmpduMaxTime(
 234         PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 235 )
 236 {
 237         pCoexDm->curAmpduTimeType = type;
 238
 239         if (
 240                 bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)
 241         ) {
 242                 switch (pCoexDm->curAmpduTimeType) {
 243                 case 0: /*  normal mode */
 244                         pBtCoexist->fBtcWrite1Byte(
 245                                 pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime
 246                         );
 247                         break;
 248                 case 1: /*  AMPDU timw = 0x38 * 32us */
 249                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38);
 250                         break;
 251                 default:
 252                         break;
 253                 }
 254         }
 255
 256         pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType;
 257 }
 258
 259 static void halbtc8723b1ant_LimitedTx(
 260         PBTC_COEXIST pBtCoexist,
 261         bool bForceExec,
 262         u8 raMaskType,
 263         u8 arfrType,
 264         u8 retryLimitType,
 265         u8 ampduTimeType
 266 )
 267 {
 268         switch (raMaskType) {
 269         case 0: /*  normal mode */
 270                 halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0);
 271                 break;
 272         case 1: /*  disable cck 1/2 */
 273                 halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003);
 274                 break;
 275         case 2: /*  disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */
 276                 halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7);
 277                 break;
 278         default:
 279                 break;
 280         }
 281
 282         halbtc8723b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType);
 283         halbtc8723b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType);
 284         halbtc8723b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType);
 285 }
 286
 287 static void halbtc8723b1ant_LimitedRx(
 288         PBTC_COEXIST pBtCoexist,
 289         bool bForceExec,
 290         bool bRejApAggPkt,
 291         bool bBtCtrlAggBufSize,
 292         u8 aggBufSize
 293 )
 294 {
 295         bool bRejectRxAgg = bRejApAggPkt;
 296         bool bBtCtrlRxAggSize = bBtCtrlAggBufSize;
 297         u8 rxAggSize = aggBufSize;
 298
 299         /*  */
 300         /*      Rx Aggregation related setting */
 301         /*  */
 302         pBtCoexist->fBtcSet(
 303                 pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg
 304         );
 305         /*  decide BT control aggregation buf size or not */
 306         pBtCoexist->fBtcSet(
 307                 pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize
 308         );
 309         /*  aggregation buf size, only work when BT control Rx aggregation size. */
 310         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize);
 311         /*  real update aggregation setting */
 312         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);
 313
 314
 315 }
 316
 317 static void halbtc8723b1ant_QueryBtInfo(PBTC_COEXIST pBtCoexist)
 318 {
 319         u8      H2C_Parameter[1] = {0};
 320
 321         pCoexSta->bC2hBtInfoReqSent = true;
 322
 323         H2C_Parameter[0] |= BIT0;       /*  trigger */
 324
 325         BTC_PRINT(
 326                 BTC_MSG_ALGORITHM,
 327                 ALGO_TRACE_FW_EXEC,
 328                 ("[BTCoex], Query Bt Info, FW write 0x61 = 0x%x\n", H2C_Parameter[0])
 329         );
 330
 331         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter);
 332 }
 333
 334 static void halbtc8723b1ant_MonitorBtCtr(PBTC_COEXIST pBtCoexist)
 335 {
 336         u32 regHPTxRx, regLPTxRx, u4Tmp;
 337         u32 regHPTx = 0, regHPRx = 0, regLPTx = 0, regLPRx = 0;
 338         static u8 NumOfBtCounterChk;
 339
 340        /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */
 341         /* if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8)) */
 342
 343         if (pCoexSta->bUnderIps) {
 344                 pCoexSta->highPriorityTx = 65535;
 345                 pCoexSta->highPriorityRx = 65535;
 346                 pCoexSta->lowPriorityTx = 65535;
 347                 pCoexSta->lowPriorityRx = 65535;
 348                 return;
 349         }
 350
 351         regHPTxRx = 0x770;
 352         regLPTxRx = 0x774;
 353
 354         u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx);
 355         regHPTx = u4Tmp & bMaskLWord;
 356         regHPRx = (u4Tmp & bMaskHWord)>>16;
 357
 358         u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx);
 359         regLPTx = u4Tmp & bMaskLWord;
 360         regLPRx = (u4Tmp & bMaskHWord)>>16;
 361
 362         pCoexSta->highPriorityTx = regHPTx;
 363         pCoexSta->highPriorityRx = regHPRx;
 364         pCoexSta->lowPriorityTx = regLPTx;
 365         pCoexSta->lowPriorityRx = regLPRx;
 366
 367         if ((pCoexSta->lowPriorityTx >= 1050) && (!pCoexSta->bC2hBtInquiryPage))
 368                 pCoexSta->popEventCnt++;
 369
 370         BTC_PRINT(
 371                 BTC_MSG_ALGORITHM,
 372                 ALGO_TRACE,
 373                 (
 374                         "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n",
 375                         regHPRx,
 376                         regHPTx,
 377                         regLPRx,
 378                         regLPTx
 379                 )
 380         );
 381
 382         /*  reset counter */
 383         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc);
 384
 385         if ((regHPTx == 0) && (regHPRx == 0) && (regLPTx == 0) && (regLPRx == 0)) {
 386                 NumOfBtCounterChk++;
 387                 if (NumOfBtCounterChk >= 3) {
 388                         halbtc8723b1ant_QueryBtInfo(pBtCoexist);
 389                         NumOfBtCounterChk = 0;
 390                 }
 391         }
 392 }
 393
 394
 395 static void halbtc8723b1ant_MonitorWiFiCtr(PBTC_COEXIST pBtCoexist)
 396 {
 397         s32     wifiRssi = 0;
 398         bool bWifiBusy = false, bWifiUnderBMode = false;
 399         static u8 nCCKLockCounter;
 400
 401         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
 402         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);
 403         pBtCoexist->fBtcGet(
 404                 pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
 405         );
 406
 407         if (pCoexSta->bUnderIps) {
 408                 pCoexSta->nCRCOK_CCK = 0;
 409                 pCoexSta->nCRCOK_11g = 0;
 410                 pCoexSta->nCRCOK_11n = 0;
 411                 pCoexSta->nCRCOK_11nAgg = 0;
 412
 413                 pCoexSta->nCRCErr_CCK = 0;
 414                 pCoexSta->nCRCErr_11g = 0;
 415                 pCoexSta->nCRCErr_11n = 0;
 416                 pCoexSta->nCRCErr_11nAgg = 0;
 417         } else {
 418                 pCoexSta->nCRCOK_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88);
 419                 pCoexSta->nCRCOK_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94);
 420                 pCoexSta->nCRCOK_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90);
 421                 pCoexSta->nCRCOK_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8);
 422
 423                 pCoexSta->nCRCErr_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84);
 424                 pCoexSta->nCRCErr_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96);
 425                 pCoexSta->nCRCErr_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92);
 426                 pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba);
 427         }
 428
 429
 430         /* reset counter */
 431         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1);
 432         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0);
 433
 434         if (bWifiBusy && (wifiRssi >= 30) && !bWifiUnderBMode) {
 435                 if (
 436                         (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) ||
 437                         (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) ||
 438                         (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_SCO_BUSY)
 439                 ) {
 440                         if (
 441                                 pCoexSta->nCRCOK_CCK > (
 442                                         pCoexSta->nCRCOK_11g +
 443                                         pCoexSta->nCRCOK_11n +
 444                                         pCoexSta->nCRCOK_11nAgg
 445                                 )
 446                         ) {
 447                                 if (nCCKLockCounter < 5)
 448                                  nCCKLockCounter++;
 449                         } else {
 450                                 if (nCCKLockCounter > 0)
 451                                  nCCKLockCounter--;
 452                         }
 453
 454                 } else {
 455                         if (nCCKLockCounter > 0)
 456                           nCCKLockCounter--;
 457                 }
 458         } else {
 459                 if (nCCKLockCounter > 0)
 460                         nCCKLockCounter--;
 461         }
 462
 463         if (!pCoexSta->bPreCCKLock) {
 464
 465                 if (nCCKLockCounter >= 5)
 466                  pCoexSta->bCCKLock = true;
 467                 else
 468                  pCoexSta->bCCKLock = false;
 469         } else {
 470                 if (nCCKLockCounter == 0)
 471                  pCoexSta->bCCKLock = false;
 472                 else
 473                  pCoexSta->bCCKLock = true;
 474         }
 475
 476         pCoexSta->bPreCCKLock =  pCoexSta->bCCKLock;
 477
 478
 479 }
 480
 481 static bool halbtc8723b1ant_IsWifiStatusChanged(PBTC_COEXIST pBtCoexist)
 482 {
 483         static bool     bPreWifiBusy, bPreUnder4way, bPreBtHsOn;
 484         bool bWifiBusy = false, bUnder4way = false, bBtHsOn = false;
 485         bool bWifiConnected = false;
 486
 487         pBtCoexist->fBtcGet(
 488                 pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected
 489         );
 490         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
 491         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 492         pBtCoexist->fBtcGet(
 493                 pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way
 494         );
 495
 496         if (bWifiConnected) {
 497                 if (bWifiBusy != bPreWifiBusy) {
 498                         bPreWifiBusy = bWifiBusy;
 499                         return true;
 500                 }
 501
 502                 if (bUnder4way != bPreUnder4way) {
 503                         bPreUnder4way = bUnder4way;
 504                         return true;
 505                 }
 506
 507                 if (bBtHsOn != bPreBtHsOn) {
 508                         bPreBtHsOn = bBtHsOn;
 509                         return true;
 510                 }
 511         }
 512
 513         return false;
 514 }
 515
 516 static void halbtc8723b1ant_UpdateBtLinkInfo(PBTC_COEXIST pBtCoexist)
 517 {
 518         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
 519         bool bBtHsOn = false;
 520
 521         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 522
 523         pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist;
 524         pBtLinkInfo->bScoExist = pCoexSta->bScoExist;
 525         pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist;
 526         pBtLinkInfo->bPanExist = pCoexSta->bPanExist;
 527         pBtLinkInfo->bHidExist = pCoexSta->bHidExist;
 528
 529         /*  work around for HS mode. */
 530         if (bBtHsOn) {
 531                 pBtLinkInfo->bPanExist = true;
 532                 pBtLinkInfo->bBtLinkExist = true;
 533         }
 534
 535         /*  check if Sco only */
 536         if (
 537                 pBtLinkInfo->bScoExist &&
 538                 !pBtLinkInfo->bA2dpExist &&
 539                 !pBtLinkInfo->bPanExist &&
 540                 !pBtLinkInfo->bHidExist
 541         )
 542                 pBtLinkInfo->bScoOnly = true;
 543         else
 544                 pBtLinkInfo->bScoOnly = false;
 545
 546         /*  check if A2dp only */
 547         if (
 548                 !pBtLinkInfo->bScoExist &&
 549                 pBtLinkInfo->bA2dpExist &&
 550                 !pBtLinkInfo->bPanExist &&
 551                 !pBtLinkInfo->bHidExist
 552         )
 553                 pBtLinkInfo->bA2dpOnly = true;
 554         else
 555                 pBtLinkInfo->bA2dpOnly = false;
 556
 557         /*  check if Pan only */
 558         if (
 559                 !pBtLinkInfo->bScoExist &&
 560                 !pBtLinkInfo->bA2dpExist &&
 561                 pBtLinkInfo->bPanExist &&
 562                 !pBtLinkInfo->bHidExist
 563         )
 564                 pBtLinkInfo->bPanOnly = true;
 565         else
 566                 pBtLinkInfo->bPanOnly = false;
 567
 568         /*  check if Hid only */
 569         if (
 570                 !pBtLinkInfo->bScoExist &&
 571                 !pBtLinkInfo->bA2dpExist &&
 572                 !pBtLinkInfo->bPanExist &&
 573                 pBtLinkInfo->bHidExist
 574         )
 575                 pBtLinkInfo->bHidOnly = true;
 576         else
 577                 pBtLinkInfo->bHidOnly = false;
 578 }
 579
 580 static u8 halbtc8723b1ant_ActionAlgorithm(PBTC_COEXIST pBtCoexist)
 581 {
 582         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
 583         bool bBtHsOn = false;
 584         u8 algorithm = BT_8723B_1ANT_COEX_ALGO_UNDEFINED;
 585         u8 numOfDiffProfile = 0;
 586
 587         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 588
 589         if (!pBtLinkInfo->bBtLinkExist) {
 590                 BTC_PRINT(
 591                         BTC_MSG_ALGORITHM,
 592                         ALGO_TRACE,
 593                         ("[BTCoex], No BT link exists!!!\n")
 594                 );
 595                 return algorithm;
 596         }
 597
 598         if (pBtLinkInfo->bScoExist)
 599                 numOfDiffProfile++;
 600         if (pBtLinkInfo->bHidExist)
 601                 numOfDiffProfile++;
 602         if (pBtLinkInfo->bPanExist)
 603                 numOfDiffProfile++;
 604         if (pBtLinkInfo->bA2dpExist)
 605                 numOfDiffProfile++;
 606
 607         if (numOfDiffProfile == 1) {
 608                 if (pBtLinkInfo->bScoExist) {
 609                         BTC_PRINT(
 610                                 BTC_MSG_ALGORITHM,
 611                                 ALGO_TRACE,
 612                                 ("[BTCoex], BT Profile = SCO only\n")
 613                         );
 614                         algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 615                 } else {
 616                         if (pBtLinkInfo->bHidExist) {
 617                                 BTC_PRINT(
 618                                         BTC_MSG_ALGORITHM,
 619                                         ALGO_TRACE,
 620                                         ("[BTCoex], BT Profile = HID only\n")
 621                                 );
 622                                 algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 623                         } else if (pBtLinkInfo->bA2dpExist) {
 624                                 BTC_PRINT(
 625                                         BTC_MSG_ALGORITHM,
 626                                         ALGO_TRACE,
 627                                         ("[BTCoex], BT Profile = A2DP only\n")
 628                                 );
 629                                 algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP;
 630                         } else if (pBtLinkInfo->bPanExist) {
 631                                 if (bBtHsOn) {
 632                                         BTC_PRINT(
 633                                                 BTC_MSG_ALGORITHM,
 634                                                 ALGO_TRACE,
 635                                                 ("[BTCoex], BT Profile = PAN(HS) only\n")
 636                                         );
 637                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANHS;
 638                                 } else {
 639                                         BTC_PRINT(
 640                                                 BTC_MSG_ALGORITHM,
 641                                                 ALGO_TRACE,
 642                                                 ("[BTCoex], BT Profile = PAN(EDR) only\n")
 643                                         );
 644                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR;
 645                                 }
 646                         }
 647                 }
 648         } else if (numOfDiffProfile == 2) {
 649                 if (pBtLinkInfo->bScoExist) {
 650                         if (pBtLinkInfo->bHidExist) {
 651                                 BTC_PRINT(
 652                                         BTC_MSG_ALGORITHM,
 653                                         ALGO_TRACE,
 654                                         ("[BTCoex], BT Profile = SCO + HID\n")
 655                                 );
 656                                 algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 657                         } else if (pBtLinkInfo->bA2dpExist) {
 658                                 BTC_PRINT(
 659                                         BTC_MSG_ALGORITHM,
 660                                         ALGO_TRACE,
 661                                         ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")
 662                                 );
 663                                 algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 664                         } else if (pBtLinkInfo->bPanExist) {
 665                                 if (bBtHsOn) {
 666                                         BTC_PRINT(
 667                                                 BTC_MSG_ALGORITHM,
 668                                                 ALGO_TRACE,
 669                                                 ("[BTCoex], BT Profile = SCO + PAN(HS)\n")
 670                                         );
 671                                         algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 672                                 } else {
 673                                         BTC_PRINT(
 674                                                 BTC_MSG_ALGORITHM,
 675                                                 ALGO_TRACE,
 676                                                 ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")
 677                                         );
 678                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 679                                 }
 680                         }
 681                 } else {
 682                         if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) {
 683                                 BTC_PRINT(
 684                                         BTC_MSG_ALGORITHM,
 685                                         ALGO_TRACE,
 686                                         ("[BTCoex], BT Profile = HID + A2DP\n")
 687                                 );
 688                                 algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 689                         } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist) {
 690                                 if (bBtHsOn) {
 691                                         BTC_PRINT(
 692                                                 BTC_MSG_ALGORITHM,
 693                                                 ALGO_TRACE,
 694                                                 ("[BTCoex], BT Profile = HID + PAN(HS)\n")
 695                                         );
 696                                         algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 697                                 } else {
 698                                         BTC_PRINT(
 699                                                 BTC_MSG_ALGORITHM,
 700                                                 ALGO_TRACE,
 701                                                 ("[BTCoex], BT Profile = HID + PAN(EDR)\n")
 702                                         );
 703                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 704                                 }
 705                         } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) {
 706                                 if (bBtHsOn) {
 707                                         BTC_PRINT(
 708                                                 BTC_MSG_ALGORITHM,
 709                                                 ALGO_TRACE,
 710                                                 ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")
 711                                         );
 712                                         algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS;
 713                                 } else {
 714                                         BTC_PRINT(
 715                                                 BTC_MSG_ALGORITHM,
 716                                                 ALGO_TRACE,
 717                                                 ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")
 718                                         );
 719                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP;
 720                                 }
 721                         }
 722                 }
 723         } else if (numOfDiffProfile == 3) {
 724                 if (pBtLinkInfo->bScoExist) {
 725                         if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) {
 726                                 BTC_PRINT(
 727                                         BTC_MSG_ALGORITHM,
 728                                         ALGO_TRACE,
 729                                         ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")
 730                                 );
 731                                 algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 732                         } else if (
 733                                 pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist
 734                         ) {
 735                                 if (bBtHsOn) {
 736                                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"));
 737                                         algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 738                                 } else {
 739                                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"));
 740                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 741                                 }
 742                         } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) {
 743                                 if (bBtHsOn) {
 744                                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"));
 745                                         algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 746                                 } else {
 747                                         BTC_PRINT(
 748                                                 BTC_MSG_ALGORITHM,
 749                                                 ALGO_TRACE,
 750                                                 ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")
 751                                         );
 752                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 753                                 }
 754                         }
 755                 } else {
 756                         if (
 757                                 pBtLinkInfo->bHidExist &&
 758                                 pBtLinkInfo->bPanExist &&
 759                                 pBtLinkInfo->bA2dpExist
 760                         ) {
 761                                 if (bBtHsOn) {
 762                                         BTC_PRINT(
 763                                                 BTC_MSG_ALGORITHM,
 764                                                 ALGO_TRACE,
 765                                                 ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")
 766                                         );
 767                                         algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 768                                 } else {
 769                                         BTC_PRINT(
 770                                                 BTC_MSG_ALGORITHM,
 771                                                 ALGO_TRACE,
 772                                                 ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")
 773                                         );
 774                                         algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR;
 775                                 }
 776                         }
 777                 }
 778         } else if (numOfDiffProfile >= 3) {
 779                 if (pBtLinkInfo->bScoExist) {
 780                         if (
 781                                 pBtLinkInfo->bHidExist &&
 782                                 pBtLinkInfo->bPanExist &&
 783                                 pBtLinkInfo->bA2dpExist
 784                         ) {
 785                                 if (bBtHsOn) {
 786                                         BTC_PRINT(
 787                                                 BTC_MSG_ALGORITHM,
 788                                                 ALGO_TRACE,
 789                                                 ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")
 790                                         );
 791
 792                                 } else {
 793                                         BTC_PRINT(
 794                                                 BTC_MSG_ALGORITHM,
 795                                                 ALGO_TRACE,
 796                                                 ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR) ==>PAN(EDR)+HID\n")
 797                                         );
 798                                         algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 799                                 }
 800                         }
 801                 }
 802         }
 803
 804         return algorithm;
 805 }
 806
 807 static void halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(
 808         PBTC_COEXIST pBtCoexist, bool bLowPenaltyRa
 809 )
 810 {
 811         u8      H2C_Parameter[6] = {0};
 812
 813         H2C_Parameter[0] = 0x6; /*  opCode, 0x6 = Retry_Penalty */
 814
 815         if (bLowPenaltyRa) {
 816                 H2C_Parameter[1] |= BIT0;
 817                 H2C_Parameter[2] = 0x00;  /* normal rate except MCS7/6/5, OFDM54/48/36 */
 818                 H2C_Parameter[3] = 0xf7;  /* MCS7 or OFDM54 */
 819                 H2C_Parameter[4] = 0xf8;  /* MCS6 or OFDM48 */
 820                 H2C_Parameter[5] = 0xf9;        /* MCS5 or OFDM36 */
 821         }
 822
 823         BTC_PRINT(
 824                 BTC_MSG_ALGORITHM,
 825                 ALGO_TRACE_FW_EXEC,
 826                 (
 827                         "[BTCoex], set WiFi Low-Penalty Retry: %s",
 828                         (bLowPenaltyRa ? "ON!!" : "OFF!!")
 829                 )
 830         );
 831
 832         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter);
 833 }
 834
 835 static void halbtc8723b1ant_LowPenaltyRa(
 836         PBTC_COEXIST pBtCoexist, bool bForceExec, bool bLowPenaltyRa
 837 )
 838 {
 839         pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa;
 840
 841         if (!bForceExec) {
 842                 if (pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa)
 843                         return;
 844         }
 845         halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(
 846                 pBtCoexist, pCoexDm->bCurLowPenaltyRa
 847         );
 848
 849         pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa;
 850 }
 851
 852 static void halbtc8723b1ant_SetCoexTable(
 853         PBTC_COEXIST pBtCoexist,
 854         u32 val0x6c0,
 855         u32 val0x6c4,
 856         u32 val0x6c8,
 857         u8 val0x6cc
 858 )
 859 {
 860         BTC_PRINT(
 861                 BTC_MSG_ALGORITHM,
 862                 ALGO_TRACE_SW_EXEC,
 863                 ("[BTCoex], set coex table, set 0x6c0 = 0x%x\n", val0x6c0)
 864         );
 865         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0);
 866
 867         BTC_PRINT(
 868                 BTC_MSG_ALGORITHM,
 869                 ALGO_TRACE_SW_EXEC,
 870                 ("[BTCoex], set coex table, set 0x6c4 = 0x%x\n", val0x6c4)
 871         );
 872         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4);
 873
 874         BTC_PRINT(
 875                 BTC_MSG_ALGORITHM,
 876                 ALGO_TRACE_SW_EXEC,
 877                 ("[BTCoex], set coex table, set 0x6c8 = 0x%x\n", val0x6c8)
 878         );
 879         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8);
 880
 881         BTC_PRINT(
 882                 BTC_MSG_ALGORITHM,
 883                 ALGO_TRACE_SW_EXEC,
 884                 ("[BTCoex], set coex table, set 0x6cc = 0x%x\n", val0x6cc)
 885         );
 886         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc);
 887 }
 888
 889 static void halbtc8723b1ant_CoexTable(
 890         PBTC_COEXIST pBtCoexist,
 891         bool bForceExec,
 892         u32 val0x6c0,
 893         u32 val0x6c4,
 894         u32 val0x6c8,
 895         u8 val0x6cc
 896 )
 897 {
 898         BTC_PRINT(
 899                 BTC_MSG_ALGORITHM,
 900                 ALGO_TRACE_SW,
 901                 (
 902                         "[BTCoex], %s write Coex Table 0x6c0 = 0x%x, 0x6c4 = 0x%x, 0x6cc = 0x%x\n",
 903                         (bForceExec ? "force to" : ""),
 904                         val0x6c0, val0x6c4, val0x6cc
 905                 )
 906         );
 907         pCoexDm->curVal0x6c0 = val0x6c0;
 908         pCoexDm->curVal0x6c4 = val0x6c4;
 909         pCoexDm->curVal0x6c8 = val0x6c8;
 910         pCoexDm->curVal0x6cc = val0x6cc;
 911
 912         if (!bForceExec) {
 913                 if (
 914                         (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) &&
 915                     (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) &&
 916                     (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) &&
 917                     (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc)
 918                 )
 919                         return;
 920         }
 921
 922         halbtc8723b1ant_SetCoexTable(
 923                 pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc
 924         );
 925
 926         pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0;
 927         pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4;
 928         pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8;
 929         pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc;
 930 }
 931
 932 static void halbtc8723b1ant_CoexTableWithType(
 933         PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 934 )
 935 {
 936         BTC_PRINT(
 937                 BTC_MSG_ALGORITHM,
 938                 ALGO_TRACE,
 939                 ("[BTCoex], ********** CoexTable(%d) **********\n", type)
 940         );
 941
 942         pCoexSta->nCoexTableType = type;
 943
 944         switch (type) {
 945         case 0:
 946                 halbtc8723b1ant_CoexTable(
 947                         pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3
 948                 );
 949                 break;
 950         case 1:
 951                 halbtc8723b1ant_CoexTable(
 952                         pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3
 953                 );
 954                 break;
 955         case 2:
 956                 halbtc8723b1ant_CoexTable(
 957                         pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3
 958                 );
 959                 break;
 960         case 3:
 961                 halbtc8723b1ant_CoexTable(
 962                         pBtCoexist, bForceExec, 0xaaaa5555, 0xaaaa5a5a, 0xffffff, 0x3
 963                 );
 964                 break;
 965         case 4:
 966                 halbtc8723b1ant_CoexTable(
 967                         pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3
 968                 );
 969                 break;
 970         case 5:
 971                 halbtc8723b1ant_CoexTable(
 972                         pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3
 973                 );
 974                 break;
 975         case 6:
 976                 halbtc8723b1ant_CoexTable(
 977                         pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3
 978                 );
 979                 break;
 980         case 7:
 981                 halbtc8723b1ant_CoexTable(
 982                         pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3
 983                 );
 984                 break;
 985         default:
 986                 break;
 987         }
 988 }
 989
 990 static void halbtc8723b1ant_SetFwIgnoreWlanAct(
 991         PBTC_COEXIST pBtCoexist, bool bEnable
 992 )
 993 {
 994         u8 H2C_Parameter[1] = {0};
 995
 996         if (bEnable)
 997                 H2C_Parameter[0] |= BIT0; /* function enable */
 998
 999         BTC_PRINT(
1000                 BTC_MSG_ALGORITHM,
1001                 ALGO_TRACE_FW_EXEC,
1002                 (
1003                         "[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63 = 0x%x\n",
1004                         H2C_Parameter[0]
1005                 )
1006         );
1007
1008         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter);
1009 }
1010
1011 static void halbtc8723b1ant_IgnoreWlanAct(
1012         PBTC_COEXIST pBtCoexist, bool bForceExec, bool bEnable
1013 )
1014 {
1015         BTC_PRINT(
1016                 BTC_MSG_ALGORITHM,
1017                 ALGO_TRACE_FW,
1018                 (
1019                         "[BTCoex], %s turn Ignore WlanAct %s\n",
1020                         (bForceExec ? "force to" : ""),
1021                         (bEnable ? "ON" : "OFF")
1022                 )
1023         );
1024         pCoexDm->bCurIgnoreWlanAct = bEnable;
1025
1026         if (!bForceExec) {
1027                 BTC_PRINT(
1028                         BTC_MSG_ALGORITHM,
1029                         ALGO_TRACE_FW_DETAIL,
1030                         (
1031                                 "[BTCoex], bPreIgnoreWlanAct = %d, bCurIgnoreWlanAct = %d!!\n",
1032                                 pCoexDm->bPreIgnoreWlanAct,
1033                                 pCoexDm->bCurIgnoreWlanAct
1034                         )
1035                 );
1036
1037                 if (pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct)
1038                         return;
1039         }
1040         halbtc8723b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable);
1041
1042         pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct;
1043 }
1044
1045 static void halbtc8723b1ant_SetLpsRpwm(
1046         PBTC_COEXIST pBtCoexist, u8 lpsVal, u8 rpwmVal
1047 )
1048 {
1049         u8 lps = lpsVal;
1050         u8 rpwm = rpwmVal;
1051
1052         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps);
1053         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm);
1054 }
1055
1056 static void halbtc8723b1ant_LpsRpwm(
1057         PBTC_COEXIST pBtCoexist, bool bForceExec, u8 lpsVal, u8 rpwmVal
1058 )
1059 {
1060         BTC_PRINT(
1061                 BTC_MSG_ALGORITHM,
1062                 ALGO_TRACE_FW,
1063                 (
1064                         "[BTCoex], %s set lps/rpwm = 0x%x/0x%x\n",
1065                         (bForceExec ? "force to" : ""),
1066                         lpsVal,
1067                         rpwmVal
1068                 )
1069         );
1070         pCoexDm->curLps = lpsVal;
1071         pCoexDm->curRpwm = rpwmVal;
1072
1073         if (!bForceExec) {
1074                 BTC_PRINT(
1075                         BTC_MSG_ALGORITHM,
1076                         ALGO_TRACE_FW_DETAIL,
1077                         (
1078                                 "[BTCoex], LPS-RxBeaconMode = 0x%x , LPS-RPWM = 0x%x!!\n",
1079                                 pCoexDm->curLps,
1080                                 pCoexDm->curRpwm
1081                         )
1082                 );
1083
1084                 if (
1085                         (pCoexDm->preLps == pCoexDm->curLps) &&
1086                         (pCoexDm->preRpwm == pCoexDm->curRpwm)
1087                 ) {
1088                         BTC_PRINT(
1089                                 BTC_MSG_ALGORITHM,
1090                                 ALGO_TRACE_FW_DETAIL,
1091                                 (
1092                                         "[BTCoex], LPS-RPWM_Last = 0x%x , LPS-RPWM_Now = 0x%x!!\n",
1093                                         pCoexDm->preRpwm,
1094                                         pCoexDm->curRpwm
1095                                 )
1096                         );
1097
1098                         return;
1099                 }
1100         }
1101         halbtc8723b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal);
1102
1103         pCoexDm->preLps = pCoexDm->curLps;
1104         pCoexDm->preRpwm = pCoexDm->curRpwm;
1105 }
1106
1107 static void halbtc8723b1ant_SwMechanism(
1108         PBTC_COEXIST pBtCoexist, bool bLowPenaltyRA
1109 )
1110 {
1111         BTC_PRINT(
1112                 BTC_MSG_ALGORITHM,
1113                 ALGO_BT_MONITOR,
1114                 ("[BTCoex], SM[LpRA] = %d\n", bLowPenaltyRA)
1115         );
1116
1117         halbtc8723b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA);
1118 }
1119
1120 static void halbtc8723b1ant_SetAntPath(
1121         PBTC_COEXIST pBtCoexist, u8 antPosType, bool bInitHwCfg, bool bWifiOff
1122 )
1123 {
1124         PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
1125         u32 fwVer = 0, u4Tmp = 0, cntBtCalChk = 0;
1126         bool bPgExtSwitch = false;
1127         bool bUseExtSwitch = false;
1128         bool bIsInMpMode = false;
1129         u8 H2C_Parameter[2] = {0}, u1Tmp = 0;
1130
1131         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch);
1132         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); /*  [31:16]=fw ver, [15:0]=fw sub ver */
1133
1134         if ((fwVer > 0 && fwVer < 0xc0000) || bPgExtSwitch)
1135                 bUseExtSwitch = true;
1136
1137         if (bInitHwCfg) {
1138                 pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); /* WiFi TRx Mask on */
1139                 pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); /* BT TRx Mask on */
1140
1141                 if (fwVer >= 0x180000) {
1142                         /* Use H2C to set GNT_BT to HIGH */
1143                         H2C_Parameter[0] = 1;
1144                         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1145                 } else /*  set grant_bt to high */
1146                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
1147
1148                 /* set wlan_act control by PTA */
1149                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
1150
1151                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */
1152
1153                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1);
1154                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff);
1155                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3);
1156                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77);
1157         } else if (bWifiOff) {
1158                 if (fwVer >= 0x180000) {
1159                         /* Use H2C to set GNT_BT to HIGH */
1160                         H2C_Parameter[0] = 1;
1161                         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1162                 } else /*  set grant_bt to high */
1163                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
1164
1165                 /* set wlan_act to always low */
1166                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
1167
1168                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode);
1169                 if (!bIsInMpMode)
1170                         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); /* BT select s0/s1 is controlled by BT */
1171                 else
1172                         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */
1173
1174                 /*  0x4c[24:23]= 00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac = 0xf002 */
1175                 u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1176                 u4Tmp &= ~BIT23;
1177                 u4Tmp &= ~BIT24;
1178                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1179         } else {
1180                 /* Use H2C to set GNT_BT to LOW */
1181                 if (fwVer >= 0x180000) {
1182                         if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765) != 0) {
1183                                 H2C_Parameter[0] = 0;
1184                                 pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1185                         }
1186                 } else {
1187                         /*  BT calibration check */
1188                         while (cntBtCalChk <= 20) {
1189                                 u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d);
1190                                 cntBtCalChk++;
1191
1192                                 if (u1Tmp & BIT0) {
1193                                         BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ########### BT is calibrating (wait cnt =%d) ###########\n", cntBtCalChk));
1194                                         mdelay(50);
1195                                 } else {
1196                                         BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ********** BT is NOT calibrating (wait cnt =%d)**********\n", cntBtCalChk));
1197                                         break;
1198                                 }
1199                         }
1200
1201                         /*  set grant_bt to PTA */
1202                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0);
1203                 }
1204
1205                 if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) != 0xc)
1206                         /* set wlan_act control by PTA */
1207                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc);
1208         }
1209
1210         if (bUseExtSwitch) {
1211                 if (bInitHwCfg) {
1212                         /*  0x4c[23]= 0, 0x4c[24]= 1  Antenna control by WL/BT */
1213                         u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1214                         u4Tmp &= ~BIT23;
1215                         u4Tmp |= BIT24;
1216                         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1217
1218                         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); /*  fixed internal switch S1->WiFi, S0->BT */
1219
1220                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) {
1221                                 /* tell firmware "no antenna inverse" */
1222                                 H2C_Parameter[0] = 0;
1223                                 H2C_Parameter[1] = 1;  /* ext switch type */
1224                                 pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1225                         } else {
1226                                 /* tell firmware "antenna inverse" */
1227                                 H2C_Parameter[0] = 1;
1228                                 H2C_Parameter[1] = 1;  /* ext switch type */
1229                                 pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1230                         }
1231                 }
1232
1233
1234                 /*  ext switch setting */
1235                 switch (antPosType) {
1236                 case BTC_ANT_PATH_WIFI:
1237                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1238                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1239                         else
1240                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1241                         break;
1242                 case BTC_ANT_PATH_BT:
1243                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1244                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1245                         else
1246                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1247                         break;
1248                 default:
1249                 case BTC_ANT_PATH_PTA:
1250                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1251                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1252                         else
1253                                 pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1254                         break;
1255                 }
1256
1257         } else {
1258                 if (bInitHwCfg) {
1259                         /*  0x4c[23]= 1, 0x4c[24]= 0  Antenna control by 0x64 */
1260                         u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1261                         u4Tmp |= BIT23;
1262                         u4Tmp &= ~BIT24;
1263                         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1264
1265                         /* Fix Ext switch Main->S1, Aux->S0 */
1266                         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0);
1267
1268                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) {
1269
1270                                 /* tell firmware "no antenna inverse" */
1271                                 H2C_Parameter[0] = 0;
1272                                 H2C_Parameter[1] = 0;  /* internal switch type */
1273                                 pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1274                         } else {
1275
1276                                 /* tell firmware "antenna inverse" */
1277                                 H2C_Parameter[0] = 1;
1278                                 H2C_Parameter[1] = 0;  /* internal switch type */
1279                                 pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1280                         }
1281                 }
1282
1283
1284                 /*  internal switch setting */
1285                 switch (antPosType) {
1286                 case BTC_ANT_PATH_WIFI:
1287                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1288                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
1289                         else
1290                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
1291                         break;
1292                 case BTC_ANT_PATH_BT:
1293                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1294                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
1295                         else
1296                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
1297                         break;
1298                 default:
1299                 case BTC_ANT_PATH_PTA:
1300                         if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1301                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x200);
1302                         else
1303                                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x80);
1304                         break;
1305                 }
1306         }
1307 }
1308
1309 static void halbtc8723b1ant_SetFwPstdma(
1310         PBTC_COEXIST pBtCoexist, u8 byte1, u8 byte2, u8 byte3, u8 byte4, u8 byte5
1311 )
1312 {
1313         u8 H2C_Parameter[5] = {0};
1314         u8 realByte1 = byte1, realByte5 = byte5;
1315         bool bApEnable = false;
1316
1317         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
1318
1319         if (bApEnable) {
1320                 if (byte1&BIT4 && !(byte1&BIT5)) {
1321                         BTC_PRINT(
1322                                 BTC_MSG_INTERFACE,
1323                                 INTF_NOTIFY,
1324                                 ("[BTCoex], FW for 1Ant AP mode\n")
1325                         );
1326                         realByte1 &= ~BIT4;
1327                         realByte1 |= BIT5;
1328
1329                         realByte5 |= BIT5;
1330                         realByte5 &= ~BIT6;
1331                 }
1332         }
1333
1334         H2C_Parameter[0] = realByte1;
1335         H2C_Parameter[1] = byte2;
1336         H2C_Parameter[2] = byte3;
1337         H2C_Parameter[3] = byte4;
1338         H2C_Parameter[4] = realByte5;
1339
1340         pCoexDm->psTdmaPara[0] = realByte1;
1341         pCoexDm->psTdmaPara[1] = byte2;
1342         pCoexDm->psTdmaPara[2] = byte3;
1343         pCoexDm->psTdmaPara[3] = byte4;
1344         pCoexDm->psTdmaPara[4] = realByte5;
1345
1346         BTC_PRINT(
1347                 BTC_MSG_ALGORITHM,
1348                 ALGO_TRACE_FW_EXEC,
1349                 (
1350                         "[BTCoex], PS-TDMA H2C cmd = 0x%x%08x\n",
1351                         H2C_Parameter[0],
1352                         H2C_Parameter[1]<<24|
1353                         H2C_Parameter[2]<<16|
1354                         H2C_Parameter[3]<<8|
1355                         H2C_Parameter[4]
1356                 )
1357         );
1358
1359         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter);
1360 }
1361
1362
1363 static void halbtc8723b1ant_PsTdma(
1364         PBTC_COEXIST pBtCoexist, bool bForceExec, bool bTurnOn, u8 type
1365 )
1366 {
1367         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
1368         bool bWifiBusy = false;
1369         u8 rssiAdjustVal = 0;
1370         u8 psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val =  0x10;
1371         s8 nWiFiDurationAdjust = 0x0;
1372         /* u32          fwVer = 0; */
1373
1374         /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW, ("[BTCoex], %s turn %s PS TDMA, type =%d\n", */
1375         /*      (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); */
1376         pCoexDm->bCurPsTdmaOn = bTurnOn;
1377         pCoexDm->curPsTdma = type;
1378
1379         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
1380
1381         if (pCoexDm->bCurPsTdmaOn) {
1382                 BTC_PRINT(
1383                         BTC_MSG_ALGORITHM,
1384                         ALGO_TRACE,
1385                         (
1386                                 "[BTCoex], ********** TDMA(on, %d) **********\n",
1387                                 pCoexDm->curPsTdma
1388                         )
1389                 );
1390         } else {
1391                 BTC_PRINT(
1392                         BTC_MSG_ALGORITHM,
1393                         ALGO_TRACE,
1394                         (
1395                                 "[BTCoex], ********** TDMA(off, %d) **********\n",
1396                                 pCoexDm->curPsTdma
1397                         )
1398                 );
1399         }
1400
1401         if (!bForceExec) {
1402                 if (
1403                         (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) &&
1404                         (pCoexDm->prePsTdma == pCoexDm->curPsTdma)
1405                 )
1406                         return;
1407         }
1408
1409         if (pCoexSta->nScanAPNum <= 5)
1410                 nWiFiDurationAdjust = 5;
1411         else if  (pCoexSta->nScanAPNum >= 40)
1412                 nWiFiDurationAdjust = -15;
1413         else if  (pCoexSta->nScanAPNum >= 20)
1414                 nWiFiDurationAdjust = -10;
1415
1416         if (!pCoexSta->bForceLpsOn) { /* only for A2DP-only case 1/2/9/11 */
1417                 psTdmaByte0Val = 0x61;  /* no null-pkt */
1418                 psTdmaByte3Val = 0x11; /*  no tx-pause at BT-slot */
1419                 psTdmaByte4Val = 0x10; /*  0x778 = d/1 toggle */
1420         }
1421
1422
1423         if (bTurnOn) {
1424                 if (pBtLinkInfo->bSlaveRole == true)
1425                         psTdmaByte4Val = psTdmaByte4Val | 0x1;  /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */
1426
1427
1428                 switch (type) {
1429                 default:
1430                         halbtc8723b1ant_SetFwPstdma(
1431                                 pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val
1432                         );
1433                         break;
1434                 case 1:
1435                         halbtc8723b1ant_SetFwPstdma(
1436                                 pBtCoexist,
1437                                 psTdmaByte0Val,
1438                                 0x3a+nWiFiDurationAdjust,
1439                                 0x03,
1440                                 psTdmaByte3Val,
1441                                 psTdmaByte4Val
1442                         );
1443                         break;
1444                 case 2:
1445                         halbtc8723b1ant_SetFwPstdma(
1446                                 pBtCoexist,
1447                                 psTdmaByte0Val,
1448                                 0x2d+nWiFiDurationAdjust,
1449                                 0x03,
1450                                 psTdmaByte3Val,
1451                                 psTdmaByte4Val
1452                         );
1453                         break;
1454                 case 3:
1455                         halbtc8723b1ant_SetFwPstdma(
1456                                 pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, 0x10
1457                         );
1458                         break;
1459                 case 4:
1460                         halbtc8723b1ant_SetFwPstdma(
1461                                 pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0
1462                         );
1463                         break;
1464                 case 5:
1465                         halbtc8723b1ant_SetFwPstdma(
1466                                 pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x10
1467                         );
1468                         break;
1469                 case 6:
1470                         halbtc8723b1ant_SetFwPstdma(
1471                                 pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x11
1472                         );
1473                         break;
1474                 case 7:
1475                         halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0);
1476                         break;
1477                 case 8:
1478                         halbtc8723b1ant_SetFwPstdma(
1479                                 pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0
1480                         );
1481                         break;
1482                 case 9:
1483                         halbtc8723b1ant_SetFwPstdma(
1484                                 pBtCoexist,
1485                                 psTdmaByte0Val,
1486                                 0x21,
1487                                 0x3,
1488                                 psTdmaByte3Val,
1489                                 psTdmaByte4Val
1490                         );
1491                         break;
1492                 case 10:
1493                         halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40);
1494                         break;
1495                 case 11:
1496                         halbtc8723b1ant_SetFwPstdma(
1497                                 pBtCoexist,
1498                                 psTdmaByte0Val,
1499                                 0x21,
1500                                 0x03,
1501                                 psTdmaByte3Val,
1502                                 psTdmaByte4Val
1503                         );
1504                         break;
1505                 case 12:
1506                         halbtc8723b1ant_SetFwPstdma(
1507                                 pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50
1508                         );
1509                         break;
1510                 case 13:
1511                         halbtc8723b1ant_SetFwPstdma(
1512                                 pBtCoexist, 0x51, 0x12, 0x12, 0x0, 0x10
1513                         );
1514                         break;
1515                 case 14:
1516                         halbtc8723b1ant_SetFwPstdma(
1517                                 pBtCoexist, 0x51, 0x21, 0x3, 0x10, psTdmaByte4Val
1518                         );
1519                         break;
1520                 case 15:
1521                         halbtc8723b1ant_SetFwPstdma(
1522                                 pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0
1523                         );
1524                         break;
1525                 case 16:
1526                         halbtc8723b1ant_SetFwPstdma(
1527                                 pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0
1528                         );
1529                         break;
1530                 case 18:
1531                         halbtc8723b1ant_SetFwPstdma(
1532                                 pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0
1533                         );
1534                         break;
1535                 case 20:
1536                         halbtc8723b1ant_SetFwPstdma(
1537                                 pBtCoexist, 0x61, 0x3f, 0x03, 0x11, 0x10
1538
1539                         );
1540                         break;
1541                 case 21:
1542                         halbtc8723b1ant_SetFwPstdma(
1543                                 pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11
1544                         );
1545                         break;
1546                 case 22:
1547                         halbtc8723b1ant_SetFwPstdma(
1548                                 pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10
1549                         );
1550                         break;
1551                 case 23:
1552                         halbtc8723b1ant_SetFwPstdma(
1553                                 pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18
1554                         );
1555                         break;
1556                 case 24:
1557                         halbtc8723b1ant_SetFwPstdma(
1558                                 pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18
1559                         );
1560                         break;
1561                 case 25:
1562                         halbtc8723b1ant_SetFwPstdma(
1563                                 pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18
1564                         );
1565                         break;
1566                 case 26:
1567                         halbtc8723b1ant_SetFwPstdma(
1568                                 pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18
1569                         );
1570                         break;
1571                 case 27:
1572                         halbtc8723b1ant_SetFwPstdma(
1573                                 pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98
1574                         );
1575                         break;
1576                 case 28:
1577                         halbtc8723b1ant_SetFwPstdma(
1578                                 pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0
1579                         );
1580                         break;
1581                 case 29:
1582                         halbtc8723b1ant_SetFwPstdma(
1583                                 pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10
1584                         );
1585                         break;
1586                 case 30:
1587                         halbtc8723b1ant_SetFwPstdma(
1588                                 pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10
1589                         );
1590                         break;
1591                 case 31:
1592                         halbtc8723b1ant_SetFwPstdma(
1593                                 pBtCoexist, 0xd3, 0x1a, 0x1a, 0x0, 0x58
1594                         );
1595                         break;
1596                 case 32:
1597                         halbtc8723b1ant_SetFwPstdma(
1598                                 pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11
1599                         );
1600                         break;
1601                 case 33:
1602                         halbtc8723b1ant_SetFwPstdma(
1603                                 pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90
1604                         );
1605                         break;
1606                 case 34:
1607                         halbtc8723b1ant_SetFwPstdma(
1608                                 pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10
1609                         );
1610                         break;
1611                 case 35:
1612                         halbtc8723b1ant_SetFwPstdma(
1613                                 pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10
1614                         );
1615                         break;
1616                 case 36:
1617                         halbtc8723b1ant_SetFwPstdma(
1618                                 pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50
1619                         );
1620                         break;
1621                 case 40: /*  SoftAP only with no sta associated, BT disable , TDMA mode for power saving */
1622                         /* here softap mode screen off will cost 70-80mA for phone */
1623                         halbtc8723b1ant_SetFwPstdma(
1624                                 pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24
1625                         );
1626                         break;
1627                 }
1628         } else {
1629
1630                 /*  disable PS tdma */
1631                 switch (type) {
1632                 case 8: /* PTA Control */
1633                         halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0);
1634                         halbtc8723b1ant_SetAntPath(
1635                                 pBtCoexist, BTC_ANT_PATH_PTA, false, false
1636                         );
1637                         break;
1638                 case 0:
1639                 default:  /* Software control, Antenna at BT side */
1640                         halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);
1641                         halbtc8723b1ant_SetAntPath(
1642                                 pBtCoexist, BTC_ANT_PATH_BT, false, false
1643                         );
1644                         break;
1645                 case 9:   /* Software control, Antenna at WiFi side */
1646                         halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);
1647                         halbtc8723b1ant_SetAntPath(
1648                                 pBtCoexist, BTC_ANT_PATH_WIFI, false, false
1649                         );
1650                         break;
1651                 }
1652         }
1653
1654         rssiAdjustVal = 0;
1655         pBtCoexist->fBtcSet(
1656                 pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal
1657         );
1658
1659         /*  update pre state */
1660         pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn;
1661         pCoexDm->prePsTdma = pCoexDm->curPsTdma;
1662 }
1663
1664 static bool halbtc8723b1ant_IsCommonAction(PBTC_COEXIST pBtCoexist)
1665 {
1666         bool bCommon = false, bWifiConnected = false, bWifiBusy = false;
1667
1668         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
1669         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
1670
1671         if (
1672                 !bWifiConnected &&
1673                 BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus
1674         ) {
1675                 BTC_PRINT(
1676                         BTC_MSG_ALGORITHM,
1677                         ALGO_TRACE,
1678                         ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")
1679                 );
1680
1681                 /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1682
1683                 bCommon = true;
1684         } else if (
1685                 bWifiConnected &&
1686                 (BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)
1687         ) {
1688                 BTC_PRINT(
1689                         BTC_MSG_ALGORITHM,
1690                         ALGO_TRACE,
1691                         ("[BTCoex], Wifi connected + BT non connected-idle!!\n")
1692                 );
1693
1694                 /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1695
1696                 bCommon = true;
1697         } else if (
1698                 !bWifiConnected &&
1699                 (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)
1700         ) {
1701                 BTC_PRINT(
1702                         BTC_MSG_ALGORITHM,
1703                         ALGO_TRACE,
1704                         ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")
1705                 );
1706
1707                 /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1708
1709                 bCommon = true;
1710         } else if (
1711                 bWifiConnected &&
1712                 (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)
1713         ) {
1714                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi connected + BT connected-idle!!\n"));
1715
1716                 /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1717
1718                 bCommon = true;
1719         } else if (
1720                 !bWifiConnected &&
1721                 (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus)
1722         ) {
1723                 BTC_PRINT(
1724                         BTC_MSG_ALGORITHM,
1725                         ALGO_TRACE,
1726                         ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")
1727                 );
1728
1729                 /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1730
1731                 bCommon = true;
1732         } else {
1733                 if (bWifiBusy) {
1734                         BTC_PRINT(
1735                                 BTC_MSG_ALGORITHM,
1736                                 ALGO_TRACE,
1737                                 ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")
1738                         );
1739                 } else {
1740                         BTC_PRINT(
1741                                 BTC_MSG_ALGORITHM,
1742                                 ALGO_TRACE,
1743                                 ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")
1744                         );
1745                 }
1746
1747                 bCommon = false;
1748         }
1749
1750         return bCommon;
1751 }
1752
1753
1754 static void halbtc8723b1ant_TdmaDurationAdjustForAcl(
1755         PBTC_COEXIST pBtCoexist, u8 wifiStatus
1756 )
1757 {
1758         static s32 up, dn, m, n, WaitCount;
1759         s32 result;   /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */
1760         u8 retryCount = 0, btInfoExt;
1761         bool bWifiBusy = false;
1762
1763         BTC_PRINT(
1764                 BTC_MSG_ALGORITHM,
1765                 ALGO_TRACE_FW,
1766                 ("[BTCoex], TdmaDurationAdjustForAcl()\n")
1767         );
1768
1769         if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus)
1770                 bWifiBusy = true;
1771         else
1772                 bWifiBusy = false;
1773
1774         if (
1775                 (BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) ||
1776                 (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) ||
1777                 (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus)
1778         ) {
1779                 if (
1780                         pCoexDm->curPsTdma != 1 &&
1781                         pCoexDm->curPsTdma != 2 &&
1782                         pCoexDm->curPsTdma != 3 &&
1783                         pCoexDm->curPsTdma != 9
1784                 ) {
1785                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1786                         pCoexDm->psTdmaDuAdjType = 9;
1787
1788                         up = 0;
1789                         dn = 0;
1790                         m = 1;
1791                         n = 3;
1792                         result = 0;
1793                         WaitCount = 0;
1794                 }
1795                 return;
1796         }
1797
1798         if (!pCoexDm->bAutoTdmaAdjust) {
1799                 pCoexDm->bAutoTdmaAdjust = true;
1800                 BTC_PRINT(
1801                         BTC_MSG_ALGORITHM,
1802                         ALGO_TRACE_FW_DETAIL,
1803                         ("[BTCoex], first run TdmaDurationAdjust()!!\n")
1804                 );
1805
1806                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1807                 pCoexDm->psTdmaDuAdjType = 2;
1808                 /*  */
1809                 up = 0;
1810                 dn = 0;
1811                 m = 1;
1812                 n = 3;
1813                 result = 0;
1814                 WaitCount = 0;
1815         } else {
1816                 /* accquire the BT TRx retry count from BT_Info byte2 */
1817                 retryCount = pCoexSta->btRetryCnt;
1818                 btInfoExt = pCoexSta->btInfoExt;
1819                 /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], retryCount = %d\n", retryCount)); */
1820                 /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], up =%d, dn =%d, m =%d, n =%d, WaitCount =%d\n", */
1821                 /*      up, dn, m, n, WaitCount)); */
1822
1823                 if (pCoexSta->lowPriorityTx > 1050 || pCoexSta->lowPriorityRx > 1250)
1824                         retryCount++;
1825
1826                 result = 0;
1827                 WaitCount++;
1828
1829                 if (retryCount == 0) { /*  no retry in the last 2-second duration */
1830                         up++;
1831                         dn--;
1832
1833                         if (dn <= 0)
1834                                 dn = 0;
1835
1836                         if (up >= n) { /*  if 連續 n 個2秒 retry count為0, 則調寬WiFi duration */
1837                                 WaitCount = 0;
1838                                 n = 3;
1839                                 up = 0;
1840                                 dn = 0;
1841                                 result = 1;
1842                                 BTC_PRINT(
1843                                         BTC_MSG_ALGORITHM,
1844                                         ALGO_TRACE_FW_DETAIL,
1845                                         ("[BTCoex], Increase wifi duration!!\n")
1846                                 );
1847                         }
1848                 } else if (retryCount <= 3) { /*  <=3 retry in the last 2-second duration */
1849                         up--;
1850                         dn++;
1851
1852                         if (up <= 0)
1853                                 up = 0;
1854
1855                         if (dn == 2) { /*  if 連續 2 個2秒 retry count< 3, 則調窄WiFi duration */
1856                                 if (WaitCount <= 2)
1857                                         m++; /*  避免一直在兩個level中來回 */
1858                                 else
1859                                         m = 1;
1860
1861                                 if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */
1862                                         m = 20;
1863
1864                                 n = 3*m;
1865                                 up = 0;
1866                                 dn = 0;
1867                                 WaitCount = 0;
1868                                 result = -1;
1869                                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n"));
1870                         }
1871                 } else { /* retry count > 3, 只要1次 retry count > 3, 則調窄WiFi duration */
1872                         if (WaitCount == 1)
1873                                 m++; /*  避免一直在兩個level中來回 */
1874                         else
1875                                 m = 1;
1876
1877                         if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */
1878                                 m = 20;
1879
1880                         n = 3*m;
1881                         up = 0;
1882                         dn = 0;
1883                         WaitCount = 0;
1884                         result = -1;
1885                         BTC_PRINT(
1886                                 BTC_MSG_ALGORITHM,
1887                                 ALGO_TRACE_FW_DETAIL,
1888                                 ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")
1889                         );
1890                 }
1891
1892                 if (result == -1) {
1893                         if (
1894                                 BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) &&
1895                                 ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2))
1896                         ) {
1897                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1898                                 pCoexDm->psTdmaDuAdjType = 9;
1899                         } else if (pCoexDm->curPsTdma == 1) {
1900                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1901                                 pCoexDm->psTdmaDuAdjType = 2;
1902                         } else if (pCoexDm->curPsTdma == 2) {
1903                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1904                                 pCoexDm->psTdmaDuAdjType = 9;
1905                         } else if (pCoexDm->curPsTdma == 9) {
1906                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11);
1907                                 pCoexDm->psTdmaDuAdjType = 11;
1908                         }
1909                 } else if (result == 1) {
1910                         if (
1911                                 BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) &&
1912                                 ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2))
1913                         ) {
1914                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1915                                 pCoexDm->psTdmaDuAdjType = 9;
1916                         } else if (pCoexDm->curPsTdma == 11) {
1917                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1918                                 pCoexDm->psTdmaDuAdjType = 9;
1919                         } else if (pCoexDm->curPsTdma == 9) {
1920                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1921                                 pCoexDm->psTdmaDuAdjType = 2;
1922                         } else if (pCoexDm->curPsTdma == 2) {
1923                                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1);
1924                                 pCoexDm->psTdmaDuAdjType = 1;
1925                         }
1926                 } else {          /* no change */
1927                         BTC_PRINT(
1928                                 BTC_MSG_ALGORITHM,
1929                                 ALGO_TRACE_FW_DETAIL,
1930                                 (
1931                                         "[BTCoex], ********** TDMA(on, %d) **********\n",
1932                                         pCoexDm->curPsTdma
1933                                 )
1934                         );
1935                 }
1936
1937                 if (
1938                         pCoexDm->curPsTdma != 1 &&
1939                         pCoexDm->curPsTdma != 2 &&
1940                         pCoexDm->curPsTdma != 9 &&
1941                         pCoexDm->curPsTdma != 11
1942                 ) /*  recover to previous adjust type */
1943                         halbtc8723b1ant_PsTdma(
1944                                 pBtCoexist, NORMAL_EXEC, true, pCoexDm->psTdmaDuAdjType
1945                         );
1946         }
1947 }
1948
1949 static void halbtc8723b1ant_PsTdmaCheckForPowerSaveState(
1950         PBTC_COEXIST pBtCoexist, bool bNewPsState
1951 )
1952 {
1953         u8 lpsMode = 0x0;
1954
1955         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode);
1956
1957         if (lpsMode) {  /*  already under LPS state */
1958                 if (bNewPsState) {
1959                         /*  keep state under LPS, do nothing. */
1960                 } else /*  will leave LPS state, turn off psTdma first */
1961                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
1962         } else {                                                /*  NO PS state */
1963                 if (bNewPsState) /*  will enter LPS state, turn off psTdma first */
1964                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
1965                 else {
1966                         /*  keep state under NO PS state, do nothing. */
1967                 }
1968         }
1969 }
1970
1971 static void halbtc8723b1ant_PowerSaveState(
1972         PBTC_COEXIST pBtCoexist, u8 psType, u8 lpsVal, u8 rpwmVal
1973 )
1974 {
1975         bool bLowPwrDisable = false;
1976
1977         switch (psType) {
1978         case BTC_PS_WIFI_NATIVE:
1979                 /*  recover to original 32k low power setting */
1980                 bLowPwrDisable = false;
1981                 pBtCoexist->fBtcSet(
1982                         pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable
1983                 );
1984                 pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL);
1985                 pCoexSta->bForceLpsOn = false;
1986                 break;
1987         case BTC_PS_LPS_ON:
1988                 halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, true);
1989                 halbtc8723b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal);
1990                 /*  when coex force to enter LPS, do not enter 32k low power. */
1991                 bLowPwrDisable = true;
1992                 pBtCoexist->fBtcSet(
1993                         pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable
1994                 );
1995                 /*  power save must executed before psTdma. */
1996                 pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL);
1997                 pCoexSta->bForceLpsOn = true;
1998                 break;
1999         case BTC_PS_LPS_OFF:
2000                 halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, false);
2001                 pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL);
2002                 pCoexSta->bForceLpsOn = false;
2003                 break;
2004         default:
2005                 break;
2006         }
2007 }
2008
2009 /*  */
2010 /*  */
2011 /*      Software Coex Mechanism start */
2012 /*  */
2013 /*  */
2014
2015 /*  */
2016 /*  */
2017 /*      Non-Software Coex Mechanism start */
2018 /*  */
2019 /*  */
2020 static void halbtc8723b1ant_ActionWifiMultiPort(PBTC_COEXIST pBtCoexist)
2021 {
2022         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2023
2024         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2025         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2026 }
2027
2028 static void halbtc8723b1ant_ActionHs(PBTC_COEXIST pBtCoexist)
2029 {
2030         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5);
2031         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2032 }
2033
2034 static void halbtc8723b1ant_ActionBtInquiry(PBTC_COEXIST pBtCoexist)
2035 {
2036         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2037         bool bWifiConnected = false;
2038         bool bApEnable = false;
2039         bool bWifiBusy = false;
2040         bool bBtBusy = false;
2041
2042         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
2043         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
2044         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2045         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);
2046
2047         if (!bWifiConnected && !pCoexSta->bWiFiIsHighPriTask) {
2048                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2049                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2050
2051                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
2052         } else if (
2053                 pBtLinkInfo->bScoExist ||
2054                 pBtLinkInfo->bHidExist ||
2055                 pBtLinkInfo->bA2dpExist
2056         ) {
2057                 /*  SCO/HID/A2DP busy */
2058                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2059                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2060
2061                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2062         } else if (pBtLinkInfo->bPanExist || bWifiBusy) {
2063                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2064                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2065
2066                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2067         } else {
2068                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2069                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2070
2071                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2072         }
2073 }
2074
2075 static void halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2076         PBTC_COEXIST pBtCoexist, u8 wifiStatus
2077 )
2078 {
2079         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2080         bool bWifiConnected = false;
2081
2082         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
2083
2084         /*  tdma and coex table */
2085
2086         if (pBtLinkInfo->bScoExist) {
2087                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5);
2088                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);
2089         } else { /* HID */
2090                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6);
2091                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);
2092         }
2093 }
2094
2095 static void halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2096         PBTC_COEXIST pBtCoexist, u8 wifiStatus
2097 )
2098 {
2099         u8 btRssiState;
2100
2101         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2102         btRssiState = halbtc8723b1ant_BtRssiState(2, 28, 0);
2103
2104         if ((pCoexSta->lowPriorityRx >= 1000) && (pCoexSta->lowPriorityRx != 65535))
2105                 pBtLinkInfo->bSlaveRole = true;
2106         else
2107                 pBtLinkInfo->bSlaveRole = false;
2108
2109         if (pBtLinkInfo->bHidOnly) { /* HID */
2110                 halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus);
2111                 pCoexDm->bAutoTdmaAdjust = false;
2112                 return;
2113         } else if (pBtLinkInfo->bA2dpOnly) { /* A2DP */
2114                 if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) {
2115                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2116                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2117                         pCoexDm->bAutoTdmaAdjust = false;
2118                 } else {
2119                         halbtc8723b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus);
2120                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2121                         pCoexDm->bAutoTdmaAdjust = true;
2122                 }
2123         } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) { /* HID+A2DP */
2124                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14);
2125                 pCoexDm->bAutoTdmaAdjust = false;
2126
2127                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2128         } else if (
2129                 pBtLinkInfo->bPanOnly ||
2130                 (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist)
2131         ) { /* PAN(OPP, FTP), HID+PAN(OPP, FTP) */
2132                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3);
2133                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2134                 pCoexDm->bAutoTdmaAdjust = false;
2135         } else if (
2136                 (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) ||
2137                 (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist)
2138         ) { /* A2DP+PAN(OPP, FTP), HID+A2DP+PAN(OPP, FTP) */
2139                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13);
2140                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2141                 pCoexDm->bAutoTdmaAdjust = false;
2142         } else {
2143                 /* BT no-profile busy (0x9) */
2144                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2145                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2146                 pCoexDm->bAutoTdmaAdjust = false;
2147         }
2148 }
2149
2150 static void halbtc8723b1ant_ActionWifiNotConnected(PBTC_COEXIST pBtCoexist)
2151 {
2152         /*  power save state */
2153         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2154
2155         /*  tdma and coex table */
2156         halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8);
2157         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
2158 }
2159
2160 static void halbtc8723b1ant_ActionWifiNotConnectedScan(
2161         PBTC_COEXIST pBtCoexist
2162 )
2163 {
2164         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2165
2166         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2167
2168         /*  tdma and coex table */
2169         if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2170                 if (pBtLinkInfo->bA2dpExist) {
2171                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2172                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2173                 } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) {
2174                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22);
2175                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2176                 } else {
2177                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2178                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2179                 }
2180         } else if (
2181                 (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2182                 (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2183         ) {
2184                 halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2185                         pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN
2186                 );
2187         } else {
2188                 /* Bryant Add */
2189                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2190                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2191         }
2192 }
2193
2194 static void halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(
2195         PBTC_COEXIST pBtCoexist
2196 )
2197 {
2198         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2199
2200         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2201
2202         /*  tdma and coex table */
2203         if (
2204                 (pBtLinkInfo->bScoExist) ||
2205                 (pBtLinkInfo->bHidExist) ||
2206                 (pBtLinkInfo->bA2dpExist)
2207         ) {
2208                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2209                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2210         } else if (pBtLinkInfo->bPanExist) {
2211                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2212                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2213         } else {
2214                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2215                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2216         }
2217 }
2218
2219 static void halbtc8723b1ant_ActionWifiConnectedScan(PBTC_COEXIST pBtCoexist)
2220 {
2221         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2222
2223         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2224
2225         /*  tdma and coex table */
2226         if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2227                 if (pBtLinkInfo->bA2dpExist) {
2228                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2229                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2230                 } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) {
2231                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22);
2232                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2233                 } else {
2234                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2235                         halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2236                 }
2237         } else if (
2238                 (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2239                 (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2240         ) {
2241                 halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2242                         pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN
2243                 );
2244         } else {
2245                 /* Bryant Add */
2246                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2247                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2248         }
2249 }
2250
2251 static void halbtc8723b1ant_ActionWifiConnectedSpecialPacket(
2252         PBTC_COEXIST pBtCoexist
2253 )
2254 {
2255         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2256
2257         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2258
2259         /*  tdma and coex table */
2260         if (
2261                 (pBtLinkInfo->bScoExist) ||
2262                 (pBtLinkInfo->bHidExist) ||
2263                 (pBtLinkInfo->bA2dpExist)
2264         ) {
2265                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2266                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2267         } else if (pBtLinkInfo->bPanExist) {
2268                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2269                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2270         } else {
2271                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2272                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2273         }
2274 }
2275
2276 static void halbtc8723b1ant_ActionWifiConnected(PBTC_COEXIST pBtCoexist)
2277 {
2278         bool bWifiBusy = false;
2279         bool bScan = false, bLink = false, bRoam = false;
2280         bool bUnder4way = false, bApEnable = false;
2281
2282         BTC_PRINT(
2283                 BTC_MSG_ALGORITHM,
2284                 ALGO_TRACE,
2285                 ("[BTCoex], CoexForWifiConnect() ===>\n")
2286         );
2287
2288         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way);
2289         if (bUnder4way) {
2290                 halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
2291                 BTC_PRINT(
2292                         BTC_MSG_ALGORITHM,
2293                         ALGO_TRACE,
2294                         ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")
2295                 );
2296                 return;
2297         }
2298
2299         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2300         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2301         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2302         if (bScan || bLink || bRoam) {
2303                 if (bScan)
2304                         halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);
2305                 else
2306                         halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
2307                 BTC_PRINT(
2308                         BTC_MSG_ALGORITHM,
2309                         ALGO_TRACE,
2310                         ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")
2311                 );
2312                 return;
2313         }
2314
2315         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
2316         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2317
2318         /*  power save state */
2319         if (
2320                 !bApEnable &&
2321                 BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus &&
2322                 !pBtCoexist->btLinkInfo.bHidOnly
2323         ) {
2324                 if (pBtCoexist->btLinkInfo.bA2dpOnly) { /* A2DP */
2325                         if (!bWifiBusy)
2326                                 halbtc8723b1ant_PowerSaveState(
2327                                         pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0
2328                                 );
2329                         else { /* busy */
2330                                 if  (pCoexSta->nScanAPNum >= BT_8723B_1ANT_WIFI_NOISY_THRESH)  /* no force LPS, no PS-TDMA, use pure TDMA */
2331                                         halbtc8723b1ant_PowerSaveState(
2332                                                 pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0
2333                                         );
2334                                 else
2335                                         halbtc8723b1ant_PowerSaveState(
2336                                                 pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4
2337                                         );
2338                         }
2339                 } else if (
2340                         (pCoexSta->bPanExist == false) &&
2341                         (pCoexSta->bA2dpExist == false) &&
2342                         (pCoexSta->bHidExist == false)
2343                 )
2344                         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2345                 else
2346                         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4);
2347         } else
2348                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2349
2350         /*  tdma and coex table */
2351         if (!bWifiBusy) {
2352                 if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2353                         halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2354                                 pBtCoexist,
2355                                 BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE
2356                         );
2357                 } else if (
2358                         (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2359                         (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2360                 ) {
2361                         halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,
2362                                 BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);
2363                 } else {
2364                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2365
2366                         if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60)
2367                                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2368                         else
2369                                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2370                 }
2371         } else {
2372                 if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2373                         halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2374                                 pBtCoexist,
2375                                 BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY
2376                         );
2377                 } else if (
2378                         (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2379                         (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2380                 ) {
2381                         halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2382                                 pBtCoexist,
2383                                 BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY
2384                         );
2385                 } else {
2386                         halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2387
2388                         if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60)
2389                                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2390                         else
2391                                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2392                 }
2393         }
2394 }
2395
2396 static void halbtc8723b1ant_RunSwCoexistMechanism(PBTC_COEXIST pBtCoexist)
2397 {
2398         u8 algorithm = 0;
2399
2400         algorithm = halbtc8723b1ant_ActionAlgorithm(pBtCoexist);
2401         pCoexDm->curAlgorithm = algorithm;
2402
2403         if (halbtc8723b1ant_IsCommonAction(pBtCoexist)) {
2404
2405         } else {
2406                 switch (pCoexDm->curAlgorithm) {
2407                 case BT_8723B_1ANT_COEX_ALGO_SCO:
2408                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = SCO.\n"));
2409                         /* halbtc8723b1ant_ActionSco(pBtCoexist); */
2410                         break;
2411                 case BT_8723B_1ANT_COEX_ALGO_HID:
2412                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID.\n"));
2413                         /* halbtc8723b1ant_ActionHid(pBtCoexist); */
2414                         break;
2415                 case BT_8723B_1ANT_COEX_ALGO_A2DP:
2416                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP.\n"));
2417                         /* halbtc8723b1ant_ActionA2dp(pBtCoexist); */
2418                         break;
2419                 case BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS:
2420                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n"));
2421                         /* halbtc8723b1ant_ActionA2dpPanHs(pBtCoexist); */
2422                         break;
2423                 case BT_8723B_1ANT_COEX_ALGO_PANEDR:
2424                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR).\n"));
2425                         /* halbtc8723b1ant_ActionPanEdr(pBtCoexist); */
2426                         break;
2427                 case BT_8723B_1ANT_COEX_ALGO_PANHS:
2428                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HS mode.\n"));
2429                         /* halbtc8723b1ant_ActionPanHs(pBtCoexist); */
2430                         break;
2431                 case BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP:
2432                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN+A2DP.\n"));
2433                         /* halbtc8723b1ant_ActionPanEdrA2dp(pBtCoexist); */
2434                         break;
2435                 case BT_8723B_1ANT_COEX_ALGO_PANEDR_HID:
2436                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n"));
2437                         /* halbtc8723b1ant_ActionPanEdrHid(pBtCoexist); */
2438                         break;
2439                 case BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR:
2440                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n"));
2441                         /* halbtc8723b1ant_ActionHidA2dpPanEdr(pBtCoexist); */
2442                         break;
2443                 case BT_8723B_1ANT_COEX_ALGO_HID_A2DP:
2444                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP.\n"));
2445                         /* halbtc8723b1ant_ActionHidA2dp(pBtCoexist); */
2446                         break;
2447                 default:
2448                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = coexist All Off!!\n"));
2449                         break;
2450                 }
2451                 pCoexDm->preAlgorithm = pCoexDm->curAlgorithm;
2452         }
2453 }
2454
2455 static void halbtc8723b1ant_RunCoexistMechanism(PBTC_COEXIST pBtCoexist)
2456 {
2457         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2458         bool bWifiConnected = false, bBtHsOn = false;
2459         bool bIncreaseScanDevNum = false;
2460         bool bBtCtrlAggBufSize = false;
2461         u8 aggBufSize = 5;
2462         u32 wifiLinkStatus = 0;
2463         u32 numOfWifiLink = 0;
2464
2465         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism() ===>\n"));
2466
2467         if (pBtCoexist->bManualControl) {
2468                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"));
2469                 return;
2470         }
2471
2472         if (pBtCoexist->bStopCoexDm) {
2473                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"));
2474                 return;
2475         }
2476
2477         if (pCoexSta->bUnderIps) {
2478                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is under IPS !!!\n"));
2479                 return;
2480         }
2481
2482         if (
2483                 (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||
2484                 (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2485                 (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2486         ){
2487                 bIncreaseScanDevNum = true;
2488         }
2489
2490         pBtCoexist->fBtcSet(
2491                 pBtCoexist,
2492                 BTC_SET_BL_INC_SCAN_DEV_NUM,
2493                 &bIncreaseScanDevNum
2494         );
2495         pBtCoexist->fBtcGet(
2496                 pBtCoexist,
2497                 BTC_GET_BL_WIFI_CONNECTED,
2498                 &bWifiConnected
2499         );
2500
2501         pBtCoexist->fBtcGet(
2502                 pBtCoexist,
2503                 BTC_GET_U4_WIFI_LINK_STATUS,
2504                 &wifiLinkStatus
2505         );
2506         numOfWifiLink = wifiLinkStatus>>16;
2507
2508         if ((numOfWifiLink >= 2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) {
2509                 BTC_PRINT(
2510                         BTC_MSG_INTERFACE,
2511                         INTF_NOTIFY,
2512                         (
2513                                 "############# [BTCoex],  Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n",
2514                                 numOfWifiLink,
2515                                 wifiLinkStatus
2516                         )
2517                 );
2518                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
2519                 halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize);
2520
2521                 if ((pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage)) {
2522                         BTC_PRINT(
2523                                 BTC_MSG_INTERFACE,
2524                                 INTF_NOTIFY,
2525                                 ("############# [BTCoex],  BT Is Inquirying\n")
2526                         );
2527                         halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
2528                 } else
2529                         halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
2530
2531                 return;
2532         }
2533
2534         if ((pBtLinkInfo->bBtLinkExist) && (bWifiConnected)) {
2535                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1);
2536
2537                 if (pBtLinkInfo->bScoExist)
2538                         halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x5);
2539                 else
2540                         halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x8);
2541
2542                 halbtc8723b1ant_SwMechanism(pBtCoexist, true);
2543                 halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist);  /* just print debug message */
2544         } else {
2545                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
2546
2547                 halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x5);
2548
2549                 halbtc8723b1ant_SwMechanism(pBtCoexist, false);
2550                 halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); /* just print debug message */
2551         }
2552
2553         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
2554         if (pCoexSta->bC2hBtInquiryPage) {
2555                 BTC_PRINT(
2556                         BTC_MSG_INTERFACE,
2557                         INTF_NOTIFY,
2558                         ("############# [BTCoex],  BT Is Inquirying\n")
2559                 );
2560                 halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
2561                 return;
2562         } else if (bBtHsOn) {
2563                 halbtc8723b1ant_ActionHs(pBtCoexist);
2564                 return;
2565         }
2566
2567
2568         if (!bWifiConnected) {
2569                 bool bScan = false, bLink = false, bRoam = false;
2570
2571                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is non connected-idle !!!\n"));
2572
2573                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2574                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2575                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2576
2577                 if (bScan || bLink || bRoam) {
2578                          if (bScan)
2579                                 halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist);
2580                          else
2581                                 halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);
2582                 } else
2583                         halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
2584         } else /*  wifi LPS/Busy */
2585                 halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
2586 }
2587
2588 static void halbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist)
2589 {
2590         /*  force to reset coex mechanism */
2591
2592         /*  sw all off */
2593         halbtc8723b1ant_SwMechanism(pBtCoexist, false);
2594
2595         /* halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8); */
2596         halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);
2597
2598         pCoexSta->popEventCnt = 0;
2599 }
2600
2601 static void halbtc8723b1ant_InitHwConfig(
2602         PBTC_COEXIST pBtCoexist,
2603         bool bBackUp,
2604         bool bWifiOnly
2605 )
2606 {
2607         u32 u4Tmp = 0;/*  fwVer; */
2608         u8 u1Tmpa = 0, u1Tmpb = 0;
2609
2610         BTC_PRINT(
2611                 BTC_MSG_INTERFACE,
2612                 INTF_INIT,
2613                 ("[BTCoex], 1Ant Init HW Config!!\n")
2614         );
2615
2616         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1);  /* enable TBTT nterrupt */
2617
2618         /*  0x790[5:0]= 0x5 */
2619         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5);
2620
2621         /*  Enable counter statistics */
2622         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1);
2623         pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1);
2624
2625         /* Antenna config */
2626         if (bWifiOnly) {
2627                 halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, true, false);
2628                 halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 9);
2629         } else
2630                 halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, true, false);
2631
2632         /*  PTA parameter */
2633         halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);
2634
2635         u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
2636         u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);
2637         u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
2638
2639         BTC_PRINT(
2640                 BTC_MSG_INTERFACE,
2641                 INTF_NOTIFY,
2642                 (
2643                         "############# [BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n",
2644                         u4Tmp,
2645                         u1Tmpa,
2646                         u1Tmpb
2647                 )
2648         );
2649 }
2650
2651 /*  */
2652 /*  work around function start with wa_halbtc8723b1ant_ */
2653 /*  */
2654 /*  */
2655 /*  extern function start with EXhalbtc8723b1ant_ */
2656 /*  */
2657 void EXhalbtc8723b1ant_PowerOnSetting(PBTC_COEXIST pBtCoexist)
2658 {
2659         PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
2660         u8 u1Tmp = 0x0;
2661         u16 u2Tmp = 0x0;
2662
2663         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20);
2664
2665         /*  enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */
2666         u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2);
2667         pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1);
2668
2669         /*  set GRAN_BT = 1 */
2670         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
2671         /*  set WLAN_ACT = 0 */
2672         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
2673
2674         /*  */
2675         /*  S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */
2676         /*  Local setting bit define */
2677         /*      BIT0: "0" for no antenna inverse; "1" for antenna inverse */
2678         /*      BIT1: "0" for internal switch; "1" for external switch */
2679         /*      BIT2: "0" for one antenna; "1" for two antenna */
2680         /*  NOTE: here default all internal switch and 1-antenna ==> BIT1 = 0 and BIT2 = 0 */
2681         if (pBtCoexist->chipInterface == BTC_INTF_USB) {
2682                 /*  fixed at S0 for USB interface */
2683                 pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
2684
2685                 u1Tmp |= 0x1;   /*  antenna inverse */
2686                 pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp);
2687
2688                 pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;
2689         } else {
2690                 /*  for PCIE and SDIO interface, we check efuse 0xc3[6] */
2691                 if (pBoardInfo->singleAntPath == 0) {
2692                         /*  set to S1 */
2693                         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
2694                         pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT;
2695                 } else if (pBoardInfo->singleAntPath == 1) {
2696                         /*  set to S0 */
2697                         pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
2698                         u1Tmp |= 0x1;   /*  antenna inverse */
2699                         pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;
2700                 }
2701
2702                 if (pBtCoexist->chipInterface == BTC_INTF_PCI)
2703                         pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp);
2704                 else if (pBtCoexist->chipInterface == BTC_INTF_SDIO)
2705                         pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp);
2706         }
2707 }
2708
2709 void EXhalbtc8723b1ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly)
2710 {
2711         halbtc8723b1ant_InitHwConfig(pBtCoexist, true, bWifiOnly);
2712 }
2713
2714 void EXhalbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist)
2715 {
2716         BTC_PRINT(
2717                 BTC_MSG_INTERFACE,
2718                 INTF_INIT,
2719                 ("[BTCoex], Coex Mechanism Init!!\n")
2720         );
2721
2722         pBtCoexist->bStopCoexDm = false;
2723
2724         halbtc8723b1ant_InitCoexDm(pBtCoexist);
2725
2726         halbtc8723b1ant_QueryBtInfo(pBtCoexist);
2727 }
2728
2729 void EXhalbtc8723b1ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist)
2730 {
2731         PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
2732         PBTC_STACK_INFO pStackInfo = &pBtCoexist->stackInfo;
2733         PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2734         u8 *cliBuf = pBtCoexist->cliBuf;
2735         u8 u1Tmp[4], i, btInfoExt, psTdmaCase = 0;
2736         u16 u2Tmp[4];
2737         u32 u4Tmp[4];
2738         bool bRoam = false;
2739         bool bScan = false;
2740         bool bLink = false;
2741         bool bWifiUnder5G = false;
2742         bool bWifiUnderBMode = false;
2743         bool bBtHsOn = false;
2744         bool bWifiBusy = false;
2745         s32 wifiRssi = 0, btHsRssi = 0;
2746         u32 wifiBw, wifiTrafficDir, faOfdm, faCck, wifiLinkStatus;
2747         u8 wifiDot11Chnl, wifiHsChnl;
2748         u32 fwVer = 0, btPatchVer = 0;
2749         static u8 PopReportIn10s;
2750
2751         CL_SPRINTF(
2752                 cliBuf,
2753                 BT_TMP_BUF_SIZE,
2754                 "\r\n ============[BT Coexist info]============"
2755         );
2756         CL_PRINTF(cliBuf);
2757
2758         if (pBtCoexist->bManualControl) {
2759                 CL_SPRINTF(
2760                         cliBuf,
2761                         BT_TMP_BUF_SIZE,
2762                         "\r\n ============[Under Manual Control]============"
2763                 );
2764                 CL_PRINTF(cliBuf);
2765                 CL_SPRINTF(cliBuf,
2766                         BT_TMP_BUF_SIZE,
2767                         "\r\n =========================================="
2768                 );
2769                 CL_PRINTF(cliBuf);
2770         }
2771         if (pBtCoexist->bStopCoexDm) {
2772                 CL_SPRINTF(
2773                         cliBuf,
2774                         BT_TMP_BUF_SIZE,
2775                         "\r\n ============[Coex is STOPPED]============"
2776                 );
2777                 CL_PRINTF(cliBuf);
2778                 CL_SPRINTF(
2779                         cliBuf,
2780                         BT_TMP_BUF_SIZE,
2781                         "\r\n =========================================="
2782                 );
2783                 CL_PRINTF(cliBuf);
2784         }
2785
2786         CL_SPRINTF(
2787                 cliBuf,
2788                 BT_TMP_BUF_SIZE,
2789                 "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Ant Mech/ Ant Pos:", \
2790                 pBoardInfo->pgAntNum,
2791                 pBoardInfo->btdmAntNum,
2792                 pBoardInfo->btdmAntPos
2793         );
2794         CL_PRINTF(cliBuf);
2795
2796         CL_SPRINTF(
2797                 cliBuf,
2798                 BT_TMP_BUF_SIZE,
2799                 "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \
2800                 ((pStackInfo->bProfileNotified) ? "Yes" : "No"),
2801                 pStackInfo->hciVersion
2802         );
2803         CL_PRINTF(cliBuf);
2804
2805         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);
2806         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);
2807         CL_SPRINTF(
2808                 cliBuf,
2809                 BT_TMP_BUF_SIZE,
2810                 "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \
2811                 GLCoexVerDate8723b1Ant,
2812                 GLCoexVer8723b1Ant,
2813                 fwVer,
2814                 btPatchVer,
2815                 btPatchVer
2816         );
2817         CL_PRINTF(cliBuf);
2818
2819         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
2820         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiDot11Chnl);
2821         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_HS_CHNL, &wifiHsChnl);
2822         CL_SPRINTF(
2823                 cliBuf,
2824                 BT_TMP_BUF_SIZE,
2825                 "\r\n %-35s = %d / %d(%d)", "Dot11 channel / HsChnl(HsMode)", \
2826                 wifiDot11Chnl,
2827                 wifiHsChnl,
2828                 bBtHsOn
2829         );
2830         CL_PRINTF(cliBuf);
2831
2832         CL_SPRINTF(
2833                 cliBuf,
2834                 BT_TMP_BUF_SIZE,
2835                 "\r\n %-35s = %02x %02x %02x ", "H2C Wifi inform bt chnl Info", \
2836                 pCoexDm->wifiChnlInfo[0],
2837                 pCoexDm->wifiChnlInfo[1],
2838                 pCoexDm->wifiChnlInfo[2]
2839         );
2840         CL_PRINTF(cliBuf);
2841
2842         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);
2843         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi);
2844         CL_SPRINTF(
2845                 cliBuf,
2846                 BT_TMP_BUF_SIZE,
2847                 "\r\n %-35s = %d/ %d", "Wifi rssi/ HS rssi", \
2848                 wifiRssi-100, btHsRssi-100
2849         );
2850         CL_PRINTF(cliBuf);
2851
2852         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2853         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2854         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2855         CL_SPRINTF(
2856                 cliBuf,
2857                 BT_TMP_BUF_SIZE,
2858                 "\r\n %-35s = %d/ %d/ %d/ %s", "Wifi bLink/ bRoam/ bScan/ bHi-Pri", \
2859                 bLink, bRoam, bScan, ((pCoexSta->bWiFiIsHighPriTask) ? "1" : "0")
2860         );
2861         CL_PRINTF(cliBuf);
2862
2863         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G);
2864         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);
2865         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2866         pBtCoexist->fBtcGet(
2867                 pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir
2868         );
2869         pBtCoexist->fBtcGet(
2870                 pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
2871         );
2872
2873         CL_SPRINTF(
2874                 cliBuf,
2875                 BT_TMP_BUF_SIZE,
2876                 "\r\n %-35s = %s / %s/ %s/ AP =%d/ %s ", "Wifi status", \
2877                 (bWifiUnder5G ? "5G" : "2.4G"),
2878                 ((bWifiUnderBMode) ? "11b" : ((BTC_WIFI_BW_LEGACY == wifiBw) ? "11bg" : (((BTC_WIFI_BW_HT40 == wifiBw) ? "HT40" : "HT20")))),
2879                 ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")),
2880                 pCoexSta->nScanAPNum,
2881                 (pCoexSta->bCCKLock) ? "Lock" : "noLock"
2882         );
2883         CL_PRINTF(cliBuf);
2884
2885         pBtCoexist->fBtcGet(
2886                 pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus
2887         );
2888         CL_SPRINTF(
2889                 cliBuf,
2890                 BT_TMP_BUF_SIZE,
2891                 "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "sta/vwifi/hs/p2pGo/p2pGc", \
2892                 ((wifiLinkStatus&WIFI_STA_CONNECTED) ? 1 : 0),
2893                 ((wifiLinkStatus&WIFI_AP_CONNECTED) ? 1 : 0),
2894                 ((wifiLinkStatus&WIFI_HS_CONNECTED) ? 1 : 0),
2895                 ((wifiLinkStatus&WIFI_P2P_GO_CONNECTED) ? 1 : 0),
2896                 ((wifiLinkStatus&WIFI_P2P_GC_CONNECTED) ? 1 : 0)
2897         );
2898         CL_PRINTF(cliBuf);
2899
2900
2901         PopReportIn10s++;
2902         CL_SPRINTF(
2903                 cliBuf,
2904                 BT_TMP_BUF_SIZE,
2905                 "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \
2906                 ((pBtCoexist->btInfo.bBtDisabled) ? ("disabled") : ((pCoexSta->bC2hBtInquiryPage) ? ("inquiry/page scan") : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ? "non-connected idle" :
2907                 ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ? "connected-idle" : "busy")))),
2908                 pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt
2909         );
2910         CL_PRINTF(cliBuf);
2911
2912         if (PopReportIn10s >= 5) {
2913                 pCoexSta->popEventCnt = 0;
2914                 PopReportIn10s = 0;
2915         }
2916
2917
2918         CL_SPRINTF(
2919                 cliBuf,
2920                 BT_TMP_BUF_SIZE,
2921                 "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \
2922                 pBtLinkInfo->bScoExist,
2923                 pBtLinkInfo->bHidExist,
2924                 pBtLinkInfo->bPanExist,
2925                 pBtLinkInfo->bA2dpExist
2926         );
2927         CL_PRINTF(cliBuf);
2928
2929         if (pStackInfo->bProfileNotified) {
2930                 pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO);
2931         } else {
2932                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \
2933                 (pBtLinkInfo->bSlaveRole) ? "Slave" : "Master");
2934                 CL_PRINTF(cliBuf);
2935         }
2936
2937
2938         btInfoExt = pCoexSta->btInfoExt;
2939         CL_SPRINTF(
2940                 cliBuf,
2941                 BT_TMP_BUF_SIZE,
2942                 "\r\n %-35s = %s", "BT Info A2DP rate", \
2943                 (btInfoExt&BIT0) ? "Basic rate" : "EDR rate"
2944         );
2945         CL_PRINTF(cliBuf);
2946
2947         for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) {
2948                 if (pCoexSta->btInfoC2hCnt[i]) {
2949                         CL_SPRINTF(
2950                                 cliBuf,
2951                                 BT_TMP_BUF_SIZE,
2952                                 "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b1Ant[i], \
2953                                 pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1],
2954                                 pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3],
2955                                 pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5],
2956                                 pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]
2957                         );
2958                         CL_PRINTF(cliBuf);
2959                 }
2960         }
2961         CL_SPRINTF(
2962                 cliBuf,
2963                 BT_TMP_BUF_SIZE,
2964                 "\r\n %-35s = %s/%s, (0x%x/0x%x)", "PS state, IPS/LPS, (lps/rpwm)", \
2965                 (pCoexSta->bUnderIps ? "IPS ON" : "IPS OFF"),
2966                 (pCoexSta->bUnderLps ? "LPS ON" : "LPS OFF"),
2967                 pBtCoexist->btInfo.lpsVal,
2968                 pBtCoexist->btInfo.rpwmVal
2969         );
2970         CL_PRINTF(cliBuf);
2971         pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_FW_PWR_MODE_CMD);
2972
2973         if (!pBtCoexist->bManualControl) {
2974                 /*  Sw mechanism */
2975                 CL_SPRINTF(
2976                         cliBuf,
2977                         BT_TMP_BUF_SIZE,
2978                         "\r\n %-35s", "============[Sw mechanism]============"
2979                 );
2980                 CL_PRINTF(cliBuf);
2981
2982                 CL_SPRINTF(
2983                         cliBuf,
2984                         BT_TMP_BUF_SIZE,
2985                         "\r\n %-35s = %d", "SM[LowPenaltyRA]", \
2986                         pCoexDm->bCurLowPenaltyRa
2987                 );
2988                 CL_PRINTF(cliBuf);
2989
2990                 CL_SPRINTF(
2991                         cliBuf,
2992                         BT_TMP_BUF_SIZE,
2993                         "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \
2994                         (pBtCoexist->btInfo.bRejectAggPkt ? "Yes" : "No"),
2995                         (pBtCoexist->btInfo.bBtCtrlAggBufSize ? "Yes" : "No"),
2996                         pBtCoexist->btInfo.aggBufSize
2997                 );
2998                 CL_PRINTF(cliBuf);
2999                 CL_SPRINTF(
3000                         cliBuf,
3001                         BT_TMP_BUF_SIZE,
3002                         "\r\n %-35s = 0x%x ", "Rate Mask", \
3003                         pBtCoexist->btInfo.raMask
3004                 );
3005                 CL_PRINTF(cliBuf);
3006
3007                 /*  Fw mechanism */
3008                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============");
3009                 CL_PRINTF(cliBuf);
3010
3011                 psTdmaCase = pCoexDm->curPsTdma;
3012                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \
3013                         pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1],
3014                         pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3],
3015                         pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust);
3016                 CL_PRINTF(cliBuf);
3017
3018                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \
3019                         pCoexSta->nCoexTableType);
3020                 CL_PRINTF(cliBuf);
3021
3022                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "IgnWlanAct", \
3023                         pCoexDm->bCurIgnoreWlanAct);
3024                 CL_PRINTF(cliBuf);
3025
3026                 /*
3027                 CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \
3028                         pCoexDm->errorCondition);
3029                 CL_PRINTF(cliBuf);
3030                 */
3031         }
3032
3033         /*  Hw setting */
3034         CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============");
3035         CL_PRINTF(cliBuf);
3036
3037         CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \
3038                 pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime);
3039         CL_PRINTF(cliBuf);
3040
3041         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);
3042         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);
3043         u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);
3044         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);
3045         CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \
3046                 u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]);
3047         CL_PRINTF(cliBuf);
3048
3049         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778);
3050         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc);
3051         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880);
3052         CL_SPRINTF(
3053                 cliBuf, BT_TMP_BUF_SIZE,
3054                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/0x880[29:25]", \
3055                 u1Tmp[0], u4Tmp[0],  (u4Tmp[1]&0x3e000000) >> 25
3056         );
3057         CL_PRINTF(cliBuf);
3058
3059         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
3060         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
3061         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x764);
3062         u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e);
3063         CL_SPRINTF(
3064                 cliBuf,
3065                 BT_TMP_BUF_SIZE,
3066                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x764 / 0x76e", \
3067                 u4Tmp[0], ((u1Tmp[0]&0x20) >> 5), (u4Tmp[1] & 0xffff), u1Tmp[1]
3068         );
3069         CL_PRINTF(cliBuf);
3070
3071         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c);
3072         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930);
3073         u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944);
3074         CL_SPRINTF(
3075                 cliBuf,
3076                 BT_TMP_BUF_SIZE,
3077                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \
3078                 u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3
3079         );
3080         CL_PRINTF(cliBuf);
3081
3082         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39);
3083         u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40);
3084         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
3085         u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64);
3086         CL_SPRINTF(
3087                 cliBuf,
3088                 BT_TMP_BUF_SIZE,
3089                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \
3090                 ((u1Tmp[0] & 0x8)>>3),
3091                 u1Tmp[1],
3092                 ((u4Tmp[0]&0x01800000)>>23),
3093                 u1Tmp[2]&0x1
3094         );
3095         CL_PRINTF(cliBuf);
3096
3097         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550);
3098         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522);
3099         CL_SPRINTF(
3100                 cliBuf,
3101                 BT_TMP_BUF_SIZE,
3102                 "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \
3103                 u4Tmp[0], u1Tmp[0]
3104         );
3105         CL_PRINTF(cliBuf);
3106
3107         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50);
3108         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c);
3109         CL_SPRINTF(
3110                 cliBuf,
3111                 BT_TMP_BUF_SIZE,
3112                 "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \
3113                 u4Tmp[0]&0xff, u1Tmp[0]
3114         );
3115         CL_PRINTF(cliBuf);
3116
3117         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0);
3118         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4);
3119         u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8);
3120         u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0);
3121
3122         u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b);
3123         u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c);
3124
3125         faOfdm =
3126                 ((u4Tmp[0]&0xffff0000) >> 16) +
3127                 ((u4Tmp[1]&0xffff0000) >> 16) +
3128                 (u4Tmp[1] & 0xffff) +  (u4Tmp[2] & 0xffff) + \
3129                 ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff);
3130         faCck = (u1Tmp[0] << 8) + u1Tmp[1];
3131
3132         CL_SPRINTF(
3133                 cliBuf,
3134                 BT_TMP_BUF_SIZE,
3135                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \
3136                 u4Tmp[0]&0xffff, faOfdm, faCck
3137         );
3138         CL_PRINTF(cliBuf);
3139
3140
3141         CL_SPRINTF(
3142                 cliBuf,
3143                 BT_TMP_BUF_SIZE,
3144                 "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \
3145                 pCoexSta->nCRCOK_CCK,
3146                 pCoexSta->nCRCOK_11g,
3147                 pCoexSta->nCRCOK_11n,
3148                 pCoexSta->nCRCOK_11nAgg
3149         );
3150         CL_PRINTF(cliBuf);
3151
3152         CL_SPRINTF(
3153                 cliBuf,
3154                 BT_TMP_BUF_SIZE,
3155                 "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \
3156                 pCoexSta->nCRCErr_CCK,
3157                 pCoexSta->nCRCErr_11g,
3158                 pCoexSta->nCRCErr_11n,
3159                 pCoexSta->nCRCErr_11nAgg
3160         );
3161         CL_PRINTF(cliBuf);
3162
3163         u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0);
3164         u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4);
3165         u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8);
3166         CL_SPRINTF(
3167                 cliBuf,
3168                 BT_TMP_BUF_SIZE,
3169                 "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \
3170                 u4Tmp[0], u4Tmp[1], u4Tmp[2]);
3171         CL_PRINTF(cliBuf);
3172
3173         CL_SPRINTF(
3174                 cliBuf,
3175                 BT_TMP_BUF_SIZE,
3176                 "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \
3177                 pCoexSta->highPriorityRx, pCoexSta->highPriorityTx
3178         );
3179         CL_PRINTF(cliBuf);
3180         CL_SPRINTF(
3181                 cliBuf,
3182                 BT_TMP_BUF_SIZE,
3183                 "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \
3184                 pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx
3185         );
3186         CL_PRINTF(cliBuf);
3187
3188         pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS);
3189 }
3190
3191
3192 void EXhalbtc8723b1ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type)
3193 {
3194         if (pBtCoexist->bManualControl ||       pBtCoexist->bStopCoexDm)
3195                 return;
3196
3197         if (BTC_IPS_ENTER == type) {
3198                 BTC_PRINT(
3199                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS ENTER notify\n")
3200                 );
3201                 pCoexSta->bUnderIps = true;
3202
3203                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
3204                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
3205                 halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3206         } else if (BTC_IPS_LEAVE == type) {
3207                 BTC_PRINT(
3208                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS LEAVE notify\n")
3209                 );
3210                 pCoexSta->bUnderIps = false;
3211
3212                 halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false);
3213                 halbtc8723b1ant_InitCoexDm(pBtCoexist);
3214                 halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3215         }
3216 }
3217
3218 void EXhalbtc8723b1ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type)
3219 {
3220         if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm)
3221                 return;
3222
3223         if (BTC_LPS_ENABLE == type) {
3224                 BTC_PRINT(
3225                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS ENABLE notify\n")
3226                 );
3227                 pCoexSta->bUnderLps = true;
3228         } else if (BTC_LPS_DISABLE == type) {
3229                 BTC_PRINT(
3230                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS DISABLE notify\n")
3231                 );
3232                 pCoexSta->bUnderLps = false;
3233         }
3234 }
3235
3236 void EXhalbtc8723b1ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type)
3237 {
3238         bool bWifiConnected = false, bBtHsOn = false;
3239         u32 wifiLinkStatus = 0;
3240         u32 numOfWifiLink = 0;
3241         bool bBtCtrlAggBufSize = false;
3242         u8 aggBufSize = 5;
3243
3244         u8 u1Tmpa, u1Tmpb;
3245         u32 u4Tmp;
3246
3247         if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm)
3248                 return;
3249
3250         if (BTC_SCAN_START == type) {
3251                 pCoexSta->bWiFiIsHighPriTask = true;
3252                 BTC_PRINT(
3253                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")
3254                 );
3255
3256                 halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8);  /* Force antenna setup for no scan result issue */
3257                 u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
3258                 u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);
3259                 u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
3260
3261
3262                 BTC_PRINT(
3263                         BTC_MSG_INTERFACE,
3264                         INTF_NOTIFY,
3265                         (
3266                                 "[BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n",
3267                                 u4Tmp,
3268                                 u1Tmpa,
3269                                 u1Tmpb
3270                         )
3271                 );
3272         } else {
3273                 pCoexSta->bWiFiIsHighPriTask = false;
3274                 BTC_PRINT(
3275                         BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")
3276                 );
3277
3278                 pBtCoexist->fBtcGet(
3279                         pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum
3280                 );
3281         }
3282
3283         if (pBtCoexist->btInfo.bBtDisabled)
3284                 return;
3285
3286         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3287         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3288
3289         halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3290
3291         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);
3292         numOfWifiLink = wifiLinkStatus>>16;
3293
3294         if (numOfWifiLink >= 2) {
3295                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3296                 halbtc8723b1ant_LimitedRx(
3297                         pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize
3298                 );
3299                 halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3300                 return;
3301         }
3302
3303         if (pCoexSta->bC2hBtInquiryPage) {
3304                 halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3305                 return;
3306         } else if (bBtHsOn) {
3307                 halbtc8723b1ant_ActionHs(pBtCoexist);
3308                 return;
3309         }
3310
3311         if (BTC_SCAN_START == type) {
3312                 /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")); */
3313                 if (!bWifiConnected)    /*  non-connected scan */
3314                         halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist);
3315                 else    /*  wifi is connected */
3316                         halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);
3317         } else if (BTC_SCAN_FINISH == type) {
3318                 /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")); */
3319                 if (!bWifiConnected)    /*  non-connected scan */
3320                         halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
3321                 else
3322                         halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
3323         }
3324 }
3325
3326 void EXhalbtc8723b1ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type)
3327 {
3328         bool bWifiConnected = false, bBtHsOn = false;
3329         u32 wifiLinkStatus = 0;
3330         u32 numOfWifiLink = 0;
3331         bool bBtCtrlAggBufSize = false;
3332         u8 aggBufSize = 5;
3333
3334         if (
3335                 pBtCoexist->bManualControl ||
3336                 pBtCoexist->bStopCoexDm ||
3337                 pBtCoexist->btInfo.bBtDisabled
3338         )
3339                 return;
3340
3341         if (BTC_ASSOCIATE_START == type) {
3342                 pCoexSta->bWiFiIsHighPriTask = true;
3343                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n"));
3344                  pCoexDm->nArpCnt = 0;
3345         } else {
3346                 pCoexSta->bWiFiIsHighPriTask = false;
3347                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n"));
3348                 /* pCoexDm->nArpCnt = 0; */
3349         }
3350
3351         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);
3352         numOfWifiLink = wifiLinkStatus>>16;
3353         if (numOfWifiLink >= 2) {
3354                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3355                 halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize);
3356                 halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3357                 return;
3358         }
3359
3360         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3361         if (pCoexSta->bC2hBtInquiryPage) {
3362                 halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3363                 return;
3364         } else if (bBtHsOn) {
3365                 halbtc8723b1ant_ActionHs(pBtCoexist);
3366                 return;
3367         }
3368
3369         if (BTC_ASSOCIATE_START == type) {
3370                 /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n")); */
3371                 halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);
3372         } else if (BTC_ASSOCIATE_FINISH == type) {
3373                 /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n")); */
3374
3375                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3376                 if (!bWifiConnected) /*  non-connected scan */
3377                         halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
3378                 else
3379                         halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
3380         }
3381 }
3382
3383 void EXhalbtc8723b1ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type)
3384 {
3385         u8 H2C_Parameter[3] = {0};
3386         u32 wifiBw;
3387         u8 wifiCentralChnl;
3388         bool bWifiUnderBMode = false;
3389
3390         if (
3391                 pBtCoexist->bManualControl ||
3392                 pBtCoexist->bStopCoexDm ||
3393                 pBtCoexist->btInfo.bBtDisabled
3394         )
3395                 return;
3396
3397         if (BTC_MEDIA_CONNECT == type) {
3398                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA connect notify\n"));
3399
3400                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode);
3401
3402                 /* Set CCK Tx/Rx high Pri except 11b mode */
3403                 if (bWifiUnderBMode) {
3404                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); /* CCK Tx */
3405                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); /* CCK Rx */
3406                 } else {
3407                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); /* CCK Tx */
3408                         pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); /* CCK Rx */
3409                 }
3410
3411                 pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);
3412                 pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);
3413                 pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);
3414                 pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);
3415         } else {
3416                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA disconnect notify\n"));
3417                 pCoexDm->nArpCnt = 0;
3418
3419                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); /* CCK Tx */
3420                 pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); /* CCK Rx */
3421         }
3422
3423         /*  only 2.4G we need to inform bt the chnl mask */
3424         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl);
3425         if ((BTC_MEDIA_CONNECT == type) && (wifiCentralChnl <= 14)) {
3426                 /* H2C_Parameter[0] = 0x1; */
3427                 H2C_Parameter[0] = 0x0;
3428                 H2C_Parameter[1] = wifiCentralChnl;
3429                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);
3430
3431                 if (BTC_WIFI_BW_HT40 == wifiBw)
3432                         H2C_Parameter[2] = 0x30;
3433                 else
3434                         H2C_Parameter[2] = 0x20;
3435         }
3436
3437         pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0];
3438         pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1];
3439         pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2];
3440
3441         BTC_PRINT(
3442                 BTC_MSG_ALGORITHM,
3443                 ALGO_TRACE_FW_EXEC,
3444                 (
3445                         "[BTCoex], FW write 0x66 = 0x%x\n",
3446                         H2C_Parameter[0]<<16 | H2C_Parameter[1]<<8 | H2C_Parameter[2]
3447                 )
3448         );
3449
3450         pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter);
3451 }
3452
3453 void EXhalbtc8723b1ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type)
3454 {
3455         bool bBtHsOn = false;
3456         u32 wifiLinkStatus = 0;
3457         u32 numOfWifiLink = 0;
3458         bool bBtCtrlAggBufSize = false;
3459         u8 aggBufSize = 5;
3460
3461         if (
3462                 pBtCoexist->bManualControl ||
3463                 pBtCoexist->bStopCoexDm ||
3464                 pBtCoexist->btInfo.bBtDisabled
3465         )
3466                 return;
3467
3468         if (
3469                 BTC_PACKET_DHCP == type ||
3470                 BTC_PACKET_EAPOL == type ||
3471                 BTC_PACKET_ARP == type
3472         ) {
3473                 if (BTC_PACKET_ARP == type) {
3474                         BTC_PRINT(
3475                                 BTC_MSG_INTERFACE,
3476                                 INTF_NOTIFY,
3477                                 ("[BTCoex], special Packet ARP notify\n")
3478                         );
3479
3480                         pCoexDm->nArpCnt++;
3481                         BTC_PRINT(
3482                                 BTC_MSG_INTERFACE,
3483                                 INTF_NOTIFY,
3484                                 ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)
3485                         );
3486
3487                         if (pCoexDm->nArpCnt >= 10) /*  if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) */
3488                                 pCoexSta->bWiFiIsHighPriTask = false;
3489                         else
3490                                 pCoexSta->bWiFiIsHighPriTask = true;
3491                 } else {
3492                         pCoexSta->bWiFiIsHighPriTask = true;
3493                         BTC_PRINT(
3494                                 BTC_MSG_INTERFACE,
3495                                 INTF_NOTIFY,
3496                                 ("[BTCoex], special Packet DHCP or EAPOL notify\n")
3497                         );
3498                 }
3499         } else {
3500                 pCoexSta->bWiFiIsHighPriTask = false;
3501                 BTC_PRINT(
3502                         BTC_MSG_INTERFACE,
3503                         INTF_NOTIFY,
3504                         ("[BTCoex], special Packet [Type = %d] notify\n", type)
3505                 );
3506         }
3507
3508         pCoexSta->specialPktPeriodCnt = 0;
3509
3510         pBtCoexist->fBtcGet(
3511                 pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus
3512         );
3513         numOfWifiLink = wifiLinkStatus>>16;
3514
3515         if (numOfWifiLink >= 2) {
3516                 halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3517                 halbtc8723b1ant_LimitedRx(
3518                         pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize
3519                 );
3520                 halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3521                 return;
3522         }
3523
3524         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3525         if (pCoexSta->bC2hBtInquiryPage) {
3526                 halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3527                 return;
3528         } else if (bBtHsOn) {
3529                 halbtc8723b1ant_ActionHs(pBtCoexist);
3530                 return;
3531         }
3532
3533         if (
3534                 BTC_PACKET_DHCP == type ||
3535                 BTC_PACKET_EAPOL == type ||
3536                 ((BTC_PACKET_ARP == type) && (pCoexSta->bWiFiIsHighPriTask))
3537         )
3538                 halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
3539 }
3540
3541 void EXhalbtc8723b1ant_BtInfoNotify(
3542         PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length
3543 )
3544 {
3545         u8 btInfo = 0;
3546         u8 i, rspSource = 0;
3547         bool bWifiConnected = false;
3548         bool bBtBusy = false;
3549
3550         pCoexSta->bC2hBtInfoReqSent = false;
3551
3552         rspSource = tmpBuf[0]&0xf;
3553         if (rspSource >= BT_INFO_SRC_8723B_1ANT_MAX)
3554                 rspSource = BT_INFO_SRC_8723B_1ANT_WIFI_FW;
3555         pCoexSta->btInfoC2hCnt[rspSource]++;
3556
3557         BTC_PRINT(
3558                 BTC_MSG_INTERFACE,
3559                 INTF_NOTIFY,
3560                 ("[BTCoex], Bt info[%d], length =%d, hex data =[",
3561                 rspSource,
3562                 length)
3563         );
3564         for (i = 0; i < length; i++) {
3565                 pCoexSta->btInfoC2h[rspSource][i] = tmpBuf[i];
3566                 if (i == 1)
3567                         btInfo = tmpBuf[i];
3568                 if (i == length-1)
3569                         BTC_PRINT(
3570                                 BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x]\n", tmpBuf[i])
3571                         );
3572                 else
3573                         BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x, ", tmpBuf[i]));
3574         }
3575
3576         if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rspSource) {
3577                 pCoexSta->btRetryCnt = pCoexSta->btInfoC2h[rspSource][2]&0xf;
3578
3579                 if (pCoexSta->btRetryCnt >= 1)
3580                         pCoexSta->popEventCnt++;
3581
3582                 if (pCoexSta->btInfoC2h[rspSource][2]&0x20)
3583                         pCoexSta->bC2hBtPage = true;
3584                 else
3585                         pCoexSta->bC2hBtPage = false;
3586
3587                 pCoexSta->btRssi = pCoexSta->btInfoC2h[rspSource][3]*2-90;
3588                 /* pCoexSta->btInfoC2h[rspSource][3]*2+10; */
3589
3590                 pCoexSta->btInfoExt = pCoexSta->btInfoC2h[rspSource][4];
3591
3592                 pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40);
3593                 pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask);
3594
3595                 if (!pCoexSta->bBtTxRxMask) {
3596                         /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */
3597                         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"));
3598                         pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15);
3599                 }
3600
3601                 /*  Here we need to resend some wifi info to BT */
3602                 /*  because bt is reset and loss of the info. */
3603                 if (pCoexSta->btInfoExt & BIT1) {
3604                         BTC_PRINT(
3605                                 BTC_MSG_ALGORITHM,
3606                                 ALGO_TRACE,
3607                                 ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")
3608                         );
3609                         pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3610                         if (bWifiConnected)
3611                                 EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT);
3612                         else
3613                                 EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);
3614                 }
3615
3616                 if (pCoexSta->btInfoExt & BIT3) {
3617                         if (!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) {
3618                                 BTC_PRINT(
3619                                         BTC_MSG_ALGORITHM,
3620                                         ALGO_TRACE,
3621                                         ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")
3622                                 );
3623                                 halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, false);
3624                         }
3625                 } else {
3626                         /*  BT already NOT ignore Wlan active, do nothing here. */
3627                 }
3628         }
3629
3630         /*  check BIT2 first ==> check if bt is under inquiry or page scan */
3631         if (btInfo & BT_INFO_8723B_1ANT_B_INQ_PAGE)
3632                 pCoexSta->bC2hBtInquiryPage = true;
3633         else
3634                 pCoexSta->bC2hBtInquiryPage = false;
3635
3636         /*  set link exist status */
3637         if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) {
3638                 pCoexSta->bBtLinkExist = false;
3639                 pCoexSta->bPanExist = false;
3640                 pCoexSta->bA2dpExist = false;
3641                 pCoexSta->bHidExist = false;
3642                 pCoexSta->bScoExist = false;
3643         } else {        /*  connection exists */
3644                 pCoexSta->bBtLinkExist = true;
3645                 if (btInfo & BT_INFO_8723B_1ANT_B_FTP)
3646                         pCoexSta->bPanExist = true;
3647                 else
3648                         pCoexSta->bPanExist = false;
3649
3650                 if (btInfo & BT_INFO_8723B_1ANT_B_A2DP)
3651                         pCoexSta->bA2dpExist = true;
3652                 else
3653                         pCoexSta->bA2dpExist = false;
3654
3655                 if (btInfo & BT_INFO_8723B_1ANT_B_HID)
3656                         pCoexSta->bHidExist = true;
3657                 else
3658                         pCoexSta->bHidExist = false;
3659
3660                 if (btInfo & BT_INFO_8723B_1ANT_B_SCO_ESCO)
3661                         pCoexSta->bScoExist = true;
3662                 else
3663                         pCoexSta->bScoExist = false;
3664         }
3665
3666         halbtc8723b1ant_UpdateBtLinkInfo(pBtCoexist);
3667
3668         btInfo = btInfo & 0x1f;  /* mask profile bit for connect-ilde identification (for CSR case: A2DP idle --> 0x41) */
3669
3670         if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) {
3671                 pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE;
3672                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"));
3673         } else if (btInfo == BT_INFO_8723B_1ANT_B_CONNECTION)   {
3674                 /*  connection exists but no busy */
3675                 pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE;
3676                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"));
3677         } else if (
3678                 (btInfo&BT_INFO_8723B_1ANT_B_SCO_ESCO) ||
3679                 (btInfo&BT_INFO_8723B_1ANT_B_SCO_BUSY)
3680         ) {
3681                 pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_SCO_BUSY;
3682                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"));
3683         } else if (btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) {
3684                 if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus)
3685                         pCoexDm->bAutoTdmaAdjust = false;
3686
3687                 pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_ACL_BUSY;
3688                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"));
3689         } else {
3690                 pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_MAX;
3691                 BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"));
3692         }
3693
3694         if (
3695                 (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||
3696                 (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
3697                 (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
3698         )
3699                 bBtBusy = true;
3700         else
3701                 bBtBusy = false;
3702         pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);
3703
3704         halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);
3705 }
3706
3707 void EXhalbtc8723b1ant_HaltNotify(PBTC_COEXIST pBtCoexist)
3708 {
3709         BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Halt notify\n"));
3710
3711         halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
3712         halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 0);
3713         halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3714
3715         halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, true);
3716
3717         EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);
3718
3719         pBtCoexist->bStopCoexDm = true;
3720 }
3721
3722 void EXhalbtc8723b1ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState)
3723 {
3724         BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify\n"));
3725
3726         if (BTC_WIFI_PNP_SLEEP == pnpState) {
3727                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to SLEEP\n"));
3728
3729                 halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
3730                 halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
3731                 halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
3732                 halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3733
3734                 pBtCoexist->bStopCoexDm = true;
3735         } else if (BTC_WIFI_PNP_WAKE_UP == pnpState) {
3736                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to WAKE UP\n"));
3737                 pBtCoexist->bStopCoexDm = false;
3738                 halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false);
3739                 halbtc8723b1ant_InitCoexDm(pBtCoexist);
3740                 halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3741         }
3742 }
3743
3744 void EXhalbtc8723b1ant_Periodical(PBTC_COEXIST pBtCoexist)
3745 {
3746         static u8 disVerInfoCnt;
3747         u32 fwVer = 0, btPatchVer = 0;
3748
3749         BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], ==========================Periodical ===========================\n"));
3750
3751         if (disVerInfoCnt <= 5) {
3752                 disVerInfoCnt += 1;
3753                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n"));
3754                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);
3755                 pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);
3756                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", \
3757                         GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer));
3758                 BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n"));
3759         }
3760
3761         halbtc8723b1ant_MonitorBtCtr(pBtCoexist);
3762         halbtc8723b1ant_MonitorWiFiCtr(pBtCoexist);
3763
3764         if (
3765                 halbtc8723b1ant_IsWifiStatusChanged(pBtCoexist) ||
3766                 pCoexDm->bAutoTdmaAdjust
3767         )
3768                 halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);
3769
3770         pCoexSta->specialPktPeriodCnt++;
3771 }