LXR linux/drivers/staging/rtl8723bs/hal/HalBtc8723b1Ant.c

   1/******************************************************************************
   2 *
   3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
   4 *
   5 * This program is free software; you can redistribute it and/or modify it
   6 * under the terms of version 2 of the GNU General Public License as
   7 * published by the Free Software Foundation.
   8 *
   9 * This program is distributed in the hope that it will be useful, but WITHOUT
  10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12 * more details.
  13 *
  14 ******************************************************************************/
  15
  16#include "Mp_Precomp.h"
  17
  18/*  Global variables, these are static variables */
  19static COEX_DM_8723B_1ANT GLCoexDm8723b1Ant;
  20static PCOEX_DM_8723B_1ANT pCoexDm = &GLCoexDm8723b1Ant;
  21static COEX_STA_8723B_1ANT GLCoexSta8723b1Ant;
  22static PCOEX_STA_8723B_1ANT     pCoexSta = &GLCoexSta8723b1Ant;
  23
  24static const char *const GLBtInfoSrc8723b1Ant[] = {
  25        "BT Info[wifi fw]",
  26        "BT Info[bt rsp]",
  27        "BT Info[bt auto report]",
  28};
  29
  30static u32 GLCoexVerDate8723b1Ant = 20140507;
  31static u32 GLCoexVer8723b1Ant = 0x4e;
  32
  33/*  local function proto type if needed */
  34/*  local function start with halbtc8723b1ant_ */
  35static u8 halbtc8723b1ant_BtRssiState(
  36        u8 levelNum, u8 rssiThresh, u8 rssiThresh1
  37)
  38{
  39        s32 btRssi = 0;
  40        u8 btRssiState = pCoexSta->preBtRssiState;
  41
  42        btRssi = pCoexSta->btRssi;
  43
  44        if (levelNum == 2) {
  45                if (
  46                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||
  47                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)
  48                ) {
  49                        if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
  50
  51                                btRssiState = BTC_RSSI_STATE_HIGH;
  52                                BTC_PRINT(
  53                                        BTC_MSG_ALGORITHM,
  54                                        ALGO_BT_RSSI_STATE,
  55                                        ("[BTCoex], BT Rssi state switch to High\n")
  56                                );
  57                        } else {
  58                                btRssiState = BTC_RSSI_STATE_STAY_LOW;
  59                                BTC_PRINT(
  60                                        BTC_MSG_ALGORITHM,
  61                                        ALGO_BT_RSSI_STATE,
  62                                        ("[BTCoex], BT Rssi state stay at Low\n")
  63                                );
  64                        }
  65                } else {
  66                        if (btRssi < rssiThresh) {
  67                                btRssiState = BTC_RSSI_STATE_LOW;
  68                                BTC_PRINT(
  69                                        BTC_MSG_ALGORITHM,
  70                                        ALGO_BT_RSSI_STATE,
  71                                        ("[BTCoex], BT Rssi state switch to Low\n")
  72                                );
  73                        } else {
  74                                btRssiState = BTC_RSSI_STATE_STAY_HIGH;
  75                                BTC_PRINT(
  76                                        BTC_MSG_ALGORITHM,
  77                                        ALGO_BT_RSSI_STATE,
  78                                        ("[BTCoex], BT Rssi state stay at High\n")
  79                                );
  80                        }
  81                }
  82        } else if (levelNum == 3) {
  83                if (rssiThresh > rssiThresh1) {
  84                        BTC_PRINT(
  85                                BTC_MSG_ALGORITHM,
  86                                ALGO_BT_RSSI_STATE,
  87                                ("[BTCoex], BT Rssi thresh error!!\n")
  88                        );
  89                        return pCoexSta->preBtRssiState;
  90                }
  91
  92                if (
  93                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) ||
  94                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)
  95                ) {
  96                        if (btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
  97                                btRssiState = BTC_RSSI_STATE_MEDIUM;
  98                                BTC_PRINT(
  99                                        BTC_MSG_ALGORITHM,
 100                                        ALGO_BT_RSSI_STATE,
 101                                        ("[BTCoex], BT Rssi state switch to Medium\n")
 102                                );
 103                        } else {
 104                                btRssiState = BTC_RSSI_STATE_STAY_LOW;
 105                                BTC_PRINT(
 106                                        BTC_MSG_ALGORITHM,
 107                                        ALGO_BT_RSSI_STATE,
 108                                        ("[BTCoex], BT Rssi state stay at Low\n")
 109                                );
 110                        }
 111                } else if (
 112                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) ||
 113                        (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)
 114                ) {
 115                        if (btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT)) {
 116                                btRssiState = BTC_RSSI_STATE_HIGH;
 117                                BTC_PRINT(
 118                                        BTC_MSG_ALGORITHM,
 119                                        ALGO_BT_RSSI_STATE,
 120                                        ("[BTCoex], BT Rssi state switch to High\n")
 121                                );
 122                        } else if (btRssi < rssiThresh) {
 123                                btRssiState = BTC_RSSI_STATE_LOW;
 124                                BTC_PRINT(
 125                                        BTC_MSG_ALGORITHM,
 126                                        ALGO_BT_RSSI_STATE,
 127                                        ("[BTCoex], BT Rssi state switch to Low\n")
 128                                );
 129                        } else {
 130                                btRssiState = BTC_RSSI_STATE_STAY_MEDIUM;
 131                                BTC_PRINT(
 132                                        BTC_MSG_ALGORITHM,
 133                                        ALGO_BT_RSSI_STATE,
 134                                        ("[BTCoex], BT Rssi state stay at Medium\n")
 135                                );
 136                        }
 137                } else {
 138                        if (btRssi < rssiThresh1) {
 139                                btRssiState = BTC_RSSI_STATE_MEDIUM;
 140                                BTC_PRINT(
 141                                        BTC_MSG_ALGORITHM,
 142                                        ALGO_BT_RSSI_STATE,
 143                                        ("[BTCoex], BT Rssi state switch to Medium\n")
 144                                );
 145                        } else {
 146                                btRssiState = BTC_RSSI_STATE_STAY_HIGH;
 147                                BTC_PRINT(
 148                                        BTC_MSG_ALGORITHM,
 149                                        ALGO_BT_RSSI_STATE,
 150                                        ("[BTCoex], BT Rssi state stay at High\n")
 151                                );
 152                        }
 153                }
 154        }
 155
 156        pCoexSta->preBtRssiState = btRssiState;
 157
 158        return btRssiState;
 159}
 160
 161static void halbtc8723b1ant_UpdateRaMask(
 162        PBTC_COEXIST pBtCoexist, bool bForceExec, u32 disRateMask
 163)
 164{
 165        pCoexDm->curRaMask = disRateMask;
 166
 167        if (bForceExec || (pCoexDm->preRaMask != pCoexDm->curRaMask))
 168                pBtCoexist->fBtcSet(
 169                        pBtCoexist,
 170                        BTC_SET_ACT_UPDATE_RAMASK,
 171                        &pCoexDm->curRaMask
 172                );
 173        pCoexDm->preRaMask = pCoexDm->curRaMask;
 174}
 175
 176static void halbtc8723b1ant_AutoRateFallbackRetry(
 177        PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 178)
 179{
 180        bool bWifiUnderBMode = false;
 181
 182        pCoexDm->curArfrType = type;
 183
 184        if (bForceExec || (pCoexDm->preArfrType != pCoexDm->curArfrType)) {
 185                switch (pCoexDm->curArfrType) {
 186                case 0: /*  normal mode */
 187                        pBtCoexist->fBtcWrite4Byte(
 188                                pBtCoexist, 0x430, pCoexDm->backupArfrCnt1
 189                        );
 190                        pBtCoexist->fBtcWrite4Byte(
 191                                pBtCoexist, 0x434, pCoexDm->backupArfrCnt2
 192                        );
 193                        break;
 194                case 1:
 195                        pBtCoexist->fBtcGet(
 196                                pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
 197                        );
 198                        if (bWifiUnderBMode) {
 199                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);
 200                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x01010101);
 201                        } else {
 202                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x430, 0x0);
 203                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x434, 0x04030201);
 204                        }
 205                        break;
 206                default:
 207                        break;
 208                }
 209        }
 210
 211        pCoexDm->preArfrType = pCoexDm->curArfrType;
 212}
 213
 214static void halbtc8723b1ant_RetryLimit(
 215        PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 216)
 217{
 218        pCoexDm->curRetryLimitType = type;
 219
 220        if (
 221                bForceExec ||
 222                (pCoexDm->preRetryLimitType != pCoexDm->curRetryLimitType)
 223        ) {
 224                switch (pCoexDm->curRetryLimitType) {
 225                case 0: /*  normal mode */
 226                        pBtCoexist->fBtcWrite2Byte(
 227                                pBtCoexist, 0x42a, pCoexDm->backupRetryLimit
 228                        );
 229                        break;
 230                case 1: /*  retry limit =8 */
 231                        pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x42a, 0x0808);
 232                        break;
 233                default:
 234                        break;
 235                }
 236        }
 237
 238        pCoexDm->preRetryLimitType = pCoexDm->curRetryLimitType;
 239}
 240
 241static void halbtc8723b1ant_AmpduMaxTime(
 242        PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 243)
 244{
 245        pCoexDm->curAmpduTimeType = type;
 246
 247        if (
 248                bForceExec || (pCoexDm->preAmpduTimeType != pCoexDm->curAmpduTimeType)
 249        ) {
 250                switch (pCoexDm->curAmpduTimeType) {
 251                case 0: /*  normal mode */
 252                        pBtCoexist->fBtcWrite1Byte(
 253                                pBtCoexist, 0x456, pCoexDm->backupAmpduMaxTime
 254                        );
 255                        break;
 256                case 1: /*  AMPDU timw = 0x38 * 32us */
 257                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x456, 0x38);
 258                        break;
 259                default:
 260                        break;
 261                }
 262        }
 263
 264        pCoexDm->preAmpduTimeType = pCoexDm->curAmpduTimeType;
 265}
 266
 267static void halbtc8723b1ant_LimitedTx(
 268        PBTC_COEXIST pBtCoexist,
 269        bool bForceExec,
 270        u8 raMaskType,
 271        u8 arfrType,
 272        u8 retryLimitType,
 273        u8 ampduTimeType
 274)
 275{
 276        switch (raMaskType) {
 277        case 0: /*  normal mode */
 278                halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0);
 279                break;
 280        case 1: /*  disable cck 1/2 */
 281                halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x00000003);
 282                break;
 283        case 2: /*  disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */
 284                halbtc8723b1ant_UpdateRaMask(pBtCoexist, bForceExec, 0x0001f1f7);
 285                break;
 286        default:
 287                break;
 288        }
 289
 290        halbtc8723b1ant_AutoRateFallbackRetry(pBtCoexist, bForceExec, arfrType);
 291        halbtc8723b1ant_RetryLimit(pBtCoexist, bForceExec, retryLimitType);
 292        halbtc8723b1ant_AmpduMaxTime(pBtCoexist, bForceExec, ampduTimeType);
 293}
 294
 295static void halbtc8723b1ant_LimitedRx(
 296        PBTC_COEXIST pBtCoexist,
 297        bool bForceExec,
 298        bool bRejApAggPkt,
 299        bool bBtCtrlAggBufSize,
 300        u8 aggBufSize
 301)
 302{
 303        bool bRejectRxAgg = bRejApAggPkt;
 304        bool bBtCtrlRxAggSize = bBtCtrlAggBufSize;
 305        u8 rxAggSize = aggBufSize;
 306
 307        /*  */
 308        /*      Rx Aggregation related setting */
 309        /*  */
 310        pBtCoexist->fBtcSet(
 311                pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejectRxAgg
 312        );
 313        /*  decide BT control aggregation buf size or not */
 314        pBtCoexist->fBtcSet(
 315                pBtCoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, &bBtCtrlRxAggSize
 316        );
 317        /*  aggregation buf size, only work when BT control Rx aggregation size. */
 318        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_AGG_BUF_SIZE, &rxAggSize);
 319        /*  real update aggregation setting */
 320        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);
 321
 322
 323}
 324
 325static void halbtc8723b1ant_QueryBtInfo(PBTC_COEXIST pBtCoexist)
 326{
 327        u8      H2C_Parameter[1] = {0};
 328
 329        pCoexSta->bC2hBtInfoReqSent = true;
 330
 331        H2C_Parameter[0] |= BIT0;       /*  trigger */
 332
 333        BTC_PRINT(
 334                BTC_MSG_ALGORITHM,
 335                ALGO_TRACE_FW_EXEC,
 336                ("[BTCoex], Query Bt Info, FW write 0x61 = 0x%x\n", H2C_Parameter[0])
 337        );
 338
 339        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x61, 1, H2C_Parameter);
 340}
 341
 342static void halbtc8723b1ant_MonitorBtCtr(PBTC_COEXIST pBtCoexist)
 343{
 344        u32 regHPTxRx, regLPTxRx, u4Tmp;
 345        u32 regHPTx = 0, regHPRx = 0, regLPTx = 0, regLPRx = 0;
 346        static u8 NumOfBtCounterChk;
 347
 348       /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */
 349        /* if (! (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) & 0x8)) */
 350
 351        if (pCoexSta->bUnderIps) {
 352                pCoexSta->highPriorityTx = 65535;
 353                pCoexSta->highPriorityRx = 65535;
 354                pCoexSta->lowPriorityTx = 65535;
 355                pCoexSta->lowPriorityRx = 65535;
 356                return;
 357        }
 358
 359        regHPTxRx = 0x770;
 360        regLPTxRx = 0x774;
 361
 362        u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx);
 363        regHPTx = u4Tmp & bMaskLWord;
 364        regHPRx = (u4Tmp & bMaskHWord)>>16;
 365
 366        u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx);
 367        regLPTx = u4Tmp & bMaskLWord;
 368        regLPRx = (u4Tmp & bMaskHWord)>>16;
 369
 370        pCoexSta->highPriorityTx = regHPTx;
 371        pCoexSta->highPriorityRx = regHPRx;
 372        pCoexSta->lowPriorityTx = regLPTx;
 373        pCoexSta->lowPriorityRx = regLPRx;
 374
 375        if ((pCoexSta->lowPriorityTx >= 1050) && (!pCoexSta->bC2hBtInquiryPage))
 376                pCoexSta->popEventCnt++;
 377
 378        BTC_PRINT(
 379                BTC_MSG_ALGORITHM,
 380                ALGO_TRACE,
 381                (
 382                        "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n",
 383                        regHPRx,
 384                        regHPTx,
 385                        regLPRx,
 386                        regLPTx
 387                )
 388        );
 389
 390        /*  reset counter */
 391        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc);
 392
 393        if ((regHPTx == 0) && (regHPRx == 0) && (regLPTx == 0) && (regLPRx == 0)) {
 394                NumOfBtCounterChk++;
 395                if (NumOfBtCounterChk >= 3) {
 396                        halbtc8723b1ant_QueryBtInfo(pBtCoexist);
 397                        NumOfBtCounterChk = 0;
 398                }
 399        }
 400}
 401
 402
 403static void halbtc8723b1ant_MonitorWiFiCtr(PBTC_COEXIST pBtCoexist)
 404{
 405        s32     wifiRssi = 0;
 406        bool bWifiBusy = false, bWifiUnderBMode = false;
 407        static u8 nCCKLockCounter;
 408
 409        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
 410        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);
 411        pBtCoexist->fBtcGet(
 412                pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
 413        );
 414
 415        if (pCoexSta->bUnderIps) {
 416                pCoexSta->nCRCOK_CCK = 0;
 417                pCoexSta->nCRCOK_11g = 0;
 418                pCoexSta->nCRCOK_11n = 0;
 419                pCoexSta->nCRCOK_11nAgg = 0;
 420
 421                pCoexSta->nCRCErr_CCK = 0;
 422                pCoexSta->nCRCErr_11g = 0;
 423                pCoexSta->nCRCErr_11n = 0;
 424                pCoexSta->nCRCErr_11nAgg = 0;
 425        } else {
 426                pCoexSta->nCRCOK_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf88);
 427                pCoexSta->nCRCOK_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf94);
 428                pCoexSta->nCRCOK_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf90);
 429                pCoexSta->nCRCOK_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfb8);
 430
 431                pCoexSta->nCRCErr_CCK    = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xf84);
 432                pCoexSta->nCRCErr_11g    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf96);
 433                pCoexSta->nCRCErr_11n    = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xf92);
 434                pCoexSta->nCRCErr_11nAgg = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0xfba);
 435        }
 436
 437
 438        /* reset counter */
 439        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x1);
 440        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0xf16, 0x1, 0x0);
 441
 442        if (bWifiBusy && (wifiRssi >= 30) && !bWifiUnderBMode) {
 443                if (
 444                        (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) ||
 445                        (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) ||
 446                        (pCoexDm->btStatus == BT_8723B_1ANT_BT_STATUS_SCO_BUSY)
 447                ) {
 448                        if (
 449                                pCoexSta->nCRCOK_CCK > (
 450                                        pCoexSta->nCRCOK_11g +
 451                                        pCoexSta->nCRCOK_11n +
 452                                        pCoexSta->nCRCOK_11nAgg
 453                                )
 454                        ) {
 455                                if (nCCKLockCounter < 5)
 456                                 nCCKLockCounter++;
 457                        } else {
 458                                if (nCCKLockCounter > 0)
 459                                 nCCKLockCounter--;
 460                        }
 461
 462                } else {
 463                        if (nCCKLockCounter > 0)
 464                          nCCKLockCounter--;
 465                }
 466        } else {
 467                if (nCCKLockCounter > 0)
 468                        nCCKLockCounter--;
 469        }
 470
 471        if (!pCoexSta->bPreCCKLock) {
 472
 473                if (nCCKLockCounter >= 5)
 474                 pCoexSta->bCCKLock = true;
 475                else
 476                 pCoexSta->bCCKLock = false;
 477        } else {
 478                if (nCCKLockCounter == 0)
 479                 pCoexSta->bCCKLock = false;
 480                else
 481                 pCoexSta->bCCKLock = true;
 482        }
 483
 484        pCoexSta->bPreCCKLock =  pCoexSta->bCCKLock;
 485
 486
 487}
 488
 489static bool halbtc8723b1ant_IsWifiStatusChanged(PBTC_COEXIST pBtCoexist)
 490{
 491        static bool     bPreWifiBusy, bPreUnder4way, bPreBtHsOn;
 492        bool bWifiBusy = false, bUnder4way = false, bBtHsOn = false;
 493        bool bWifiConnected = false;
 494
 495        pBtCoexist->fBtcGet(
 496                pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected
 497        );
 498        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
 499        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 500        pBtCoexist->fBtcGet(
 501                pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way
 502        );
 503
 504        if (bWifiConnected) {
 505                if (bWifiBusy != bPreWifiBusy) {
 506                        bPreWifiBusy = bWifiBusy;
 507                        return true;
 508                }
 509
 510                if (bUnder4way != bPreUnder4way) {
 511                        bPreUnder4way = bUnder4way;
 512                        return true;
 513                }
 514
 515                if (bBtHsOn != bPreBtHsOn) {
 516                        bPreBtHsOn = bBtHsOn;
 517                        return true;
 518                }
 519        }
 520
 521        return false;
 522}
 523
 524static void halbtc8723b1ant_UpdateBtLinkInfo(PBTC_COEXIST pBtCoexist)
 525{
 526        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
 527        bool bBtHsOn = false;
 528
 529        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 530
 531        pBtLinkInfo->bBtLinkExist = pCoexSta->bBtLinkExist;
 532        pBtLinkInfo->bScoExist = pCoexSta->bScoExist;
 533        pBtLinkInfo->bA2dpExist = pCoexSta->bA2dpExist;
 534        pBtLinkInfo->bPanExist = pCoexSta->bPanExist;
 535        pBtLinkInfo->bHidExist = pCoexSta->bHidExist;
 536
 537        /*  work around for HS mode. */
 538        if (bBtHsOn) {
 539                pBtLinkInfo->bPanExist = true;
 540                pBtLinkInfo->bBtLinkExist = true;
 541        }
 542
 543        /*  check if Sco only */
 544        if (
 545                pBtLinkInfo->bScoExist &&
 546                !pBtLinkInfo->bA2dpExist &&
 547                !pBtLinkInfo->bPanExist &&
 548                !pBtLinkInfo->bHidExist
 549        )
 550                pBtLinkInfo->bScoOnly = true;
 551        else
 552                pBtLinkInfo->bScoOnly = false;
 553
 554        /*  check if A2dp only */
 555        if (
 556                !pBtLinkInfo->bScoExist &&
 557                pBtLinkInfo->bA2dpExist &&
 558                !pBtLinkInfo->bPanExist &&
 559                !pBtLinkInfo->bHidExist
 560        )
 561                pBtLinkInfo->bA2dpOnly = true;
 562        else
 563                pBtLinkInfo->bA2dpOnly = false;
 564
 565        /*  check if Pan only */
 566        if (
 567                !pBtLinkInfo->bScoExist &&
 568                !pBtLinkInfo->bA2dpExist &&
 569                pBtLinkInfo->bPanExist &&
 570                !pBtLinkInfo->bHidExist
 571        )
 572                pBtLinkInfo->bPanOnly = true;
 573        else
 574                pBtLinkInfo->bPanOnly = false;
 575
 576        /*  check if Hid only */
 577        if (
 578                !pBtLinkInfo->bScoExist &&
 579                !pBtLinkInfo->bA2dpExist &&
 580                !pBtLinkInfo->bPanExist &&
 581                pBtLinkInfo->bHidExist
 582        )
 583                pBtLinkInfo->bHidOnly = true;
 584        else
 585                pBtLinkInfo->bHidOnly = false;
 586}
 587
 588static u8 halbtc8723b1ant_ActionAlgorithm(PBTC_COEXIST pBtCoexist)
 589{
 590        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
 591        bool bBtHsOn = false;
 592        u8 algorithm = BT_8723B_1ANT_COEX_ALGO_UNDEFINED;
 593        u8 numOfDiffProfile = 0;
 594
 595        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
 596
 597        if (!pBtLinkInfo->bBtLinkExist) {
 598                BTC_PRINT(
 599                        BTC_MSG_ALGORITHM,
 600                        ALGO_TRACE,
 601                        ("[BTCoex], No BT link exists!!!\n")
 602                );
 603                return algorithm;
 604        }
 605
 606        if (pBtLinkInfo->bScoExist)
 607                numOfDiffProfile++;
 608        if (pBtLinkInfo->bHidExist)
 609                numOfDiffProfile++;
 610        if (pBtLinkInfo->bPanExist)
 611                numOfDiffProfile++;
 612        if (pBtLinkInfo->bA2dpExist)
 613                numOfDiffProfile++;
 614
 615        if (numOfDiffProfile == 1) {
 616                if (pBtLinkInfo->bScoExist) {
 617                        BTC_PRINT(
 618                                BTC_MSG_ALGORITHM,
 619                                ALGO_TRACE,
 620                                ("[BTCoex], BT Profile = SCO only\n")
 621                        );
 622                        algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 623                } else {
 624                        if (pBtLinkInfo->bHidExist) {
 625                                BTC_PRINT(
 626                                        BTC_MSG_ALGORITHM,
 627                                        ALGO_TRACE,
 628                                        ("[BTCoex], BT Profile = HID only\n")
 629                                );
 630                                algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 631                        } else if (pBtLinkInfo->bA2dpExist) {
 632                                BTC_PRINT(
 633                                        BTC_MSG_ALGORITHM,
 634                                        ALGO_TRACE,
 635                                        ("[BTCoex], BT Profile = A2DP only\n")
 636                                );
 637                                algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP;
 638                        } else if (pBtLinkInfo->bPanExist) {
 639                                if (bBtHsOn) {
 640                                        BTC_PRINT(
 641                                                BTC_MSG_ALGORITHM,
 642                                                ALGO_TRACE,
 643                                                ("[BTCoex], BT Profile = PAN(HS) only\n")
 644                                        );
 645                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANHS;
 646                                } else {
 647                                        BTC_PRINT(
 648                                                BTC_MSG_ALGORITHM,
 649                                                ALGO_TRACE,
 650                                                ("[BTCoex], BT Profile = PAN(EDR) only\n")
 651                                        );
 652                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR;
 653                                }
 654                        }
 655                }
 656        } else if (numOfDiffProfile == 2) {
 657                if (pBtLinkInfo->bScoExist) {
 658                        if (pBtLinkInfo->bHidExist) {
 659                                BTC_PRINT(
 660                                        BTC_MSG_ALGORITHM,
 661                                        ALGO_TRACE,
 662                                        ("[BTCoex], BT Profile = SCO + HID\n")
 663                                );
 664                                algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 665                        } else if (pBtLinkInfo->bA2dpExist) {
 666                                BTC_PRINT(
 667                                        BTC_MSG_ALGORITHM,
 668                                        ALGO_TRACE,
 669                                        ("[BTCoex], BT Profile = SCO + A2DP ==> SCO\n")
 670                                );
 671                                algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 672                        } else if (pBtLinkInfo->bPanExist) {
 673                                if (bBtHsOn) {
 674                                        BTC_PRINT(
 675                                                BTC_MSG_ALGORITHM,
 676                                                ALGO_TRACE,
 677                                                ("[BTCoex], BT Profile = SCO + PAN(HS)\n")
 678                                        );
 679                                        algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 680                                } else {
 681                                        BTC_PRINT(
 682                                                BTC_MSG_ALGORITHM,
 683                                                ALGO_TRACE,
 684                                                ("[BTCoex], BT Profile = SCO + PAN(EDR)\n")
 685                                        );
 686                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 687                                }
 688                        }
 689                } else {
 690                        if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) {
 691                                BTC_PRINT(
 692                                        BTC_MSG_ALGORITHM,
 693                                        ALGO_TRACE,
 694                                        ("[BTCoex], BT Profile = HID + A2DP\n")
 695                                );
 696                                algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 697                        } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist) {
 698                                if (bBtHsOn) {
 699                                        BTC_PRINT(
 700                                                BTC_MSG_ALGORITHM,
 701                                                ALGO_TRACE,
 702                                                ("[BTCoex], BT Profile = HID + PAN(HS)\n")
 703                                        );
 704                                        algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 705                                } else {
 706                                        BTC_PRINT(
 707                                                BTC_MSG_ALGORITHM,
 708                                                ALGO_TRACE,
 709                                                ("[BTCoex], BT Profile = HID + PAN(EDR)\n")
 710                                        );
 711                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 712                                }
 713                        } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) {
 714                                if (bBtHsOn) {
 715                                        BTC_PRINT(
 716                                                BTC_MSG_ALGORITHM,
 717                                                ALGO_TRACE,
 718                                                ("[BTCoex], BT Profile = A2DP + PAN(HS)\n")
 719                                        );
 720                                        algorithm = BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS;
 721                                } else {
 722                                        BTC_PRINT(
 723                                                BTC_MSG_ALGORITHM,
 724                                                ALGO_TRACE,
 725                                                ("[BTCoex], BT Profile = A2DP + PAN(EDR)\n")
 726                                        );
 727                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP;
 728                                }
 729                        }
 730                }
 731        } else if (numOfDiffProfile == 3) {
 732                if (pBtLinkInfo->bScoExist) {
 733                        if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) {
 734                                BTC_PRINT(
 735                                        BTC_MSG_ALGORITHM,
 736                                        ALGO_TRACE,
 737                                        ("[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n")
 738                                );
 739                                algorithm = BT_8723B_1ANT_COEX_ALGO_HID;
 740                        } else if (
 741                                pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist
 742                        ) {
 743                                if (bBtHsOn) {
 744                                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"));
 745                                        algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 746                                } else {
 747                                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"));
 748                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 749                                }
 750                        } else if (pBtLinkInfo->bPanExist && pBtLinkInfo->bA2dpExist) {
 751                                if (bBtHsOn) {
 752                                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"));
 753                                        algorithm = BT_8723B_1ANT_COEX_ALGO_SCO;
 754                                } else {
 755                                        BTC_PRINT(
 756                                                BTC_MSG_ALGORITHM,
 757                                                ALGO_TRACE,
 758                                                ("[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n")
 759                                        );
 760                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 761                                }
 762                        }
 763                } else {
 764                        if (
 765                                pBtLinkInfo->bHidExist &&
 766                                pBtLinkInfo->bPanExist &&
 767                                pBtLinkInfo->bA2dpExist
 768                        ) {
 769                                if (bBtHsOn) {
 770                                        BTC_PRINT(
 771                                                BTC_MSG_ALGORITHM,
 772                                                ALGO_TRACE,
 773                                                ("[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n")
 774                                        );
 775                                        algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP;
 776                                } else {
 777                                        BTC_PRINT(
 778                                                BTC_MSG_ALGORITHM,
 779                                                ALGO_TRACE,
 780                                                ("[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n")
 781                                        );
 782                                        algorithm = BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR;
 783                                }
 784                        }
 785                }
 786        } else if (numOfDiffProfile >= 3) {
 787                if (pBtLinkInfo->bScoExist) {
 788                        if (
 789                                pBtLinkInfo->bHidExist &&
 790                                pBtLinkInfo->bPanExist &&
 791                                pBtLinkInfo->bA2dpExist
 792                        ) {
 793                                if (bBtHsOn) {
 794                                        BTC_PRINT(
 795                                                BTC_MSG_ALGORITHM,
 796                                                ALGO_TRACE,
 797                                                ("[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n")
 798                                        );
 799
 800                                } else {
 801                                        BTC_PRINT(
 802                                                BTC_MSG_ALGORITHM,
 803                                                ALGO_TRACE,
 804                                                ("[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR) ==>PAN(EDR)+HID\n")
 805                                        );
 806                                        algorithm = BT_8723B_1ANT_COEX_ALGO_PANEDR_HID;
 807                                }
 808                        }
 809                }
 810        }
 811
 812        return algorithm;
 813}
 814
 815static void halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(
 816        PBTC_COEXIST pBtCoexist, bool bLowPenaltyRa
 817)
 818{
 819        u8      H2C_Parameter[6] = {0};
 820
 821        H2C_Parameter[0] = 0x6; /*  opCode, 0x6 = Retry_Penalty */
 822
 823        if (bLowPenaltyRa) {
 824                H2C_Parameter[1] |= BIT0;
 825                H2C_Parameter[2] = 0x00;  /* normal rate except MCS7/6/5, OFDM54/48/36 */
 826                H2C_Parameter[3] = 0xf7;  /* MCS7 or OFDM54 */
 827                H2C_Parameter[4] = 0xf8;  /* MCS6 or OFDM48 */
 828                H2C_Parameter[5] = 0xf9;        /* MCS5 or OFDM36 */
 829        }
 830
 831        BTC_PRINT(
 832                BTC_MSG_ALGORITHM,
 833                ALGO_TRACE_FW_EXEC,
 834                (
 835                        "[BTCoex], set WiFi Low-Penalty Retry: %s",
 836                        (bLowPenaltyRa ? "ON!!" : "OFF!!")
 837                )
 838        );
 839
 840        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x69, 6, H2C_Parameter);
 841}
 842
 843static void halbtc8723b1ant_LowPenaltyRa(
 844        PBTC_COEXIST pBtCoexist, bool bForceExec, bool bLowPenaltyRa
 845)
 846{
 847        pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa;
 848
 849        if (!bForceExec) {
 850                if (pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa)
 851                        return;
 852        }
 853        halbtc8723b1ant_SetSwPenaltyTxRateAdaptive(
 854                pBtCoexist, pCoexDm->bCurLowPenaltyRa
 855        );
 856
 857        pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa;
 858}
 859
 860static void halbtc8723b1ant_SetCoexTable(
 861        PBTC_COEXIST pBtCoexist,
 862        u32 val0x6c0,
 863        u32 val0x6c4,
 864        u32 val0x6c8,
 865        u8 val0x6cc
 866)
 867{
 868        BTC_PRINT(
 869                BTC_MSG_ALGORITHM,
 870                ALGO_TRACE_SW_EXEC,
 871                ("[BTCoex], set coex table, set 0x6c0 = 0x%x\n", val0x6c0)
 872        );
 873        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0);
 874
 875        BTC_PRINT(
 876                BTC_MSG_ALGORITHM,
 877                ALGO_TRACE_SW_EXEC,
 878                ("[BTCoex], set coex table, set 0x6c4 = 0x%x\n", val0x6c4)
 879        );
 880        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4);
 881
 882        BTC_PRINT(
 883                BTC_MSG_ALGORITHM,
 884                ALGO_TRACE_SW_EXEC,
 885                ("[BTCoex], set coex table, set 0x6c8 = 0x%x\n", val0x6c8)
 886        );
 887        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8);
 888
 889        BTC_PRINT(
 890                BTC_MSG_ALGORITHM,
 891                ALGO_TRACE_SW_EXEC,
 892                ("[BTCoex], set coex table, set 0x6cc = 0x%x\n", val0x6cc)
 893        );
 894        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc);
 895}
 896
 897static void halbtc8723b1ant_CoexTable(
 898        PBTC_COEXIST pBtCoexist,
 899        bool bForceExec,
 900        u32 val0x6c0,
 901        u32 val0x6c4,
 902        u32 val0x6c8,
 903        u8 val0x6cc
 904)
 905{
 906        BTC_PRINT(
 907                BTC_MSG_ALGORITHM,
 908                ALGO_TRACE_SW,
 909                (
 910                        "[BTCoex], %s write Coex Table 0x6c0 = 0x%x, 0x6c4 = 0x%x, 0x6cc = 0x%x\n",
 911                        (bForceExec ? "force to" : ""),
 912                        val0x6c0, val0x6c4, val0x6cc
 913                )
 914        );
 915        pCoexDm->curVal0x6c0 = val0x6c0;
 916        pCoexDm->curVal0x6c4 = val0x6c4;
 917        pCoexDm->curVal0x6c8 = val0x6c8;
 918        pCoexDm->curVal0x6cc = val0x6cc;
 919
 920        if (!bForceExec) {
 921                if (
 922                        (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) &&
 923                    (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) &&
 924                    (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) &&
 925                    (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc)
 926                )
 927                        return;
 928        }
 929
 930        halbtc8723b1ant_SetCoexTable(
 931                pBtCoexist, val0x6c0, val0x6c4, val0x6c8, val0x6cc
 932        );
 933
 934        pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0;
 935        pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4;
 936        pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8;
 937        pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc;
 938}
 939
 940static void halbtc8723b1ant_CoexTableWithType(
 941        PBTC_COEXIST pBtCoexist, bool bForceExec, u8 type
 942)
 943{
 944        BTC_PRINT(
 945                BTC_MSG_ALGORITHM,
 946                ALGO_TRACE,
 947                ("[BTCoex], ********** CoexTable(%d) **********\n", type)
 948        );
 949
 950        pCoexSta->nCoexTableType = type;
 951
 952        switch (type) {
 953        case 0:
 954                halbtc8723b1ant_CoexTable(
 955                        pBtCoexist, bForceExec, 0x55555555, 0x55555555, 0xffffff, 0x3
 956                );
 957                break;
 958        case 1:
 959                halbtc8723b1ant_CoexTable(
 960                        pBtCoexist, bForceExec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3
 961                );
 962                break;
 963        case 2:
 964                halbtc8723b1ant_CoexTable(
 965                        pBtCoexist, bForceExec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3
 966                );
 967                break;
 968        case 3:
 969                halbtc8723b1ant_CoexTable(
 970                        pBtCoexist, bForceExec, 0xaaaa5555, 0xaaaa5a5a, 0xffffff, 0x3
 971                );
 972                break;
 973        case 4:
 974                halbtc8723b1ant_CoexTable(
 975                        pBtCoexist, bForceExec, 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3
 976                );
 977                break;
 978        case 5:
 979                halbtc8723b1ant_CoexTable(
 980                        pBtCoexist, bForceExec, 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3
 981                );
 982                break;
 983        case 6:
 984                halbtc8723b1ant_CoexTable(
 985                        pBtCoexist, bForceExec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3
 986                );
 987                break;
 988        case 7:
 989                halbtc8723b1ant_CoexTable(
 990                        pBtCoexist, bForceExec, 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3
 991                );
 992                break;
 993        default:
 994                break;
 995        }
 996}
 997
 998static void halbtc8723b1ant_SetFwIgnoreWlanAct(
 999        PBTC_COEXIST pBtCoexist, bool bEnable
1000)

