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

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

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

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

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