1001{
1002        u8 H2C_Parameter[1] = {0};
1003
1004        if (bEnable)
1005                H2C_Parameter[0] |= BIT0; /* function enable */
1006
1007        BTC_PRINT(
1008                BTC_MSG_ALGORITHM,
1009                ALGO_TRACE_FW_EXEC,
1010                (
1011                        "[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x63 = 0x%x\n",
1012                        H2C_Parameter[0]
1013                )
1014        );
1015
1016        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x63, 1, H2C_Parameter);
1017}
1018
1019static void halbtc8723b1ant_IgnoreWlanAct(
1020        PBTC_COEXIST pBtCoexist, bool bForceExec, bool bEnable
1021)
1022{
1023        BTC_PRINT(
1024                BTC_MSG_ALGORITHM,
1025                ALGO_TRACE_FW,
1026                (
1027                        "[BTCoex], %s turn Ignore WlanAct %s\n",
1028                        (bForceExec ? "force to" : ""),
1029                        (bEnable ? "ON" : "OFF")
1030                )
1031        );
1032        pCoexDm->bCurIgnoreWlanAct = bEnable;
1033
1034        if (!bForceExec) {
1035                BTC_PRINT(
1036                        BTC_MSG_ALGORITHM,
1037                        ALGO_TRACE_FW_DETAIL,
1038                        (
1039                                "[BTCoex], bPreIgnoreWlanAct = %d, bCurIgnoreWlanAct = %d!!\n",
1040                                pCoexDm->bPreIgnoreWlanAct,
1041                                pCoexDm->bCurIgnoreWlanAct
1042                        )
1043                );
1044
1045                if (pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct)
1046                        return;
1047        }
1048        halbtc8723b1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable);
1049
1050        pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct;
1051}
1052
1053static void halbtc8723b1ant_SetLpsRpwm(
1054        PBTC_COEXIST pBtCoexist, u8 lpsVal, u8 rpwmVal
1055)
1056{
1057        u8 lps = lpsVal;
1058        u8 rpwm = rpwmVal;
1059
1060        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_LPS_VAL, &lps);
1061        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RPWM_VAL, &rpwm);
1062}
1063
1064static void halbtc8723b1ant_LpsRpwm(
1065        PBTC_COEXIST pBtCoexist, bool bForceExec, u8 lpsVal, u8 rpwmVal
1066)
1067{
1068        BTC_PRINT(
1069                BTC_MSG_ALGORITHM,
1070                ALGO_TRACE_FW,
1071                (
1072                        "[BTCoex], %s set lps/rpwm = 0x%x/0x%x\n",
1073                        (bForceExec ? "force to" : ""),
1074                        lpsVal,
1075                        rpwmVal
1076                )
1077        );
1078        pCoexDm->curLps = lpsVal;
1079        pCoexDm->curRpwm = rpwmVal;
1080
1081        if (!bForceExec) {
1082                BTC_PRINT(
1083                        BTC_MSG_ALGORITHM,
1084                        ALGO_TRACE_FW_DETAIL,
1085                        (
1086                                "[BTCoex], LPS-RxBeaconMode = 0x%x , LPS-RPWM = 0x%x!!\n",
1087                                pCoexDm->curLps,
1088                                pCoexDm->curRpwm
1089                        )
1090                );
1091
1092                if (
1093                        (pCoexDm->preLps == pCoexDm->curLps) &&
1094                        (pCoexDm->preRpwm == pCoexDm->curRpwm)
1095                ) {
1096                        BTC_PRINT(
1097                                BTC_MSG_ALGORITHM,
1098                                ALGO_TRACE_FW_DETAIL,
1099                                (
1100                                        "[BTCoex], LPS-RPWM_Last = 0x%x , LPS-RPWM_Now = 0x%x!!\n",
1101                                        pCoexDm->preRpwm,
1102                                        pCoexDm->curRpwm
1103                                )
1104                        );
1105
1106                        return;
1107                }
1108        }
1109        halbtc8723b1ant_SetLpsRpwm(pBtCoexist, lpsVal, rpwmVal);
1110
1111        pCoexDm->preLps = pCoexDm->curLps;
1112        pCoexDm->preRpwm = pCoexDm->curRpwm;
1113}
1114
1115static void halbtc8723b1ant_SwMechanism(
1116        PBTC_COEXIST pBtCoexist, bool bLowPenaltyRA
1117)
1118{
1119        BTC_PRINT(
1120                BTC_MSG_ALGORITHM,
1121                ALGO_BT_MONITOR,
1122                ("[BTCoex], SM[LpRA] = %d\n", bLowPenaltyRA)
1123        );
1124
1125        halbtc8723b1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, bLowPenaltyRA);
1126}
1127
1128static void halbtc8723b1ant_SetAntPath(
1129        PBTC_COEXIST pBtCoexist, u8 antPosType, bool bInitHwCfg, bool bWifiOff
1130)
1131{
1132        PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
1133        u32 fwVer = 0, u4Tmp = 0, cntBtCalChk = 0;
1134        bool bPgExtSwitch = false;
1135        bool bUseExtSwitch = false;
1136        bool bIsInMpMode = false;
1137        u8 H2C_Parameter[2] = {0}, u1Tmp = 0;
1138
1139        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_EXT_SWITCH, &bPgExtSwitch);
1140        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); /*  [31:16]=fw ver, [15:0]=fw sub ver */
1141
1142        if ((fwVer > 0 && fwVer < 0xc0000) || bPgExtSwitch)
1143                bUseExtSwitch = true;
1144
1145        if (bInitHwCfg) {
1146                pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1, 0xfffff, 0x780); /* WiFi TRx Mask on */
1147                pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15); /* BT TRx Mask on */
1148
1149                if (fwVer >= 0x180000) {
1150                        /* Use H2C to set GNT_BT to HIGH */
1151                        H2C_Parameter[0] = 1;
1152                        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1153                } else /*  set grant_bt to high */
1154                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
1155
1156                /* set wlan_act control by PTA */
1157                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
1158
1159                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */
1160
1161                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x39, 0x8, 0x1);
1162                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x974, 0xff);
1163                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x944, 0x3, 0x3);
1164                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x930, 0x77);
1165        } else if (bWifiOff) {
1166                if (fwVer >= 0x180000) {
1167                        /* Use H2C to set GNT_BT to HIGH */
1168                        H2C_Parameter[0] = 1;
1169                        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1170                } else /*  set grant_bt to high */
1171                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
1172
1173                /* set wlan_act to always low */
1174                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
1175
1176                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, &bIsInMpMode);
1177                if (!bIsInMpMode)
1178                        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x0); /* BT select s0/s1 is controlled by BT */
1179                else
1180                        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */
1181
1182                /*  0x4c[24:23]= 00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac = 0xf002 */
1183                u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1184                u4Tmp &= ~BIT23;
1185                u4Tmp &= ~BIT24;
1186                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1187        } else {
1188                /* Use H2C to set GNT_BT to LOW */
1189                if (fwVer >= 0x180000) {
1190                        if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765) != 0) {
1191                                H2C_Parameter[0] = 0;
1192                                pBtCoexist->fBtcFillH2c(pBtCoexist, 0x6E, 1, H2C_Parameter);
1193                        }
1194                } else {
1195                        /*  BT calibration check */
1196                        while (cntBtCalChk <= 20) {
1197                                u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49d);
1198                                cntBtCalChk++;
1199
1200                                if (u1Tmp & BIT0) {
1201                                        BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ########### BT is calibrating (wait cnt =%d) ###########\n", cntBtCalChk));
1202                                        mdelay(50);
1203                                } else {
1204                                        BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ********** BT is NOT calibrating (wait cnt =%d)**********\n", cntBtCalChk));
1205                                        break;
1206                                }
1207                        }
1208
1209                        /*  set grant_bt to PTA */
1210                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x0);
1211                }
1212
1213                if (pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e) != 0xc)
1214                        /* set wlan_act control by PTA */
1215                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc);
1216        }
1217
1218        if (bUseExtSwitch) {
1219                if (bInitHwCfg) {
1220                        /*  0x4c[23]= 0, 0x4c[24]= 1  Antenna control by WL/BT */
1221                        u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1222                        u4Tmp &= ~BIT23;
1223                        u4Tmp |= BIT24;
1224                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1225
1226                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0); /*  fixed internal switch S1->WiFi, S0->BT */
1227
1228                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) {
1229                                /* tell firmware "no antenna inverse" */
1230                                H2C_Parameter[0] = 0;
1231                                H2C_Parameter[1] = 1;  /* ext switch type */
1232                                pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1233                        } else {
1234                                /* tell firmware "antenna inverse" */
1235                                H2C_Parameter[0] = 1;
1236                                H2C_Parameter[1] = 1;  /* ext switch type */
1237                                pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1238                        }
1239                }
1240
1241
1242                /*  ext switch setting */
1243                switch (antPosType) {
1244                case BTC_ANT_PATH_WIFI:
1245                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1246                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1247                        else
1248                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1249                        break;
1250                case BTC_ANT_PATH_BT:
1251                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1252                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1253                        else
1254                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1255                        break;
1256                default:
1257                case BTC_ANT_PATH_PTA:
1258                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1259                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x1);
1260                        else
1261                                pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x92c, 0x3, 0x2);
1262                        break;
1263                }
1264
1265        } else {
1266                if (bInitHwCfg) {
1267                        /*  0x4c[23]= 1, 0x4c[24]= 0  Antenna control by 0x64 */
1268                        u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
1269                        u4Tmp |= BIT23;
1270                        u4Tmp &= ~BIT24;
1271                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x4c, u4Tmp);
1272
1273                        /* Fix Ext switch Main->S1, Aux->S0 */
1274                        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x64, 0x1, 0x0);
1275
1276                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT) {
1277
1278                                /* tell firmware "no antenna inverse" */
1279                                H2C_Parameter[0] = 0;
1280                                H2C_Parameter[1] = 0;  /* internal switch type */
1281                                pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1282                        } else {
1283
1284                                /* tell firmware "antenna inverse" */
1285                                H2C_Parameter[0] = 1;
1286                                H2C_Parameter[1] = 0;  /* internal switch type */
1287                                pBtCoexist->fBtcFillH2c(pBtCoexist, 0x65, 2, H2C_Parameter);
1288                        }
1289                }
1290
1291
1292                /*  internal switch setting */
1293                switch (antPosType) {
1294                case BTC_ANT_PATH_WIFI:
1295                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1296                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
1297                        else
1298                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
1299                        break;
1300                case BTC_ANT_PATH_BT:
1301                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1302                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
1303                        else
1304                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
1305                        break;
1306                default:
1307                case BTC_ANT_PATH_PTA:
1308                        if (pBoardInfo->btdmAntPos == BTC_ANTENNA_AT_MAIN_PORT)
1309                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x200);
1310                        else
1311                                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x80);
1312                        break;
1313                }
1314        }
1315}
1316
1317static void halbtc8723b1ant_SetFwPstdma(
1318        PBTC_COEXIST pBtCoexist, u8 byte1, u8 byte2, u8 byte3, u8 byte4, u8 byte5
1319)
1320{
1321        u8 H2C_Parameter[5] = {0};
1322        u8 realByte1 = byte1, realByte5 = byte5;
1323        bool bApEnable = false;
1324
1325        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
1326
1327        if (bApEnable) {
1328                if (byte1&BIT4 && !(byte1&BIT5)) {
1329                        BTC_PRINT(
1330                                BTC_MSG_INTERFACE,
1331                                INTF_NOTIFY,
1332                                ("[BTCoex], FW for 1Ant AP mode\n")
1333                        );
1334                        realByte1 &= ~BIT4;
1335                        realByte1 |= BIT5;
1336
1337                        realByte5 |= BIT5;
1338                        realByte5 &= ~BIT6;
1339                }
1340        }
1341
1342        H2C_Parameter[0] = realByte1;
1343        H2C_Parameter[1] = byte2;
1344        H2C_Parameter[2] = byte3;
1345        H2C_Parameter[3] = byte4;
1346        H2C_Parameter[4] = realByte5;
1347
1348        pCoexDm->psTdmaPara[0] = realByte1;
1349        pCoexDm->psTdmaPara[1] = byte2;
1350        pCoexDm->psTdmaPara[2] = byte3;
1351        pCoexDm->psTdmaPara[3] = byte4;
1352        pCoexDm->psTdmaPara[4] = realByte5;
1353
1354        BTC_PRINT(
1355                BTC_MSG_ALGORITHM,
1356                ALGO_TRACE_FW_EXEC,
1357                (
1358                        "[BTCoex], PS-TDMA H2C cmd = 0x%x%08x\n",
1359                        H2C_Parameter[0],
1360                        H2C_Parameter[1]<<24|
1361                        H2C_Parameter[2]<<16|
1362                        H2C_Parameter[3]<<8|
1363                        H2C_Parameter[4]
1364                )
1365        );
1366
1367        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x60, 5, H2C_Parameter);
1368}
1369
1370
1371static void halbtc8723b1ant_PsTdma(
1372        PBTC_COEXIST pBtCoexist, bool bForceExec, bool bTurnOn, u8 type
1373)
1374{
1375        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
1376        bool bWifiBusy = false;
1377        u8 rssiAdjustVal = 0;
1378        u8 psTdmaByte4Val = 0x50, psTdmaByte0Val = 0x51, psTdmaByte3Val =  0x10;
1379        s8 nWiFiDurationAdjust = 0x0;
1380        /* u32          fwVer = 0; */
1381
1382        /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW, ("[BTCoex], %s turn %s PS TDMA, type =%d\n", */
1383        /*      (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); */
1384        pCoexDm->bCurPsTdmaOn = bTurnOn;
1385        pCoexDm->curPsTdma = type;
1386
1387        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
1388
1389        if (pCoexDm->bCurPsTdmaOn) {
1390                BTC_PRINT(
1391                        BTC_MSG_ALGORITHM,
1392                        ALGO_TRACE,
1393                        (
1394                                "[BTCoex], ********** TDMA(on, %d) **********\n",
1395                                pCoexDm->curPsTdma
1396                        )
1397                );
1398        } else {
1399                BTC_PRINT(
1400                        BTC_MSG_ALGORITHM,
1401                        ALGO_TRACE,
1402                        (
1403                                "[BTCoex], ********** TDMA(off, %d) **********\n",
1404                                pCoexDm->curPsTdma
1405                        )
1406                );
1407        }
1408
1409        if (!bForceExec) {
1410                if (
1411                        (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) &&
1412                        (pCoexDm->prePsTdma == pCoexDm->curPsTdma)
1413                )
1414                        return;
1415        }
1416
1417        if (pCoexSta->nScanAPNum <= 5)
1418                nWiFiDurationAdjust = 5;
1419        else if  (pCoexSta->nScanAPNum >= 40)
1420                nWiFiDurationAdjust = -15;
1421        else if  (pCoexSta->nScanAPNum >= 20)
1422                nWiFiDurationAdjust = -10;
1423
1424        if (!pCoexSta->bForceLpsOn) { /* only for A2DP-only case 1/2/9/11 */
1425                psTdmaByte0Val = 0x61;  /* no null-pkt */
1426                psTdmaByte3Val = 0x11; /*  no tx-pause at BT-slot */
1427                psTdmaByte4Val = 0x10; /*  0x778 = d/1 toggle */
1428        }
1429
1430
1431        if (bTurnOn) {
1432                if (pBtLinkInfo->bSlaveRole == true)
1433                        psTdmaByte4Val = psTdmaByte4Val | 0x1;  /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */
1434
1435
1436                switch (type) {
1437                default:
1438                        halbtc8723b1ant_SetFwPstdma(
1439                                pBtCoexist, 0x51, 0x1a, 0x1a, 0x0, psTdmaByte4Val
1440                        );
1441                        break;
1442                case 1:
1443                        halbtc8723b1ant_SetFwPstdma(
1444                                pBtCoexist,
1445                                psTdmaByte0Val,
1446                                0x3a+nWiFiDurationAdjust,
1447                                0x03,
1448                                psTdmaByte3Val,
1449                                psTdmaByte4Val
1450                        );
1451                        break;
1452                case 2:
1453                        halbtc8723b1ant_SetFwPstdma(
1454                                pBtCoexist,
1455                                psTdmaByte0Val,
1456                                0x2d+nWiFiDurationAdjust,
1457                                0x03,
1458                                psTdmaByte3Val,
1459                                psTdmaByte4Val
1460                        );
1461                        break;
1462                case 3:
1463                        halbtc8723b1ant_SetFwPstdma(
1464                                pBtCoexist, 0x51, 0x1d, 0x1d, 0x0, 0x10
1465                        );
1466                        break;
1467                case 4:
1468                        halbtc8723b1ant_SetFwPstdma(
1469                                pBtCoexist, 0x93, 0x15, 0x3, 0x14, 0x0
1470                        );
1471                        break;
1472                case 5:
1473                        halbtc8723b1ant_SetFwPstdma(
1474                                pBtCoexist, 0x61, 0x15, 0x3, 0x11, 0x10
1475                        );
1476                        break;
1477                case 6:
1478                        halbtc8723b1ant_SetFwPstdma(
1479                                pBtCoexist, 0x61, 0x20, 0x3, 0x11, 0x11
1480                        );
1481                        break;
1482                case 7:
1483                        halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xc, 0x5, 0x0, 0x0);
1484                        break;
1485                case 8:
1486                        halbtc8723b1ant_SetFwPstdma(
1487                                pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0
1488                        );
1489                        break;
1490                case 9:
1491                        halbtc8723b1ant_SetFwPstdma(
1492                                pBtCoexist,
1493                                psTdmaByte0Val,
1494                                0x21,
1495                                0x3,
1496                                psTdmaByte3Val,
1497                                psTdmaByte4Val
1498                        );
1499                        break;
1500                case 10:
1501                        halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x13, 0xa, 0xa, 0x0, 0x40);
1502                        break;
1503                case 11:
1504                        halbtc8723b1ant_SetFwPstdma(
1505                                pBtCoexist,
1506                                psTdmaByte0Val,
1507                                0x21,
1508                                0x03,
1509                                psTdmaByte3Val,
1510                                psTdmaByte4Val
1511                        );
1512                        break;
1513                case 12:
1514                        halbtc8723b1ant_SetFwPstdma(
1515                                pBtCoexist, 0x51, 0x0a, 0x0a, 0x0, 0x50
1516                        );
1517                        break;
1518                case 13:
1519                        halbtc8723b1ant_SetFwPstdma(
1520                                pBtCoexist, 0x51, 0x12, 0x12, 0x0, 0x10
1521                        );
1522                        break;
1523                case 14:
1524                        halbtc8723b1ant_SetFwPstdma(
1525                                pBtCoexist, 0x51, 0x21, 0x3, 0x10, psTdmaByte4Val
1526                        );
1527                        break;
1528                case 15:
1529                        halbtc8723b1ant_SetFwPstdma(
1530                                pBtCoexist, 0x13, 0xa, 0x3, 0x8, 0x0
1531                        );
1532                        break;
1533                case 16:
1534                        halbtc8723b1ant_SetFwPstdma(
1535                                pBtCoexist, 0x93, 0x15, 0x3, 0x10, 0x0
1536                        );
1537                        break;
1538                case 18:
1539                        halbtc8723b1ant_SetFwPstdma(
1540                                pBtCoexist, 0x93, 0x25, 0x3, 0x10, 0x0
1541                        );
1542                        break;
1543                case 20:
1544                        halbtc8723b1ant_SetFwPstdma(
1545                                pBtCoexist, 0x61, 0x3f, 0x03, 0x11, 0x10
1546
1547                        );
1548                        break;
1549                case 21:
1550                        halbtc8723b1ant_SetFwPstdma(
1551                                pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x11
1552                        );
1553                        break;
1554                case 22:
1555                        halbtc8723b1ant_SetFwPstdma(
1556                                pBtCoexist, 0x61, 0x25, 0x03, 0x11, 0x10
1557                        );
1558                        break;
1559                case 23:
1560                        halbtc8723b1ant_SetFwPstdma(
1561                                pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x18
1562                        );
1563                        break;
1564                case 24:
1565                        halbtc8723b1ant_SetFwPstdma(
1566                                pBtCoexist, 0xe3, 0x15, 0x3, 0x31, 0x18
1567                        );
1568                        break;
1569                case 25:
1570                        halbtc8723b1ant_SetFwPstdma(
1571                                pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18
1572                        );
1573                        break;
1574                case 26:
1575                        halbtc8723b1ant_SetFwPstdma(
1576                                pBtCoexist, 0xe3, 0xa, 0x3, 0x31, 0x18
1577                        );
1578                        break;
1579                case 27:
1580                        halbtc8723b1ant_SetFwPstdma(
1581                                pBtCoexist, 0xe3, 0x25, 0x3, 0x31, 0x98
1582                        );
1583                        break;
1584                case 28:
1585                        halbtc8723b1ant_SetFwPstdma(
1586                                pBtCoexist, 0x69, 0x25, 0x3, 0x31, 0x0
1587                        );
1588                        break;
1589                case 29:
1590                        halbtc8723b1ant_SetFwPstdma(
1591                                pBtCoexist, 0xab, 0x1a, 0x1a, 0x1, 0x10
1592                        );
1593                        break;
1594                case 30:
1595                        halbtc8723b1ant_SetFwPstdma(
1596                                pBtCoexist, 0x51, 0x30, 0x3, 0x10, 0x10
1597                        );
1598                        break;
1599                case 31:
1600                        halbtc8723b1ant_SetFwPstdma(
1601                                pBtCoexist, 0xd3, 0x1a, 0x1a, 0x0, 0x58
1602                        );
1603                        break;
1604                case 32:
1605                        halbtc8723b1ant_SetFwPstdma(
1606                                pBtCoexist, 0x61, 0x35, 0x3, 0x11, 0x11
1607                        );
1608                        break;
1609                case 33:
1610                        halbtc8723b1ant_SetFwPstdma(
1611                                pBtCoexist, 0xa3, 0x25, 0x3, 0x30, 0x90
1612                        );
1613                        break;
1614                case 34:
1615                        halbtc8723b1ant_SetFwPstdma(
1616                                pBtCoexist, 0x53, 0x1a, 0x1a, 0x0, 0x10
1617                        );
1618                        break;
1619                case 35:
1620                        halbtc8723b1ant_SetFwPstdma(
1621                                pBtCoexist, 0x63, 0x1a, 0x1a, 0x0, 0x10
1622                        );
1623                        break;
1624                case 36:
1625                        halbtc8723b1ant_SetFwPstdma(
1626                                pBtCoexist, 0xd3, 0x12, 0x3, 0x14, 0x50
1627                        );
1628                        break;
1629                case 40: /*  SoftAP only with no sta associated, BT disable , TDMA mode for power saving */
1630                        /* here softap mode screen off will cost 70-80mA for phone */
1631                        halbtc8723b1ant_SetFwPstdma(
1632                                pBtCoexist, 0x23, 0x18, 0x00, 0x10, 0x24
1633                        );
1634                        break;
1635                }
1636        } else {
1637
1638                /*  disable PS tdma */
1639                switch (type) {
1640                case 8: /* PTA Control */
1641                        halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x8, 0x0, 0x0, 0x0, 0x0);
1642                        halbtc8723b1ant_SetAntPath(
1643                                pBtCoexist, BTC_ANT_PATH_PTA, false, false
1644                        );
1645                        break;
1646                case 0:
1647                default:  /* Software control, Antenna at BT side */
1648                        halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);
1649                        halbtc8723b1ant_SetAntPath(
1650                                pBtCoexist, BTC_ANT_PATH_BT, false, false
1651                        );
1652                        break;
1653                case 9:   /* Software control, Antenna at WiFi side */
1654                        halbtc8723b1ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0);
1655                        halbtc8723b1ant_SetAntPath(
1656                                pBtCoexist, BTC_ANT_PATH_WIFI, false, false
1657                        );
1658                        break;
1659                }
1660        }
1661
1662        rssiAdjustVal = 0;
1663        pBtCoexist->fBtcSet(
1664                pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssiAdjustVal
1665        );
1666
1667        /*  update pre state */
1668        pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn;
1669        pCoexDm->prePsTdma = pCoexDm->curPsTdma;
1670}
1671
1672static bool halbtc8723b1ant_IsCommonAction(PBTC_COEXIST pBtCoexist)
1673{
1674        bool bCommon = false, bWifiConnected = false, bWifiBusy = false;
1675
1676        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
1677        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
1678
1679        if (
1680                !bWifiConnected &&
1681                BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus
1682        ) {
1683                BTC_PRINT(
1684                        BTC_MSG_ALGORITHM,
1685                        ALGO_TRACE,
1686                        ("[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n")
1687                );
1688
1689                /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1690
1691                bCommon = true;
1692        } else if (
1693                bWifiConnected &&
1694                (BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus)
1695        ) {
1696                BTC_PRINT(
1697                        BTC_MSG_ALGORITHM,
1698                        ALGO_TRACE,
1699                        ("[BTCoex], Wifi connected + BT non connected-idle!!\n")
1700                );
1701
1702                /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1703
1704                bCommon = true;
1705        } else if (
1706                !bWifiConnected &&
1707                (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)
1708        ) {
1709                BTC_PRINT(
1710                        BTC_MSG_ALGORITHM,
1711                        ALGO_TRACE,
1712                        ("[BTCoex], Wifi non connected-idle + BT connected-idle!!\n")
1713                );
1714
1715                /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1716
1717                bCommon = true;
1718        } else if (
1719                bWifiConnected &&
1720                (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)
1721        ) {
1722                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Wifi connected + BT connected-idle!!\n"));
1723
1724                /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1725
1726                bCommon = true;
1727        } else if (
1728                !bWifiConnected &&
1729                (BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus)
1730        ) {
1731                BTC_PRINT(
1732                        BTC_MSG_ALGORITHM,
1733                        ALGO_TRACE,
1734                        ("[BTCoex], Wifi non connected-idle + BT Busy!!\n")
1735                );
1736
1737                /* halbtc8723b1ant_SwMechanism(pBtCoexist, false); */
1738
1739                bCommon = true;
1740        } else {
1741                if (bWifiBusy) {
1742                        BTC_PRINT(
1743                                BTC_MSG_ALGORITHM,
1744                                ALGO_TRACE,
1745                                ("[BTCoex], Wifi Connected-Busy + BT Busy!!\n")
1746                        );
1747                } else {
1748                        BTC_PRINT(
1749                                BTC_MSG_ALGORITHM,
1750                                ALGO_TRACE,
1751                                ("[BTCoex], Wifi Connected-Idle + BT Busy!!\n")
1752                        );
1753                }
1754
1755                bCommon = false;
1756        }
1757
1758        return bCommon;
1759}
1760
1761
1762static void halbtc8723b1ant_TdmaDurationAdjustForAcl(
1763        PBTC_COEXIST pBtCoexist, u8 wifiStatus
1764)
1765{
1766        static s32 up, dn, m, n, WaitCount;
1767        s32 result;   /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */
1768        u8 retryCount = 0, btInfoExt;
1769        bool bWifiBusy = false;
1770
1771        BTC_PRINT(
1772                BTC_MSG_ALGORITHM,
1773                ALGO_TRACE_FW,
1774                ("[BTCoex], TdmaDurationAdjustForAcl()\n")
1775        );
1776
1777        if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifiStatus)
1778                bWifiBusy = true;
1779        else
1780                bWifiBusy = false;
1781
1782        if (
1783                (BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == wifiStatus) ||
1784                (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifiStatus) ||
1785                (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == wifiStatus)
1786        ) {
1787                if (
1788                        pCoexDm->curPsTdma != 1 &&
1789                        pCoexDm->curPsTdma != 2 &&
1790                        pCoexDm->curPsTdma != 3 &&
1791                        pCoexDm->curPsTdma != 9
1792                ) {
1793                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1794                        pCoexDm->psTdmaDuAdjType = 9;
1795
1796                        up = 0;
1797                        dn = 0;
1798                        m = 1;
1799                        n = 3;
1800                        result = 0;
1801                        WaitCount = 0;
1802                }
1803                return;
1804        }
1805
1806        if (!pCoexDm->bAutoTdmaAdjust) {
1807                pCoexDm->bAutoTdmaAdjust = true;
1808                BTC_PRINT(
1809                        BTC_MSG_ALGORITHM,
1810                        ALGO_TRACE_FW_DETAIL,
1811                        ("[BTCoex], first run TdmaDurationAdjust()!!\n")
1812                );
1813
1814                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1815                pCoexDm->psTdmaDuAdjType = 2;
1816                /*  */
1817                up = 0;
1818                dn = 0;
1819                m = 1;
1820                n = 3;
1821                result = 0;
1822                WaitCount = 0;
1823        } else {
1824                /* accquire the BT TRx retry count from BT_Info byte2 */
1825                retryCount = pCoexSta->btRetryCnt;
1826                btInfoExt = pCoexSta->btInfoExt;
1827                /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], retryCount = %d\n", retryCount)); */
1828                /* BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], up =%d, dn =%d, m =%d, n =%d, WaitCount =%d\n", */
1829                /*      up, dn, m, n, WaitCount)); */
1830
1831                if (pCoexSta->lowPriorityTx > 1050 || pCoexSta->lowPriorityRx > 1250)
1832                        retryCount++;
1833
1834                result = 0;
1835                WaitCount++;
1836
1837                if (retryCount == 0) { /*  no retry in the last 2-second duration */
1838                        up++;
1839                        dn--;
1840
1841                        if (dn <= 0)
1842                                dn = 0;
1843
1844                        if (up >= n) { /*  if 連續 n 個2秒 retry count為0, 則調寬WiFi duration */
1845                                WaitCount = 0;
1846                                n = 3;
1847                                up = 0;
1848                                dn = 0;
1849                                result = 1;
1850                                BTC_PRINT(
1851                                        BTC_MSG_ALGORITHM,
1852                                        ALGO_TRACE_FW_DETAIL,
1853                                        ("[BTCoex], Increase wifi duration!!\n")
1854                                );
1855                        }
1856                } else if (retryCount <= 3) { /*  <=3 retry in the last 2-second duration */
1857                        up--;
1858                        dn++;
1859
1860                        if (up <= 0)
1861                                up = 0;
1862
1863                        if (dn == 2) { /*  if 連續 2 個2秒 retry count< 3, 則調窄WiFi duration */
1864                                if (WaitCount <= 2)
1865                                        m++; /*  避免一直在兩個level中來回 */
1866                                else
1867                                        m = 1;
1868
1869                                if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */
1870                                        m = 20;
1871
1872                                n = 3*m;
1873                                up = 0;
1874                                dn = 0;
1875                                WaitCount = 0;
1876                                result = -1;
1877                                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE_FW_DETAIL, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n"));
1878                        }
1879                } else { /* retry count > 3, 只要1次 retry count > 3, 則調窄WiFi duration */
1880                        if (WaitCount == 1)
1881                                m++; /*  避免一直在兩個level中來回 */
1882                        else
1883                                m = 1;
1884
1885                        if (m >= 20) /* m 最大值 = 20 ' 最大120秒 recheck是否調整 WiFi duration. */
1886                                m = 20;
1887
1888                        n = 3*m;
1889                        up = 0;
1890                        dn = 0;
1891                        WaitCount = 0;
1892                        result = -1;
1893                        BTC_PRINT(
1894                                BTC_MSG_ALGORITHM,
1895                                ALGO_TRACE_FW_DETAIL,
1896                                ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")
1897                        );
1898                }
1899
1900                if (result == -1) {
1901                        if (
1902                                BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) &&
1903                                ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2))
1904                        ) {
1905                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1906                                pCoexDm->psTdmaDuAdjType = 9;
1907                        } else if (pCoexDm->curPsTdma == 1) {
1908                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1909                                pCoexDm->psTdmaDuAdjType = 2;
1910                        } else if (pCoexDm->curPsTdma == 2) {
1911                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1912                                pCoexDm->psTdmaDuAdjType = 9;
1913                        } else if (pCoexDm->curPsTdma == 9) {
1914                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 11);
1915                                pCoexDm->psTdmaDuAdjType = 11;
1916                        }
1917                } else if (result == 1) {
1918                        if (
1919                                BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(btInfoExt) &&
1920                                ((pCoexDm->curPsTdma == 1) || (pCoexDm->curPsTdma == 2))
1921                        ) {
1922                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1923                                pCoexDm->psTdmaDuAdjType = 9;
1924                        } else if (pCoexDm->curPsTdma == 11) {
1925                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 9);
1926                                pCoexDm->psTdmaDuAdjType = 9;
1927                        } else if (pCoexDm->curPsTdma == 9) {
1928                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 2);
1929                                pCoexDm->psTdmaDuAdjType = 2;
1930                        } else if (pCoexDm->curPsTdma == 2) {
1931                                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 1);
1932                                pCoexDm->psTdmaDuAdjType = 1;
1933                        }
1934                } else {          /* no change */
1935                        BTC_PRINT(
1936                                BTC_MSG_ALGORITHM,
1937                                ALGO_TRACE_FW_DETAIL,
1938                                (
1939                                        "[BTCoex], ********** TDMA(on, %d) **********\n",
1940                                        pCoexDm->curPsTdma
1941                                )
1942                        );
1943                }
1944
1945                if (
1946                        pCoexDm->curPsTdma != 1 &&
1947                        pCoexDm->curPsTdma != 2 &&
1948                        pCoexDm->curPsTdma != 9 &&
1949                        pCoexDm->curPsTdma != 11
1950                ) /*  recover to previous adjust type */
1951                        halbtc8723b1ant_PsTdma(
1952                                pBtCoexist, NORMAL_EXEC, true, pCoexDm->psTdmaDuAdjType
1953                        );
1954        }
1955}
1956
1957static void halbtc8723b1ant_PsTdmaCheckForPowerSaveState(
1958        PBTC_COEXIST pBtCoexist, bool bNewPsState
1959)
1960{
1961        u8 lpsMode = 0x0;
1962
1963        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_LPS_MODE, &lpsMode);
1964
1965        if (lpsMode) {  /*  already under LPS state */
1966                if (bNewPsState) {
1967                        /*  keep state under LPS, do nothing. */
1968                } else /*  will leave LPS state, turn off psTdma first */
1969                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
1970        } else {                                                /*  NO PS state */
1971                if (bNewPsState) /*  will enter LPS state, turn off psTdma first */
1972                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
1973                else {
1974                        /*  keep state under NO PS state, do nothing. */
1975                }
1976        }
1977}
1978
1979static void halbtc8723b1ant_PowerSaveState(
1980        PBTC_COEXIST pBtCoexist, u8 psType, u8 lpsVal, u8 rpwmVal
1981)
1982{
1983        bool bLowPwrDisable = false;
1984
1985        switch (psType) {
1986        case BTC_PS_WIFI_NATIVE:
1987                /*  recover to original 32k low power setting */
1988                bLowPwrDisable = false;
1989                pBtCoexist->fBtcSet(
1990                        pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable
1991                );
1992                pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL);
1993                pCoexSta->bForceLpsOn = false;
1994                break;
1995        case BTC_PS_LPS_ON:
1996                halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, true);
1997                halbtc8723b1ant_LpsRpwm(pBtCoexist, NORMAL_EXEC, lpsVal, rpwmVal);
1998                /*  when coex force to enter LPS, do not enter 32k low power. */
1999                bLowPwrDisable = true;
2000                pBtCoexist->fBtcSet(

2001                        pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable
2002                );
2003                /*  power save must executed before psTdma. */
2004                pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL);
2005                pCoexSta->bForceLpsOn = true;
2006                break;
2007        case BTC_PS_LPS_OFF:
2008                halbtc8723b1ant_PsTdmaCheckForPowerSaveState(pBtCoexist, false);
2009                pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_LEAVE_LPS, NULL);
2010                pCoexSta->bForceLpsOn = false;
2011                break;
2012        default:
2013                break;
2014        }
2015}
2016
2017/*  */
2018/*  */
2019/*      Software Coex Mechanism start */
2020/*  */
2021/*  */
2022
2023/*  */
2024/*  */
2025/*      Non-Software Coex Mechanism start */
2026/*  */
2027/*  */
2028static void halbtc8723b1ant_ActionWifiMultiPort(PBTC_COEXIST pBtCoexist)
2029{
2030        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2031
2032        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2033        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2034}
2035
2036static void halbtc8723b1ant_ActionHs(PBTC_COEXIST pBtCoexist)
2037{
2038        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5);
2039        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2040}
2041
2042static void halbtc8723b1ant_ActionBtInquiry(PBTC_COEXIST pBtCoexist)
2043{
2044        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2045        bool bWifiConnected = false;
2046        bool bApEnable = false;
2047        bool bWifiBusy = false;
2048        bool bBtBusy = false;
2049
2050        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
2051        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
2052        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2053        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);
2054
2055        if (!bWifiConnected && !pCoexSta->bWiFiIsHighPriTask) {
2056                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2057                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2058
2059                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
2060        } else if (
2061                pBtLinkInfo->bScoExist ||
2062                pBtLinkInfo->bHidExist ||
2063                pBtLinkInfo->bA2dpExist
2064        ) {
2065                /*  SCO/HID/A2DP busy */
2066                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2067                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2068
2069                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2070        } else if (pBtLinkInfo->bPanExist || bWifiBusy) {
2071                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2072                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2073
2074                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2075        } else {
2076                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2077                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2078
2079                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2080        }
2081}
2082
2083static void halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2084        PBTC_COEXIST pBtCoexist, u8 wifiStatus
2085)
2086{
2087        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2088        bool bWifiConnected = false;
2089
2090        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
2091
2092        /*  tdma and coex table */
2093
2094        if (pBtLinkInfo->bScoExist) {
2095                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 5);
2096                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);
2097        } else { /* HID */
2098                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 6);
2099                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 5);
2100        }
2101}
2102
2103static void halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2104        PBTC_COEXIST pBtCoexist, u8 wifiStatus
2105)
2106{
2107        u8 btRssiState;
2108
2109        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2110        btRssiState = halbtc8723b1ant_BtRssiState(2, 28, 0);
2111
2112        if ((pCoexSta->lowPriorityRx >= 1000) && (pCoexSta->lowPriorityRx != 65535))
2113                pBtLinkInfo->bSlaveRole = true;
2114        else
2115                pBtLinkInfo->bSlaveRole = false;
2116
2117        if (pBtLinkInfo->bHidOnly) { /* HID */
2118                halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist, wifiStatus);
2119                pCoexDm->bAutoTdmaAdjust = false;
2120                return;
2121        } else if (pBtLinkInfo->bA2dpOnly) { /* A2DP */
2122                if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifiStatus) {
2123                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2124                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2125                        pCoexDm->bAutoTdmaAdjust = false;
2126                } else {
2127                        halbtc8723b1ant_TdmaDurationAdjustForAcl(pBtCoexist, wifiStatus);
2128                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2129                        pCoexDm->bAutoTdmaAdjust = true;
2130                }
2131        } else if (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist) { /* HID+A2DP */
2132                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 14);
2133                pCoexDm->bAutoTdmaAdjust = false;
2134
2135                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2136        } else if (
2137                pBtLinkInfo->bPanOnly ||
2138                (pBtLinkInfo->bHidExist && pBtLinkInfo->bPanExist)
2139        ) { /* PAN(OPP, FTP), HID+PAN(OPP, FTP) */
2140                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 3);
2141                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2142                pCoexDm->bAutoTdmaAdjust = false;
2143        } else if (
2144                (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) ||
2145                (pBtLinkInfo->bHidExist && pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist)
2146        ) { /* A2DP+PAN(OPP, FTP), HID+A2DP+PAN(OPP, FTP) */
2147                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 13);
2148                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2149                pCoexDm->bAutoTdmaAdjust = false;
2150        } else {
2151                /* BT no-profile busy (0x9) */
2152                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2153                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2154                pCoexDm->bAutoTdmaAdjust = false;
2155        }
2156}
2157
2158static void halbtc8723b1ant_ActionWifiNotConnected(PBTC_COEXIST pBtCoexist)
2159{
2160        /*  power save state */
2161        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2162
2163        /*  tdma and coex table */
2164        halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8);
2165        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
2166}
2167
2168static void halbtc8723b1ant_ActionWifiNotConnectedScan(
2169        PBTC_COEXIST pBtCoexist
2170)
2171{
2172        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2173
2174        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2175
2176        /*  tdma and coex table */
2177        if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2178                if (pBtLinkInfo->bA2dpExist) {
2179                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2180                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2181                } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) {
2182                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22);
2183                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2184                } else {
2185                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2186                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2187                }
2188        } else if (
2189                (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2190                (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2191        ) {
2192                halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2193                        pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN
2194                );
2195        } else {
2196                /* Bryant Add */
2197                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2198                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2199        }
2200}
2201
2202static void halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(
2203        PBTC_COEXIST pBtCoexist
2204)
2205{
2206        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2207
2208        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2209
2210        /*  tdma and coex table */
2211        if (
2212                (pBtLinkInfo->bScoExist) ||
2213                (pBtLinkInfo->bHidExist) ||
2214                (pBtLinkInfo->bA2dpExist)
2215        ) {
2216                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2217                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2218        } else if (pBtLinkInfo->bPanExist) {
2219                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2220                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2221        } else {
2222                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2223                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2224        }
2225}
2226
2227static void halbtc8723b1ant_ActionWifiConnectedScan(PBTC_COEXIST pBtCoexist)
2228{
2229        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2230
2231        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2232
2233        /*  tdma and coex table */
2234        if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2235                if (pBtLinkInfo->bA2dpExist) {
2236                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2237                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2238                } else if (pBtLinkInfo->bA2dpExist && pBtLinkInfo->bPanExist) {
2239                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 22);
2240                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2241                } else {
2242                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2243                        halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2244                }
2245        } else if (
2246                (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2247                (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2248        ) {
2249                halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2250                        pBtCoexist, BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN
2251                );
2252        } else {
2253                /* Bryant Add */
2254                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2255                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2256        }
2257}
2258
2259static void halbtc8723b1ant_ActionWifiConnectedSpecialPacket(
2260        PBTC_COEXIST pBtCoexist
2261)
2262{
2263        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2264
2265        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2266
2267        /*  tdma and coex table */
2268        if (
2269                (pBtLinkInfo->bScoExist) ||
2270                (pBtLinkInfo->bHidExist) ||
2271                (pBtLinkInfo->bA2dpExist)
2272        ) {
2273                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 32);
2274                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2275        } else if (pBtLinkInfo->bPanExist) {
2276                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, true, 20);
2277                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 4);
2278        } else {
2279                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2280                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2281        }
2282}
2283
2284static void halbtc8723b1ant_ActionWifiConnected(PBTC_COEXIST pBtCoexist)
2285{
2286        bool bWifiBusy = false;
2287        bool bScan = false, bLink = false, bRoam = false;
2288        bool bUnder4way = false, bApEnable = false;
2289
2290        BTC_PRINT(
2291                BTC_MSG_ALGORITHM,
2292                ALGO_TRACE,
2293                ("[BTCoex], CoexForWifiConnect() ===>\n")
2294        );
2295
2296        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &bUnder4way);
2297        if (bUnder4way) {
2298                halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
2299                BTC_PRINT(
2300                        BTC_MSG_ALGORITHM,
2301                        ALGO_TRACE,
2302                        ("[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n")
2303                );
2304                return;
2305        }
2306
2307        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2308        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2309        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2310        if (bScan || bLink || bRoam) {
2311                if (bScan)
2312                        halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);
2313                else
2314                        halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
2315                BTC_PRINT(
2316                        BTC_MSG_ALGORITHM,
2317                        ALGO_TRACE,
2318                        ("[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n")
2319                );
2320                return;
2321        }
2322
2323        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable);
2324        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2325
2326        /*  power save state */
2327        if (
2328                !bApEnable &&
2329                BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus &&
2330                !pBtCoexist->btLinkInfo.bHidOnly
2331        ) {
2332                if (pBtCoexist->btLinkInfo.bA2dpOnly) { /* A2DP */
2333                        if (!bWifiBusy)
2334                                halbtc8723b1ant_PowerSaveState(
2335                                        pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0
2336                                );
2337                        else { /* busy */
2338                                if  (pCoexSta->nScanAPNum >= BT_8723B_1ANT_WIFI_NOISY_THRESH)  /* no force LPS, no PS-TDMA, use pure TDMA */
2339                                        halbtc8723b1ant_PowerSaveState(
2340                                                pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0
2341                                        );
2342                                else
2343                                        halbtc8723b1ant_PowerSaveState(
2344                                                pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4
2345                                        );
2346                        }
2347                } else if (
2348                        (pCoexSta->bPanExist == false) &&
2349                        (pCoexSta->bA2dpExist == false) &&
2350                        (pCoexSta->bHidExist == false)
2351                )
2352                        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2353                else
2354                        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_LPS_ON, 0x50, 0x4);
2355        } else
2356                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
2357
2358        /*  tdma and coex table */
2359        if (!bWifiBusy) {
2360                if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2361                        halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2362                                pBtCoexist,
2363                                BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE
2364                        );
2365                } else if (
2366                        (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2367                        (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2368                ) {
2369                        halbtc8723b1ant_ActionBtScoHidOnlyBusy(pBtCoexist,
2370                                BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE);
2371                } else {
2372                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2373
2374                        if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60)
2375                                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2376                        else
2377                                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2378                }
2379        } else {
2380                if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) {
2381                        halbtc8723b1ant_ActionWifiConnectedBtAclBusy(
2382                                pBtCoexist,
2383                                BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY
2384                        );
2385                } else if (
2386                        (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2387                        (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2388                ) {
2389                        halbtc8723b1ant_ActionBtScoHidOnlyBusy(
2390                                pBtCoexist,
2391                                BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY
2392                        );
2393                } else {
2394                        halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 8);
2395
2396                        if ((pCoexSta->highPriorityTx) + (pCoexSta->highPriorityRx) <= 60)
2397                                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
2398                        else
2399                                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 7);
2400                }
2401        }
2402}
2403
2404static void halbtc8723b1ant_RunSwCoexistMechanism(PBTC_COEXIST pBtCoexist)
2405{
2406        u8 algorithm = 0;
2407
2408        algorithm = halbtc8723b1ant_ActionAlgorithm(pBtCoexist);
2409        pCoexDm->curAlgorithm = algorithm;
2410
2411        if (halbtc8723b1ant_IsCommonAction(pBtCoexist)) {
2412
2413        } else {
2414                switch (pCoexDm->curAlgorithm) {
2415                case BT_8723B_1ANT_COEX_ALGO_SCO:
2416                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = SCO.\n"));
2417                        /* halbtc8723b1ant_ActionSco(pBtCoexist); */
2418                        break;
2419                case BT_8723B_1ANT_COEX_ALGO_HID:
2420                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID.\n"));
2421                        /* halbtc8723b1ant_ActionHid(pBtCoexist); */
2422                        break;
2423                case BT_8723B_1ANT_COEX_ALGO_A2DP:
2424                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP.\n"));
2425                        /* halbtc8723b1ant_ActionA2dp(pBtCoexist); */
2426                        break;
2427                case BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS:
2428                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = A2DP+PAN(HS).\n"));
2429                        /* halbtc8723b1ant_ActionA2dpPanHs(pBtCoexist); */
2430                        break;
2431                case BT_8723B_1ANT_COEX_ALGO_PANEDR:
2432                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR).\n"));
2433                        /* halbtc8723b1ant_ActionPanEdr(pBtCoexist); */
2434                        break;
2435                case BT_8723B_1ANT_COEX_ALGO_PANHS:
2436                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HS mode.\n"));
2437                        /* halbtc8723b1ant_ActionPanHs(pBtCoexist); */
2438                        break;
2439                case BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP:
2440                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN+A2DP.\n"));
2441                        /* halbtc8723b1ant_ActionPanEdrA2dp(pBtCoexist); */
2442                        break;
2443                case BT_8723B_1ANT_COEX_ALGO_PANEDR_HID:
2444                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = PAN(EDR)+HID.\n"));
2445                        /* halbtc8723b1ant_ActionPanEdrHid(pBtCoexist); */
2446                        break;
2447                case BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR:
2448                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP+PAN.\n"));
2449                        /* halbtc8723b1ant_ActionHidA2dpPanEdr(pBtCoexist); */
2450                        break;
2451                case BT_8723B_1ANT_COEX_ALGO_HID_A2DP:
2452                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = HID+A2DP.\n"));
2453                        /* halbtc8723b1ant_ActionHidA2dp(pBtCoexist); */
2454                        break;
2455                default:
2456                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Action algorithm = coexist All Off!!\n"));
2457                        break;
2458                }
2459                pCoexDm->preAlgorithm = pCoexDm->curAlgorithm;
2460        }
2461}
2462
2463static void halbtc8723b1ant_RunCoexistMechanism(PBTC_COEXIST pBtCoexist)
2464{
2465        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2466        bool bWifiConnected = false, bBtHsOn = false;
2467        bool bIncreaseScanDevNum = false;
2468        bool bBtCtrlAggBufSize = false;
2469        u8 aggBufSize = 5;
2470        u32 wifiLinkStatus = 0;
2471        u32 numOfWifiLink = 0;
2472
2473        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism() ===>\n"));
2474
2475        if (pBtCoexist->bManualControl) {
2476                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"));
2477                return;
2478        }
2479
2480        if (pBtCoexist->bStopCoexDm) {
2481                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"));
2482                return;
2483        }
2484
2485        if (pCoexSta->bUnderIps) {
2486                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is under IPS !!!\n"));
2487                return;
2488        }
2489
2490        if (
2491                (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||
2492                (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
2493                (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
2494        ){
2495                bIncreaseScanDevNum = true;
2496        }
2497
2498        pBtCoexist->fBtcSet(
2499                pBtCoexist,
2500                BTC_SET_BL_INC_SCAN_DEV_NUM,
2501                &bIncreaseScanDevNum
2502        );
2503        pBtCoexist->fBtcGet(
2504                pBtCoexist,
2505                BTC_GET_BL_WIFI_CONNECTED,
2506                &bWifiConnected
2507        );
2508
2509        pBtCoexist->fBtcGet(
2510                pBtCoexist,
2511                BTC_GET_U4_WIFI_LINK_STATUS,
2512                &wifiLinkStatus
2513        );
2514        numOfWifiLink = wifiLinkStatus>>16;
2515
2516        if ((numOfWifiLink >= 2) || (wifiLinkStatus&WIFI_P2P_GO_CONNECTED)) {
2517                BTC_PRINT(
2518                        BTC_MSG_INTERFACE,
2519                        INTF_NOTIFY,
2520                        (
2521                                "############# [BTCoex],  Multi-Port numOfWifiLink = %d, wifiLinkStatus = 0x%x\n",
2522                                numOfWifiLink,
2523                                wifiLinkStatus
2524                        )
2525                );
2526                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
2527                halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize);
2528
2529                if ((pBtLinkInfo->bA2dpExist) && (pCoexSta->bC2hBtInquiryPage)) {
2530                        BTC_PRINT(
2531                                BTC_MSG_INTERFACE,
2532                                INTF_NOTIFY,
2533                                ("############# [BTCoex],  BT Is Inquirying\n")
2534                        );
2535                        halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
2536                } else
2537                        halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
2538
2539                return;
2540        }
2541
2542        if ((pBtLinkInfo->bBtLinkExist) && (bWifiConnected)) {
2543                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 1, 1, 0, 1);
2544
2545                if (pBtLinkInfo->bScoExist)
2546                        halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x5);
2547                else
2548                        halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, true, 0x8);
2549
2550                halbtc8723b1ant_SwMechanism(pBtCoexist, true);
2551                halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist);  /* just print debug message */
2552        } else {
2553                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
2554
2555                halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, false, 0x5);
2556
2557                halbtc8723b1ant_SwMechanism(pBtCoexist, false);
2558                halbtc8723b1ant_RunSwCoexistMechanism(pBtCoexist); /* just print debug message */
2559        }
2560
2561        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
2562        if (pCoexSta->bC2hBtInquiryPage) {
2563                BTC_PRINT(
2564                        BTC_MSG_INTERFACE,
2565                        INTF_NOTIFY,
2566                        ("############# [BTCoex],  BT Is Inquirying\n")
2567                );
2568                halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
2569                return;
2570        } else if (bBtHsOn) {
2571                halbtc8723b1ant_ActionHs(pBtCoexist);
2572                return;
2573        }
2574
2575
2576        if (!bWifiConnected) {
2577                bool bScan = false, bLink = false, bRoam = false;
2578
2579                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], wifi is non connected-idle !!!\n"));
2580
2581                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2582                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2583                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2584
2585                if (bScan || bLink || bRoam) {
2586                         if (bScan)
2587                                halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist);
2588                         else
2589                                halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);
2590                } else
2591                        halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
2592        } else /*  wifi LPS/Busy */
2593                halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
2594}
2595
2596static void halbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist)
2597{
2598        /*  force to reset coex mechanism */
2599
2600        /*  sw all off */
2601        halbtc8723b1ant_SwMechanism(pBtCoexist, false);
2602
2603        /* halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8); */
2604        halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);
2605
2606        pCoexSta->popEventCnt = 0;
2607}
2608
2609static void halbtc8723b1ant_InitHwConfig(
2610        PBTC_COEXIST pBtCoexist,
2611        bool bBackUp,
2612        bool bWifiOnly
2613)
2614{
2615        u32 u4Tmp = 0;/*  fwVer; */
2616        u8 u1Tmpa = 0, u1Tmpb = 0;
2617
2618        BTC_PRINT(
2619                BTC_MSG_INTERFACE,
2620                INTF_INIT,
2621                ("[BTCoex], 1Ant Init HW Config!!\n")
2622        );
2623
2624        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x550, 0x8, 0x1);  /* enable TBTT nterrupt */
2625
2626        /*  0x790[5:0]= 0x5 */
2627        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x790, 0x5);
2628
2629        /*  Enable counter statistics */
2630        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1);
2631        pBtCoexist->fBtcWrite1ByteBitMask(pBtCoexist, 0x40, 0x20, 0x1);
2632
2633        /* Antenna config */
2634        if (bWifiOnly) {
2635                halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_WIFI, true, false);
2636                halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 9);
2637        } else
2638                halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, true, false);
2639
2640        /*  PTA parameter */
2641        halbtc8723b1ant_CoexTableWithType(pBtCoexist, FORCE_EXEC, 0);
2642
2643        u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
2644        u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);
2645        u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
2646
2647        BTC_PRINT(
2648                BTC_MSG_INTERFACE,
2649                INTF_NOTIFY,
2650                (
2651                        "############# [BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n",
2652                        u4Tmp,
2653                        u1Tmpa,
2654                        u1Tmpb
2655                )
2656        );
2657}
2658
2659/*  */
2660/*  work around function start with wa_halbtc8723b1ant_ */
2661/*  */
2662/*  */
2663/*  extern function start with EXhalbtc8723b1ant_ */
2664/*  */
2665void EXhalbtc8723b1ant_PowerOnSetting(PBTC_COEXIST pBtCoexist)
2666{
2667        PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
2668        u8 u1Tmp = 0x0;
2669        u16 u2Tmp = 0x0;
2670
2671        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x67, 0x20);
2672
2673        /*  enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */
2674        u2Tmp = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x2);
2675        pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x2, u2Tmp|BIT0|BIT1);
2676
2677        /*  set GRAN_BT = 1 */
2678        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x765, 0x18);
2679        /*  set WLAN_ACT = 0 */
2680        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4);
2681
2682        /*  */
2683        /*  S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */
2684        /*  Local setting bit define */
2685        /*      BIT0: "0" for no antenna inverse; "1" for antenna inverse */
2686        /*      BIT1: "0" for internal switch; "1" for external switch */
2687        /*      BIT2: "0" for one antenna; "1" for two antenna */
2688        /*  NOTE: here default all internal switch and 1-antenna ==> BIT1 = 0 and BIT2 = 0 */
2689        if (pBtCoexist->chipInterface == BTC_INTF_USB) {
2690                /*  fixed at S0 for USB interface */
2691                pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
2692
2693                u1Tmp |= 0x1;   /*  antenna inverse */
2694                pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0xfe08, u1Tmp);
2695
2696                pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;
2697        } else {
2698                /*  for PCIE and SDIO interface, we check efuse 0xc3[6] */
2699                if (pBoardInfo->singleAntPath == 0) {
2700                        /*  set to S1 */
2701                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x280);
2702                        pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_MAIN_PORT;
2703                } else if (pBoardInfo->singleAntPath == 1) {
2704                        /*  set to S0 */
2705                        pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x948, 0x0);
2706                        u1Tmp |= 0x1;   /*  antenna inverse */
2707                        pBoardInfo->btdmAntPos = BTC_ANTENNA_AT_AUX_PORT;
2708                }
2709
2710                if (pBtCoexist->chipInterface == BTC_INTF_PCI)
2711                        pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x384, u1Tmp);
2712                else if (pBtCoexist->chipInterface == BTC_INTF_SDIO)
2713                        pBtCoexist->fBtcWriteLocalReg1Byte(pBtCoexist, 0x60, u1Tmp);
2714        }
2715}
2716
2717void EXhalbtc8723b1ant_InitHwConfig(PBTC_COEXIST pBtCoexist, bool bWifiOnly)
2718{
2719        halbtc8723b1ant_InitHwConfig(pBtCoexist, true, bWifiOnly);
2720}
2721
2722void EXhalbtc8723b1ant_InitCoexDm(PBTC_COEXIST pBtCoexist)
2723{
2724        BTC_PRINT(
2725                BTC_MSG_INTERFACE,
2726                INTF_INIT,
2727                ("[BTCoex], Coex Mechanism Init!!\n")
2728        );
2729
2730        pBtCoexist->bStopCoexDm = false;
2731
2732        halbtc8723b1ant_InitCoexDm(pBtCoexist);
2733
2734        halbtc8723b1ant_QueryBtInfo(pBtCoexist);
2735}
2736
2737void EXhalbtc8723b1ant_DisplayCoexInfo(PBTC_COEXIST pBtCoexist)
2738{
2739        PBTC_BOARD_INFO pBoardInfo = &pBtCoexist->boardInfo;
2740        PBTC_STACK_INFO pStackInfo = &pBtCoexist->stackInfo;
2741        PBTC_BT_LINK_INFO pBtLinkInfo = &pBtCoexist->btLinkInfo;
2742        u8 *cliBuf = pBtCoexist->cliBuf;
2743        u8 u1Tmp[4], i, btInfoExt, psTdmaCase = 0;
2744        u16 u2Tmp[4];
2745        u32 u4Tmp[4];
2746        bool bRoam = false;
2747        bool bScan = false;
2748        bool bLink = false;
2749        bool bWifiUnder5G = false;
2750        bool bWifiUnderBMode = false;
2751        bool bBtHsOn = false;
2752        bool bWifiBusy = false;
2753        s32 wifiRssi = 0, btHsRssi = 0;
2754        u32 wifiBw, wifiTrafficDir, faOfdm, faCck, wifiLinkStatus;
2755        u8 wifiDot11Chnl, wifiHsChnl;
2756        u32 fwVer = 0, btPatchVer = 0;
2757        static u8 PopReportIn10s;
2758
2759        CL_SPRINTF(
2760                cliBuf,
2761                BT_TMP_BUF_SIZE,
2762                "\r\n ============[BT Coexist info]============"
2763        );
2764        CL_PRINTF(cliBuf);
2765
2766        if (pBtCoexist->bManualControl) {
2767                CL_SPRINTF(
2768                        cliBuf,
2769                        BT_TMP_BUF_SIZE,
2770                        "\r\n ============[Under Manual Control]============"
2771                );
2772                CL_PRINTF(cliBuf);
2773                CL_SPRINTF(cliBuf,
2774                        BT_TMP_BUF_SIZE,
2775                        "\r\n =========================================="
2776                );
2777                CL_PRINTF(cliBuf);
2778        }
2779        if (pBtCoexist->bStopCoexDm) {
2780                CL_SPRINTF(
2781                        cliBuf,
2782                        BT_TMP_BUF_SIZE,
2783                        "\r\n ============[Coex is STOPPED]============"
2784                );
2785                CL_PRINTF(cliBuf);
2786                CL_SPRINTF(
2787                        cliBuf,
2788                        BT_TMP_BUF_SIZE,
2789                        "\r\n =========================================="
2790                );
2791                CL_PRINTF(cliBuf);
2792        }
2793
2794        CL_SPRINTF(
2795                cliBuf,
2796                BT_TMP_BUF_SIZE,
2797                "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Ant Mech/ Ant Pos:", \
2798                pBoardInfo->pgAntNum,
2799                pBoardInfo->btdmAntNum,
2800                pBoardInfo->btdmAntPos
2801        );
2802        CL_PRINTF(cliBuf);
2803
2804        CL_SPRINTF(
2805                cliBuf,
2806                BT_TMP_BUF_SIZE,
2807                "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \
2808                ((pStackInfo->bProfileNotified) ? "Yes" : "No"),
2809                pStackInfo->hciVersion
2810        );
2811        CL_PRINTF(cliBuf);
2812
2813        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);
2814        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);
2815        CL_SPRINTF(
2816                cliBuf,
2817                BT_TMP_BUF_SIZE,
2818                "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", "CoexVer/ FwVer/ PatchVer", \
2819                GLCoexVerDate8723b1Ant,
2820                GLCoexVer8723b1Ant,
2821                fwVer,
2822                btPatchVer,
2823                btPatchVer
2824        );
2825        CL_PRINTF(cliBuf);
2826
2827        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
2828        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiDot11Chnl);
2829        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_HS_CHNL, &wifiHsChnl);
2830        CL_SPRINTF(
2831                cliBuf,
2832                BT_TMP_BUF_SIZE,
2833                "\r\n %-35s = %d / %d(%d)", "Dot11 channel / HsChnl(HsMode)", \
2834                wifiDot11Chnl,
2835                wifiHsChnl,
2836                bBtHsOn
2837        );
2838        CL_PRINTF(cliBuf);
2839
2840        CL_SPRINTF(
2841                cliBuf,
2842                BT_TMP_BUF_SIZE,
2843                "\r\n %-35s = %02x %02x %02x ", "H2C Wifi inform bt chnl Info", \
2844                pCoexDm->wifiChnlInfo[0],
2845                pCoexDm->wifiChnlInfo[1],
2846                pCoexDm->wifiChnlInfo[2]
2847        );
2848        CL_PRINTF(cliBuf);
2849
2850        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi);
2851        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi);
2852        CL_SPRINTF(
2853                cliBuf,
2854                BT_TMP_BUF_SIZE,
2855                "\r\n %-35s = %d/ %d", "Wifi rssi/ HS rssi", \
2856                wifiRssi-100, btHsRssi-100
2857        );
2858        CL_PRINTF(cliBuf);
2859
2860        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan);
2861        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink);
2862        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam);
2863        CL_SPRINTF(
2864                cliBuf,
2865                BT_TMP_BUF_SIZE,
2866                "\r\n %-35s = %d/ %d/ %d/ %s", "Wifi bLink/ bRoam/ bScan/ bHi-Pri", \
2867                bLink, bRoam, bScan, ((pCoexSta->bWiFiIsHighPriTask) ? "1" : "0")
2868        );
2869        CL_PRINTF(cliBuf);
2870
2871        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G);
2872        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);
2873        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy);
2874        pBtCoexist->fBtcGet(
2875                pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir
2876        );
2877        pBtCoexist->fBtcGet(
2878                pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode
2879        );
2880
2881        CL_SPRINTF(
2882                cliBuf,
2883                BT_TMP_BUF_SIZE,
2884                "\r\n %-35s = %s / %s/ %s/ AP =%d/ %s ", "Wifi status", \
2885                (bWifiUnder5G ? "5G" : "2.4G"),
2886                ((bWifiUnderBMode) ? "11b" : ((BTC_WIFI_BW_LEGACY == wifiBw) ? "11bg" : (((BTC_WIFI_BW_HT40 == wifiBw) ? "HT40" : "HT20")))),
2887                ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")),
2888                pCoexSta->nScanAPNum,
2889                (pCoexSta->bCCKLock) ? "Lock" : "noLock"
2890        );
2891        CL_PRINTF(cliBuf);
2892
2893        pBtCoexist->fBtcGet(
2894                pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus
2895        );
2896        CL_SPRINTF(
2897                cliBuf,
2898                BT_TMP_BUF_SIZE,
2899                "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "sta/vwifi/hs/p2pGo/p2pGc", \
2900                ((wifiLinkStatus&WIFI_STA_CONNECTED) ? 1 : 0),
2901                ((wifiLinkStatus&WIFI_AP_CONNECTED) ? 1 : 0),
2902                ((wifiLinkStatus&WIFI_HS_CONNECTED) ? 1 : 0),
2903                ((wifiLinkStatus&WIFI_P2P_GO_CONNECTED) ? 1 : 0),
2904                ((wifiLinkStatus&WIFI_P2P_GC_CONNECTED) ? 1 : 0)
2905        );
2906        CL_PRINTF(cliBuf);
2907
2908
2909        PopReportIn10s++;
2910        CL_SPRINTF(
2911                cliBuf,
2912                BT_TMP_BUF_SIZE,
2913                "\r\n %-35s = [%s/ %d/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", \
2914                ((pBtCoexist->btInfo.bBtDisabled) ? ("disabled") : ((pCoexSta->bC2hBtInquiryPage) ? ("inquiry/page scan") : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == pCoexDm->btStatus) ? "non-connected idle" :
2915                ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ? "connected-idle" : "busy")))),
2916                pCoexSta->btRssi, pCoexSta->btRetryCnt, pCoexSta->popEventCnt
2917        );
2918        CL_PRINTF(cliBuf);
2919
2920        if (PopReportIn10s >= 5) {
2921                pCoexSta->popEventCnt = 0;
2922                PopReportIn10s = 0;
2923        }
2924
2925
2926        CL_SPRINTF(
2927                cliBuf,
2928                BT_TMP_BUF_SIZE,
2929                "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \
2930                pBtLinkInfo->bScoExist,
2931                pBtLinkInfo->bHidExist,
2932                pBtLinkInfo->bPanExist,
2933                pBtLinkInfo->bA2dpExist
2934        );
2935        CL_PRINTF(cliBuf);
2936
2937        if (pStackInfo->bProfileNotified) {
2938                pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO);
2939        } else {
2940                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Role", \
2941                (pBtLinkInfo->bSlaveRole) ? "Slave" : "Master");
2942                CL_PRINTF(cliBuf);
2943        }
2944
2945
2946        btInfoExt = pCoexSta->btInfoExt;
2947        CL_SPRINTF(
2948                cliBuf,
2949                BT_TMP_BUF_SIZE,
2950                "\r\n %-35s = %s", "BT Info A2DP rate", \
2951                (btInfoExt&BIT0) ? "Basic rate" : "EDR rate"
2952        );
2953        CL_PRINTF(cliBuf);
2954
2955        for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) {
2956                if (pCoexSta->btInfoC2hCnt[i]) {
2957                        CL_SPRINTF(
2958                                cliBuf,
2959                                BT_TMP_BUF_SIZE,
2960                                "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723b1Ant[i], \
2961                                pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1],
2962                                pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3],
2963                                pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5],
2964                                pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]
2965                        );
2966                        CL_PRINTF(cliBuf);
2967                }
2968        }
2969        CL_SPRINTF(
2970                cliBuf,
2971                BT_TMP_BUF_SIZE,
2972                "\r\n %-35s = %s/%s, (0x%x/0x%x)", "PS state, IPS/LPS, (lps/rpwm)", \
2973                (pCoexSta->bUnderIps ? "IPS ON" : "IPS OFF"),
2974                (pCoexSta->bUnderLps ? "LPS ON" : "LPS OFF"),
2975                pBtCoexist->btInfo.lpsVal,
2976                pBtCoexist->btInfo.rpwmVal
2977        );
2978        CL_PRINTF(cliBuf);
2979        pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_FW_PWR_MODE_CMD);
2980
2981        if (!pBtCoexist->bManualControl) {
2982                /*  Sw mechanism */
2983                CL_SPRINTF(
2984                        cliBuf,
2985                        BT_TMP_BUF_SIZE,
2986                        "\r\n %-35s", "============[Sw mechanism]============"
2987                );
2988                CL_PRINTF(cliBuf);
2989
2990                CL_SPRINTF(
2991                        cliBuf,
2992                        BT_TMP_BUF_SIZE,
2993                        "\r\n %-35s = %d", "SM[LowPenaltyRA]", \
2994                        pCoexDm->bCurLowPenaltyRa
2995                );
2996                CL_PRINTF(cliBuf);
2997
2998                CL_SPRINTF(
2999                        cliBuf,
3000                        BT_TMP_BUF_SIZE,

3001                        "\r\n %-35s = %s/ %s/ %d ", "DelBA/ BtCtrlAgg/ AggSize", \
3002                        (pBtCoexist->btInfo.bRejectAggPkt ? "Yes" : "No"),
3003                        (pBtCoexist->btInfo.bBtCtrlAggBufSize ? "Yes" : "No"),
3004                        pBtCoexist->btInfo.aggBufSize
3005                );
3006                CL_PRINTF(cliBuf);
3007                CL_SPRINTF(
3008                        cliBuf,
3009                        BT_TMP_BUF_SIZE,
3010                        "\r\n %-35s = 0x%x ", "Rate Mask", \
3011                        pBtCoexist->btInfo.raMask
3012                );
3013                CL_PRINTF(cliBuf);
3014
3015                /*  Fw mechanism */
3016                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============");
3017                CL_PRINTF(cliBuf);
3018
3019                psTdmaCase = pCoexDm->curPsTdma;
3020                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d)", "PS TDMA", \
3021                        pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1],
3022                        pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3],
3023                        pCoexDm->psTdmaPara[4], psTdmaCase, pCoexDm->bAutoTdmaAdjust);
3024                CL_PRINTF(cliBuf);
3025
3026                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Coex Table Type", \
3027                        pCoexSta->nCoexTableType);
3028                CL_PRINTF(cliBuf);
3029
3030                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "IgnWlanAct", \
3031                        pCoexDm->bCurIgnoreWlanAct);
3032                CL_PRINTF(cliBuf);
3033
3034                /*
3035                CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", \
3036                        pCoexDm->errorCondition);
3037                CL_PRINTF(cliBuf);
3038                */
3039        }
3040
3041        /*  Hw setting */
3042        CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============");
3043        CL_PRINTF(cliBuf);
3044
3045        CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "backup ARFR1/ARFR2/RL/AMaxTime", \
3046                pCoexDm->backupArfrCnt1, pCoexDm->backupArfrCnt2, pCoexDm->backupRetryLimit, pCoexDm->backupAmpduMaxTime);
3047        CL_PRINTF(cliBuf);
3048
3049        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);
3050        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);
3051        u2Tmp[0] = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);
3052        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);
3053        CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", "0x430/0x434/0x42a/0x456", \
3054                u4Tmp[0], u4Tmp[1], u2Tmp[0], u1Tmp[0]);
3055        CL_PRINTF(cliBuf);
3056
3057        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778);
3058        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc);
3059        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880);
3060        CL_SPRINTF(
3061                cliBuf, BT_TMP_BUF_SIZE,
3062                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/0x6cc/0x880[29:25]", \
3063                u1Tmp[0], u4Tmp[0],  (u4Tmp[1]&0x3e000000) >> 25
3064        );
3065        CL_PRINTF(cliBuf);
3066
3067        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
3068        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
3069        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x764);
3070        u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x76e);
3071        CL_SPRINTF(
3072                cliBuf,
3073                BT_TMP_BUF_SIZE,
3074                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x948/ 0x67[5] / 0x764 / 0x76e", \
3075                u4Tmp[0], ((u1Tmp[0]&0x20) >> 5), (u4Tmp[1] & 0xffff), u1Tmp[1]
3076        );
3077        CL_PRINTF(cliBuf);
3078
3079        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x92c);
3080        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x930);
3081        u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x944);
3082        CL_SPRINTF(
3083                cliBuf,
3084                BT_TMP_BUF_SIZE,
3085                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", \
3086                u4Tmp[0]&0x3, u4Tmp[1]&0xff, u4Tmp[2]&0x3
3087        );
3088        CL_PRINTF(cliBuf);
3089
3090        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x39);
3091        u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40);
3092        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x4c);
3093        u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x64);
3094        CL_SPRINTF(
3095                cliBuf,
3096                BT_TMP_BUF_SIZE,
3097                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x38[11]/0x40/0x4c[24:23]/0x64[0]", \
3098                ((u1Tmp[0] & 0x8)>>3),
3099                u1Tmp[1],
3100                ((u4Tmp[0]&0x01800000)>>23),
3101                u1Tmp[2]&0x1
3102        );
3103        CL_PRINTF(cliBuf);
3104
3105        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550);
3106        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522);
3107        CL_SPRINTF(
3108                cliBuf,
3109                BT_TMP_BUF_SIZE,
3110                "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \
3111                u4Tmp[0], u1Tmp[0]
3112        );
3113        CL_PRINTF(cliBuf);
3114
3115        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50);
3116        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x49c);
3117        CL_SPRINTF(
3118                cliBuf,
3119                BT_TMP_BUF_SIZE,
3120                "\r\n %-35s = 0x%x/ 0x%x", "0xc50(dig)/0x49c(null-drop)", \
3121                u4Tmp[0]&0xff, u1Tmp[0]
3122        );
3123        CL_PRINTF(cliBuf);
3124
3125        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0);
3126        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4);
3127        u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8);
3128        u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xcf0);
3129
3130        u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5b);
3131        u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0xa5c);
3132
3133        faOfdm =
3134                ((u4Tmp[0]&0xffff0000) >> 16) +
3135                ((u4Tmp[1]&0xffff0000) >> 16) +
3136                (u4Tmp[1] & 0xffff) +  (u4Tmp[2] & 0xffff) + \
3137                ((u4Tmp[3]&0xffff0000) >> 16) + (u4Tmp[3] & 0xffff);
3138        faCck = (u1Tmp[0] << 8) + u1Tmp[1];
3139
3140        CL_SPRINTF(
3141                cliBuf,
3142                BT_TMP_BUF_SIZE,
3143                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "OFDM-CCA/OFDM-FA/CCK-FA", \
3144                u4Tmp[0]&0xffff, faOfdm, faCck
3145        );
3146        CL_PRINTF(cliBuf);
3147
3148
3149        CL_SPRINTF(
3150                cliBuf,
3151                BT_TMP_BUF_SIZE,
3152                "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_OK CCK/11g/11n/11n-Agg", \
3153                pCoexSta->nCRCOK_CCK,
3154                pCoexSta->nCRCOK_11g,
3155                pCoexSta->nCRCOK_11n,
3156                pCoexSta->nCRCOK_11nAgg
3157        );
3158        CL_PRINTF(cliBuf);
3159
3160        CL_SPRINTF(
3161                cliBuf,
3162                BT_TMP_BUF_SIZE,
3163                "\r\n %-35s = %d/ %d/ %d/ %d", "CRC_Err CCK/11g/11n/11n-Agg", \
3164                pCoexSta->nCRCErr_CCK,
3165                pCoexSta->nCRCErr_11g,
3166                pCoexSta->nCRCErr_11n,
3167                pCoexSta->nCRCErr_11nAgg
3168        );
3169        CL_PRINTF(cliBuf);
3170
3171        u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0);
3172        u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4);
3173        u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8);
3174        CL_SPRINTF(
3175                cliBuf,
3176                BT_TMP_BUF_SIZE,
3177                "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8(coexTable)", \
3178                u4Tmp[0], u4Tmp[1], u4Tmp[2]);
3179        CL_PRINTF(cliBuf);
3180
3181        CL_SPRINTF(
3182                cliBuf,
3183                BT_TMP_BUF_SIZE,
3184                "\r\n %-35s = %d/ %d", "0x770(high-pri rx/tx)", \
3185                pCoexSta->highPriorityRx, pCoexSta->highPriorityTx
3186        );
3187        CL_PRINTF(cliBuf);
3188        CL_SPRINTF(
3189                cliBuf,
3190                BT_TMP_BUF_SIZE,
3191                "\r\n %-35s = %d/ %d", "0x774(low-pri rx/tx)", \
3192                pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx
3193        );
3194        CL_PRINTF(cliBuf);
3195
3196        pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS);
3197}
3198
3199
3200void EXhalbtc8723b1ant_IpsNotify(PBTC_COEXIST pBtCoexist, u8 type)
3201{
3202        if (pBtCoexist->bManualControl ||       pBtCoexist->bStopCoexDm)
3203                return;
3204
3205        if (BTC_IPS_ENTER == type) {
3206                BTC_PRINT(
3207                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS ENTER notify\n")
3208                );
3209                pCoexSta->bUnderIps = true;
3210
3211                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
3212                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 0);
3213                halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3214        } else if (BTC_IPS_LEAVE == type) {
3215                BTC_PRINT(
3216                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], IPS LEAVE notify\n")
3217                );
3218                pCoexSta->bUnderIps = false;
3219
3220                halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false);
3221                halbtc8723b1ant_InitCoexDm(pBtCoexist);
3222                halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3223        }
3224}
3225
3226void EXhalbtc8723b1ant_LpsNotify(PBTC_COEXIST pBtCoexist, u8 type)
3227{
3228        if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm)
3229                return;
3230
3231        if (BTC_LPS_ENABLE == type) {
3232                BTC_PRINT(
3233                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS ENABLE notify\n")
3234                );
3235                pCoexSta->bUnderLps = true;
3236        } else if (BTC_LPS_DISABLE == type) {
3237                BTC_PRINT(
3238                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], LPS DISABLE notify\n")
3239                );
3240                pCoexSta->bUnderLps = false;
3241        }
3242}
3243
3244void EXhalbtc8723b1ant_ScanNotify(PBTC_COEXIST pBtCoexist, u8 type)
3245{
3246        bool bWifiConnected = false, bBtHsOn = false;
3247        u32 wifiLinkStatus = 0;
3248        u32 numOfWifiLink = 0;
3249        bool bBtCtrlAggBufSize = false;
3250        u8 aggBufSize = 5;
3251
3252        u8 u1Tmpa, u1Tmpb;
3253        u32 u4Tmp;
3254
3255        if (pBtCoexist->bManualControl || pBtCoexist->bStopCoexDm)
3256                return;
3257
3258        if (BTC_SCAN_START == type) {
3259                pCoexSta->bWiFiIsHighPriTask = true;
3260                BTC_PRINT(
3261                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")
3262                );
3263
3264                halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 8);  /* Force antenna setup for no scan result issue */
3265                u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x948);
3266                u1Tmpa = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x765);
3267                u1Tmpb = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x67);
3268
3269
3270                BTC_PRINT(
3271                        BTC_MSG_INTERFACE,
3272                        INTF_NOTIFY,
3273                        (
3274                                "[BTCoex], 0x948 = 0x%x, 0x765 = 0x%x, 0x67 = 0x%x\n",
3275                                u4Tmp,
3276                                u1Tmpa,
3277                                u1Tmpb
3278                        )
3279                );
3280        } else {
3281                pCoexSta->bWiFiIsHighPriTask = false;
3282                BTC_PRINT(
3283                        BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")
3284                );
3285
3286                pBtCoexist->fBtcGet(
3287                        pBtCoexist, BTC_GET_U1_AP_NUM, &pCoexSta->nScanAPNum
3288                );
3289        }
3290
3291        if (pBtCoexist->btInfo.bBtDisabled)
3292                return;
3293
3294        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3295        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3296
3297        halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3298
3299        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);
3300        numOfWifiLink = wifiLinkStatus>>16;
3301
3302        if (numOfWifiLink >= 2) {
3303                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3304                halbtc8723b1ant_LimitedRx(
3305                        pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize
3306                );
3307                halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3308                return;
3309        }
3310
3311        if (pCoexSta->bC2hBtInquiryPage) {
3312                halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3313                return;
3314        } else if (bBtHsOn) {
3315                halbtc8723b1ant_ActionHs(pBtCoexist);
3316                return;
3317        }
3318
3319        if (BTC_SCAN_START == type) {
3320                /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN START notify\n")); */
3321                if (!bWifiConnected)    /*  non-connected scan */
3322                        halbtc8723b1ant_ActionWifiNotConnectedScan(pBtCoexist);
3323                else    /*  wifi is connected */
3324                        halbtc8723b1ant_ActionWifiConnectedScan(pBtCoexist);
3325        } else if (BTC_SCAN_FINISH == type) {
3326                /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], SCAN FINISH notify\n")); */
3327                if (!bWifiConnected)    /*  non-connected scan */
3328                        halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
3329                else
3330                        halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
3331        }
3332}
3333
3334void EXhalbtc8723b1ant_ConnectNotify(PBTC_COEXIST pBtCoexist, u8 type)
3335{
3336        bool bWifiConnected = false, bBtHsOn = false;
3337        u32 wifiLinkStatus = 0;
3338        u32 numOfWifiLink = 0;
3339        bool bBtCtrlAggBufSize = false;
3340        u8 aggBufSize = 5;
3341
3342        if (
3343                pBtCoexist->bManualControl ||
3344                pBtCoexist->bStopCoexDm ||
3345                pBtCoexist->btInfo.bBtDisabled
3346        )
3347                return;
3348
3349        if (BTC_ASSOCIATE_START == type) {
3350                pCoexSta->bWiFiIsHighPriTask = true;
3351                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n"));
3352                 pCoexDm->nArpCnt = 0;
3353        } else {
3354                pCoexSta->bWiFiIsHighPriTask = false;
3355                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n"));
3356                /* pCoexDm->nArpCnt = 0; */
3357        }
3358
3359        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus);
3360        numOfWifiLink = wifiLinkStatus>>16;
3361        if (numOfWifiLink >= 2) {
3362                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3363                halbtc8723b1ant_LimitedRx(pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize);
3364                halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3365                return;
3366        }
3367
3368        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3369        if (pCoexSta->bC2hBtInquiryPage) {
3370                halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3371                return;
3372        } else if (bBtHsOn) {
3373                halbtc8723b1ant_ActionHs(pBtCoexist);
3374                return;
3375        }
3376
3377        if (BTC_ASSOCIATE_START == type) {
3378                /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT START notify\n")); */
3379                halbtc8723b1ant_ActionWifiNotConnectedAssoAuth(pBtCoexist);
3380        } else if (BTC_ASSOCIATE_FINISH == type) {
3381                /* BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], CONNECT FINISH notify\n")); */
3382
3383                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3384                if (!bWifiConnected) /*  non-connected scan */
3385                        halbtc8723b1ant_ActionWifiNotConnected(pBtCoexist);
3386                else
3387                        halbtc8723b1ant_ActionWifiConnected(pBtCoexist);
3388        }
3389}
3390
3391void EXhalbtc8723b1ant_MediaStatusNotify(PBTC_COEXIST pBtCoexist, u8 type)
3392{
3393        u8 H2C_Parameter[3] = {0};
3394        u32 wifiBw;
3395        u8 wifiCentralChnl;
3396        bool bWifiUnderBMode = false;
3397
3398        if (
3399                pBtCoexist->bManualControl ||
3400                pBtCoexist->bStopCoexDm ||
3401                pBtCoexist->btInfo.bBtDisabled
3402        )
3403                return;
3404
3405        if (BTC_MEDIA_CONNECT == type) {
3406                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA connect notify\n"));
3407
3408                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode);
3409
3410                /* Set CCK Tx/Rx high Pri except 11b mode */
3411                if (bWifiUnderBMode) {
3412                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x00); /* CCK Tx */
3413                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x00); /* CCK Rx */
3414                } else {
3415                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x10); /* CCK Tx */
3416                        pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x10); /* CCK Rx */
3417                }
3418
3419                pCoexDm->backupArfrCnt1 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x430);
3420                pCoexDm->backupArfrCnt2 = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x434);
3421                pCoexDm->backupRetryLimit = pBtCoexist->fBtcRead2Byte(pBtCoexist, 0x42a);
3422                pCoexDm->backupAmpduMaxTime = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x456);
3423        } else {
3424                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], MEDIA disconnect notify\n"));
3425                pCoexDm->nArpCnt = 0;
3426
3427                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cd, 0x0); /* CCK Tx */
3428                pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cf, 0x0); /* CCK Rx */
3429        }
3430
3431        /*  only 2.4G we need to inform bt the chnl mask */
3432        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl);
3433        if ((BTC_MEDIA_CONNECT == type) && (wifiCentralChnl <= 14)) {
3434                /* H2C_Parameter[0] = 0x1; */
3435                H2C_Parameter[0] = 0x0;
3436                H2C_Parameter[1] = wifiCentralChnl;
3437                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw);
3438
3439                if (BTC_WIFI_BW_HT40 == wifiBw)
3440                        H2C_Parameter[2] = 0x30;
3441                else
3442                        H2C_Parameter[2] = 0x20;
3443        }
3444
3445        pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0];
3446        pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1];
3447        pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2];
3448
3449        BTC_PRINT(
3450                BTC_MSG_ALGORITHM,
3451                ALGO_TRACE_FW_EXEC,
3452                (
3453                        "[BTCoex], FW write 0x66 = 0x%x\n",
3454                        H2C_Parameter[0]<<16 | H2C_Parameter[1]<<8 | H2C_Parameter[2]
3455                )
3456        );
3457
3458        pBtCoexist->fBtcFillH2c(pBtCoexist, 0x66, 3, H2C_Parameter);
3459}
3460
3461void EXhalbtc8723b1ant_SpecialPacketNotify(PBTC_COEXIST pBtCoexist, u8 type)
3462{
3463        bool bBtHsOn = false;
3464        u32 wifiLinkStatus = 0;
3465        u32 numOfWifiLink = 0;
3466        bool bBtCtrlAggBufSize = false;
3467        u8 aggBufSize = 5;
3468
3469        if (
3470                pBtCoexist->bManualControl ||
3471                pBtCoexist->bStopCoexDm ||
3472                pBtCoexist->btInfo.bBtDisabled
3473        )
3474                return;
3475
3476        if (
3477                BTC_PACKET_DHCP == type ||
3478                BTC_PACKET_EAPOL == type ||
3479                BTC_PACKET_ARP == type
3480        ) {
3481                if (BTC_PACKET_ARP == type) {
3482                        BTC_PRINT(
3483                                BTC_MSG_INTERFACE,
3484                                INTF_NOTIFY,
3485                                ("[BTCoex], special Packet ARP notify\n")
3486                        );
3487
3488                        pCoexDm->nArpCnt++;
3489                        BTC_PRINT(
3490                                BTC_MSG_INTERFACE,
3491                                INTF_NOTIFY,
3492                                ("[BTCoex], ARP Packet Count = %d\n", pCoexDm->nArpCnt)
3493                        );
3494
3495                        if (pCoexDm->nArpCnt >= 10) /*  if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecialPacket(pBtCoexist) */
3496                                pCoexSta->bWiFiIsHighPriTask = false;
3497                        else
3498                                pCoexSta->bWiFiIsHighPriTask = true;
3499                } else {
3500                        pCoexSta->bWiFiIsHighPriTask = true;
3501                        BTC_PRINT(
3502                                BTC_MSG_INTERFACE,
3503                                INTF_NOTIFY,
3504                                ("[BTCoex], special Packet DHCP or EAPOL notify\n")
3505                        );
3506                }
3507        } else {
3508                pCoexSta->bWiFiIsHighPriTask = false;
3509                BTC_PRINT(
3510                        BTC_MSG_INTERFACE,
3511                        INTF_NOTIFY,
3512                        ("[BTCoex], special Packet [Type = %d] notify\n", type)
3513                );
3514        }
3515
3516        pCoexSta->specialPktPeriodCnt = 0;
3517
3518        pBtCoexist->fBtcGet(
3519                pBtCoexist, BTC_GET_U4_WIFI_LINK_STATUS, &wifiLinkStatus
3520        );
3521        numOfWifiLink = wifiLinkStatus>>16;
3522
3523        if (numOfWifiLink >= 2) {
3524                halbtc8723b1ant_LimitedTx(pBtCoexist, NORMAL_EXEC, 0, 0, 0, 0);
3525                halbtc8723b1ant_LimitedRx(
3526                        pBtCoexist, NORMAL_EXEC, false, bBtCtrlAggBufSize, aggBufSize
3527                );
3528                halbtc8723b1ant_ActionWifiMultiPort(pBtCoexist);
3529                return;
3530        }
3531
3532        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn);
3533        if (pCoexSta->bC2hBtInquiryPage) {
3534                halbtc8723b1ant_ActionBtInquiry(pBtCoexist);
3535                return;
3536        } else if (bBtHsOn) {
3537                halbtc8723b1ant_ActionHs(pBtCoexist);
3538                return;
3539        }
3540
3541        if (
3542                BTC_PACKET_DHCP == type ||
3543                BTC_PACKET_EAPOL == type ||
3544                ((BTC_PACKET_ARP == type) && (pCoexSta->bWiFiIsHighPriTask))
3545        )
3546                halbtc8723b1ant_ActionWifiConnectedSpecialPacket(pBtCoexist);
3547}
3548
3549void EXhalbtc8723b1ant_BtInfoNotify(
3550        PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 length
3551)
3552{
3553        u8 btInfo = 0;
3554        u8 i, rspSource = 0;
3555        bool bWifiConnected = false;
3556        bool bBtBusy = false;
3557
3558        pCoexSta->bC2hBtInfoReqSent = false;
3559
3560        rspSource = tmpBuf[0]&0xf;
3561        if (rspSource >= BT_INFO_SRC_8723B_1ANT_MAX)
3562                rspSource = BT_INFO_SRC_8723B_1ANT_WIFI_FW;
3563        pCoexSta->btInfoC2hCnt[rspSource]++;
3564
3565        BTC_PRINT(
3566                BTC_MSG_INTERFACE,
3567                INTF_NOTIFY,
3568                ("[BTCoex], Bt info[%d], length =%d, hex data =[",
3569                rspSource,
3570                length)
3571        );
3572        for (i = 0; i < length; i++) {
3573                pCoexSta->btInfoC2h[rspSource][i] = tmpBuf[i];
3574                if (i == 1)
3575                        btInfo = tmpBuf[i];
3576                if (i == length-1)
3577                        BTC_PRINT(
3578                                BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x]\n", tmpBuf[i])
3579                        );
3580                else
3581                        BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("0x%02x, ", tmpBuf[i]));
3582        }
3583
3584        if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rspSource) {
3585                pCoexSta->btRetryCnt = pCoexSta->btInfoC2h[rspSource][2]&0xf;
3586
3587                if (pCoexSta->btRetryCnt >= 1)
3588                        pCoexSta->popEventCnt++;
3589
3590                if (pCoexSta->btInfoC2h[rspSource][2]&0x20)
3591                        pCoexSta->bC2hBtPage = true;
3592                else
3593                        pCoexSta->bC2hBtPage = false;
3594
3595                pCoexSta->btRssi = pCoexSta->btInfoC2h[rspSource][3]*2-90;
3596                /* pCoexSta->btInfoC2h[rspSource][3]*2+10; */
3597
3598                pCoexSta->btInfoExt = pCoexSta->btInfoC2h[rspSource][4];
3599
3600                pCoexSta->bBtTxRxMask = (pCoexSta->btInfoC2h[rspSource][2]&0x40);
3601                pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TX_RX_MASK, &pCoexSta->bBtTxRxMask);
3602
3603                if (!pCoexSta->bBtTxRxMask) {
3604                        /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */
3605                        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"));
3606                        pBtCoexist->fBtcSetBtReg(pBtCoexist, BTC_BT_REG_RF, 0x3c, 0x15);
3607                }
3608
3609                /*  Here we need to resend some wifi info to BT */
3610                /*  because bt is reset and loss of the info. */
3611                if (pCoexSta->btInfoExt & BIT1) {
3612                        BTC_PRINT(
3613                                BTC_MSG_ALGORITHM,
3614                                ALGO_TRACE,
3615                                ("[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n")
3616                        );
3617                        pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected);
3618                        if (bWifiConnected)
3619                                EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_CONNECT);
3620                        else
3621                                EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);
3622                }
3623
3624                if (pCoexSta->btInfoExt & BIT3) {
3625                        if (!pBtCoexist->bManualControl && !pBtCoexist->bStopCoexDm) {
3626                                BTC_PRINT(
3627                                        BTC_MSG_ALGORITHM,
3628                                        ALGO_TRACE,
3629                                        ("[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n")
3630                                );
3631                                halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, false);
3632                        }
3633                } else {
3634                        /*  BT already NOT ignore Wlan active, do nothing here. */
3635                }
3636        }
3637
3638        /*  check BIT2 first ==> check if bt is under inquiry or page scan */
3639        if (btInfo & BT_INFO_8723B_1ANT_B_INQ_PAGE)
3640                pCoexSta->bC2hBtInquiryPage = true;
3641        else
3642                pCoexSta->bC2hBtInquiryPage = false;
3643
3644        /*  set link exist status */
3645        if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) {
3646                pCoexSta->bBtLinkExist = false;
3647                pCoexSta->bPanExist = false;
3648                pCoexSta->bA2dpExist = false;
3649                pCoexSta->bHidExist = false;
3650                pCoexSta->bScoExist = false;
3651        } else {        /*  connection exists */
3652                pCoexSta->bBtLinkExist = true;
3653                if (btInfo & BT_INFO_8723B_1ANT_B_FTP)
3654                        pCoexSta->bPanExist = true;
3655                else
3656                        pCoexSta->bPanExist = false;
3657
3658                if (btInfo & BT_INFO_8723B_1ANT_B_A2DP)
3659                        pCoexSta->bA2dpExist = true;
3660                else
3661                        pCoexSta->bA2dpExist = false;
3662
3663                if (btInfo & BT_INFO_8723B_1ANT_B_HID)
3664                        pCoexSta->bHidExist = true;
3665                else
3666                        pCoexSta->bHidExist = false;
3667
3668                if (btInfo & BT_INFO_8723B_1ANT_B_SCO_ESCO)
3669                        pCoexSta->bScoExist = true;
3670                else
3671                        pCoexSta->bScoExist = false;
3672        }
3673
3674        halbtc8723b1ant_UpdateBtLinkInfo(pBtCoexist);
3675
3676        btInfo = btInfo & 0x1f;  /* mask profile bit for connect-ilde identification (for CSR case: A2DP idle --> 0x41) */
3677
3678        if (!(btInfo&BT_INFO_8723B_1ANT_B_CONNECTION)) {
3679                pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE;
3680                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"));
3681        } else if (btInfo == BT_INFO_8723B_1ANT_B_CONNECTION)   {
3682                /*  connection exists but no busy */
3683                pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE;
3684                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"));
3685        } else if (
3686                (btInfo&BT_INFO_8723B_1ANT_B_SCO_ESCO) ||
3687                (btInfo&BT_INFO_8723B_1ANT_B_SCO_BUSY)
3688        ) {
3689                pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_SCO_BUSY;
3690                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"));
3691        } else if (btInfo&BT_INFO_8723B_1ANT_B_ACL_BUSY) {
3692                if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY != pCoexDm->btStatus)
3693                        pCoexDm->bAutoTdmaAdjust = false;
3694
3695                pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_ACL_BUSY;
3696                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"));
3697        } else {
3698                pCoexDm->btStatus = BT_8723B_1ANT_BT_STATUS_MAX;
3699                BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"));
3700        }
3701
3702        if (
3703                (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == pCoexDm->btStatus) ||
3704                (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == pCoexDm->btStatus) ||
3705                (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == pCoexDm->btStatus)
3706        )
3707                bBtBusy = true;
3708        else
3709                bBtBusy = false;
3710        pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy);
3711
3712        halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);
3713}
3714
3715void EXhalbtc8723b1ant_HaltNotify(PBTC_COEXIST pBtCoexist)
3716{
3717        BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Halt notify\n"));
3718
3719        halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
3720        halbtc8723b1ant_PsTdma(pBtCoexist, FORCE_EXEC, false, 0);
3721        halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3722
3723        halbtc8723b1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, true);
3724
3725        EXhalbtc8723b1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT);
3726
3727        pBtCoexist->bStopCoexDm = true;
3728}
3729
3730void EXhalbtc8723b1ant_PnpNotify(PBTC_COEXIST pBtCoexist, u8 pnpState)
3731{
3732        BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify\n"));
3733
3734        if (BTC_WIFI_PNP_SLEEP == pnpState) {
3735                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to SLEEP\n"));
3736
3737                halbtc8723b1ant_PowerSaveState(pBtCoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0);
3738                halbtc8723b1ant_PsTdma(pBtCoexist, NORMAL_EXEC, false, 0);
3739                halbtc8723b1ant_CoexTableWithType(pBtCoexist, NORMAL_EXEC, 2);
3740                halbtc8723b1ant_SetAntPath(pBtCoexist, BTC_ANT_PATH_BT, false, true);
3741
3742                pBtCoexist->bStopCoexDm = true;
3743        } else if (BTC_WIFI_PNP_WAKE_UP == pnpState) {
3744                BTC_PRINT(BTC_MSG_INTERFACE, INTF_NOTIFY, ("[BTCoex], Pnp notify to WAKE UP\n"));
3745                pBtCoexist->bStopCoexDm = false;
3746                halbtc8723b1ant_InitHwConfig(pBtCoexist, false, false);
3747                halbtc8723b1ant_InitCoexDm(pBtCoexist);
3748                halbtc8723b1ant_QueryBtInfo(pBtCoexist);
3749        }
3750}
3751
3752void EXhalbtc8723b1ant_Periodical(PBTC_COEXIST pBtCoexist)
3753{
3754        static u8 disVerInfoCnt;
3755        u32 fwVer = 0, btPatchVer = 0;
3756
3757        BTC_PRINT(BTC_MSG_ALGORITHM, ALGO_TRACE, ("[BTCoex], ==========================Periodical ===========================\n"));
3758
3759        if (disVerInfoCnt <= 5) {
3760                disVerInfoCnt += 1;
3761                BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n"));
3762                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_BT_PATCH_VER, &btPatchVer);
3763                pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer);
3764                BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", \
3765                        GLCoexVerDate8723b1Ant, GLCoexVer8723b1Ant, fwVer, btPatchVer, btPatchVer));
3766                BTC_PRINT(BTC_MSG_INTERFACE, INTF_INIT, ("[BTCoex], ****************************************************************\n"));
3767        }
3768
3769        halbtc8723b1ant_MonitorBtCtr(pBtCoexist);
3770        halbtc8723b1ant_MonitorWiFiCtr(pBtCoexist);
3771
3772        if (
3773                halbtc8723b1ant_IsWifiStatusChanged(pBtCoexist) ||
3774                pCoexDm->bAutoTdmaAdjust
3775        )
3776                halbtc8723b1ant_RunCoexistMechanism(pBtCoexist);
3777
3778        pCoexSta->specialPktPeriodCnt++;
3779}
3780