drivers/net/wireless/realtek/rtlwifi/rtl8723ae/hal_btc.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2009-2012  Realtek Corporation.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * The full GNU General Public License is included in this distribution in the
  15  * file called LICENSE.
  16  *
  17  * Contact Information:
  18  * wlanfae <wlanfae@realtek.com>
  19  * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
  20  * Hsinchu 300, Taiwan.
  21  *
  22  * Larry Finger <Larry.Finger@lwfinger.net>
  23  *
  24  *****************************************************************************/
  25 #include "hal_btc.h"
  26 #include "../pci.h"
  27 #include "phy.h"
  28 #include "fw.h"
  29 #include "reg.h"
  30 #include "def.h"
  31 #include "../rtl8723com/phy_common.h"
  32
  33 static struct bt_coexist_8723 hal_coex_8723;
  34
  35 void rtl8723e_dm_bt_turn_off_bt_coexist_before_enter_lps(struct ieee80211_hw *hw)
  36 {
  37         struct rtl_priv *rtlpriv = rtl_priv(hw);
  38         struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
  39
  40         if (!rtlpriv->btcoexist.bt_coexistence)
  41                 return;
  42
  43         if (ppsc->inactiveps) {
  44                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
  45                         "[BT][DM], Before enter IPS, turn off all Coexist DM\n");
  46                 rtlpriv->btcoexist.cstate = 0;
  47                 rtlpriv->btcoexist.previous_state = 0;
  48                 rtlpriv->btcoexist.cstate_h = 0;
  49                 rtlpriv->btcoexist.previous_state_h = 0;
  50                 rtl8723e_btdm_coex_all_off(hw);
  51         }
  52 }
  53
  54 static enum rt_media_status mgnt_link_status_query(struct ieee80211_hw *hw)
  55 {
  56         struct rtl_priv *rtlpriv = rtl_priv(hw);
  57         struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  58         enum rt_media_status    m_status = RT_MEDIA_DISCONNECT;
  59         u8 bibss = (mac->opmode == NL80211_IFTYPE_ADHOC) ? 1 : 0;
  60         if (bibss || rtlpriv->mac80211.link_state >= MAC80211_LINKED)
  61                 m_status = RT_MEDIA_CONNECT;
  62
  63         return m_status;
  64 }
  65
  66 void rtl_8723e_bt_wifi_media_status_notify(struct ieee80211_hw *hw,
  67                                                 bool mstatus)
  68 {
  69         struct rtl_priv *rtlpriv = rtl_priv(hw);
  70         struct rtl_phy *rtlphy = &(rtlpriv->phy);
  71         u8 h2c_parameter[3] = {0};
  72         u8 chnl;
  73
  74         if (!rtlpriv->btcoexist.bt_coexistence)
  75                 return;
  76
  77         if (RT_MEDIA_CONNECT == mstatus)
  78                 h2c_parameter[0] = 0x1; /* 0: disconnected, 1:connected */
  79         else
  80                 h2c_parameter[0] = 0x0;
  81
  82         if (mgnt_link_status_query(hw)) {
  83                 chnl = rtlphy->current_channel;
  84                 h2c_parameter[1] = chnl;
  85         }
  86
  87         if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40)
  88                 h2c_parameter[2] = 0x30;
  89         else
  90                 h2c_parameter[2] = 0x20;
  91
  92         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
  93                  "[BTCoex], FW write 0x19=0x%x\n",
  94                  h2c_parameter[0]<<16|h2c_parameter[1]<<8|h2c_parameter[2]);
  95
  96         rtl8723e_fill_h2c_cmd(hw, 0x19, 3, h2c_parameter);
  97 }
  98
  99 static bool rtl8723e_dm_bt_is_wifi_busy(struct ieee80211_hw *hw)
 100 {
 101         struct rtl_priv *rtlpriv = rtl_priv(hw);
 102         if (rtlpriv->link_info.busytraffic ||
 103                 rtlpriv->link_info.rx_busy_traffic ||
 104                 rtlpriv->link_info.tx_busy_traffic)
 105                 return true;
 106         else
 107                 return false;
 108 }
 109
 110 static void rtl8723e_dm_bt_set_fw_3a(struct ieee80211_hw *hw,
 111                                      u8 byte1, u8 byte2, u8 byte3, u8 byte4,
 112                                      u8 byte5)
 113 {
 114         struct rtl_priv *rtlpriv = rtl_priv(hw);
 115         u8 h2c_parameter[5];
 116
 117         h2c_parameter[0] = byte1;
 118         h2c_parameter[1] = byte2;
 119         h2c_parameter[2] = byte3;
 120         h2c_parameter[3] = byte4;
 121         h2c_parameter[4] = byte5;
 122         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 123                 "[BTCoex], FW write 0x3a(4bytes)=0x%x%8x\n",
 124                 h2c_parameter[0], h2c_parameter[1]<<24 |
 125                 h2c_parameter[2]<<16 | h2c_parameter[3]<<8 |
 126                 h2c_parameter[4]);
 127         rtl8723e_fill_h2c_cmd(hw, 0x3a, 5, h2c_parameter);
 128 }
 129
 130 static bool rtl8723e_dm_bt_need_to_dec_bt_pwr(struct ieee80211_hw *hw)
 131 {
 132         struct rtl_priv *rtlpriv = rtl_priv(hw);
 133
 134         if (mgnt_link_status_query(hw) == RT_MEDIA_CONNECT) {
 135                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 136                         "Need to decrease bt power\n");
 137                         rtlpriv->btcoexist.cstate |=
 138                         BT_COEX_STATE_DEC_BT_POWER;
 139                         return true;
 140         }
 141
 142         rtlpriv->btcoexist.cstate &= ~BT_COEX_STATE_DEC_BT_POWER;
 143         return false;
 144 }
 145
 146 static bool rtl8723e_dm_bt_is_same_coexist_state(struct ieee80211_hw *hw)
 147 {
 148         struct rtl_priv *rtlpriv = rtl_priv(hw);
 149
 150         if ((rtlpriv->btcoexist.previous_state ==
 151              rtlpriv->btcoexist.cstate) &&
 152             (rtlpriv->btcoexist.previous_state_h ==
 153              rtlpriv->btcoexist.cstate_h)) {
 154                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 155                          "[DM][BT], Coexist state do not chang!!\n");
 156                 return true;
 157         } else {
 158                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 159                          "[DM][BT], Coexist state changed!!\n");
 160                 return false;
 161         }
 162 }
 163
 164 static void rtl8723e_dm_bt_set_coex_table(struct ieee80211_hw *hw,
 165                                           u32 val_0x6c0, u32 val_0x6c8,
 166                                           u32 val_0x6cc)
 167 {
 168         struct rtl_priv *rtlpriv = rtl_priv(hw);
 169
 170         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 171                  "set coex table, set 0x6c0=0x%x\n", val_0x6c0);
 172         rtl_write_dword(rtlpriv, 0x6c0, val_0x6c0);
 173
 174         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 175                  "set coex table, set 0x6c8=0x%x\n", val_0x6c8);
 176         rtl_write_dword(rtlpriv, 0x6c8, val_0x6c8);
 177
 178         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 179                  "set coex table, set 0x6cc=0x%x\n", val_0x6cc);
 180         rtl_write_byte(rtlpriv, 0x6cc, val_0x6cc);
 181 }
 182
 183 static void rtl8723e_dm_bt_set_hw_pta_mode(struct ieee80211_hw *hw, bool b_mode)
 184 {
 185         struct rtl_priv *rtlpriv = rtl_priv(hw);
 186
 187         if (BT_PTA_MODE_ON == b_mode) {
 188                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE, "PTA mode on, ");
 189                 /*  Enable GPIO 0/1/2/3/8 pins for bt */
 190                 rtl_write_byte(rtlpriv, 0x40, 0x20);
 191                 rtlpriv->btcoexist.hw_coexist_all_off = false;
 192         } else {
 193                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE, "PTA mode off\n");
 194                 rtl_write_byte(rtlpriv, 0x40, 0x0);
 195         }
 196 }
 197
 198 static void rtl8723e_dm_bt_set_sw_rf_rx_lpf_corner(struct ieee80211_hw *hw,
 199                                                    u8 type)
 200 {
 201         struct rtl_priv *rtlpriv = rtl_priv(hw);
 202
 203         if (BT_RF_RX_LPF_CORNER_SHRINK == type) {
 204                 /* Shrink RF Rx LPF corner, 0x1e[7:4]=1111 ==> [11:4] */
 205                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 206                          "Shrink RF Rx LPF corner!!\n");
 207                 rtl8723e_phy_set_rf_reg(hw, RF90_PATH_A, 0x1e,
 208                                         0xfffff, 0xf0ff7);
 209                 rtlpriv->btcoexist.sw_coexist_all_off = false;
 210         } else if (BT_RF_RX_LPF_CORNER_RESUME == type) {
 211                 /*Resume RF Rx LPF corner*/
 212                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 213                          "Resume RF Rx LPF corner!!\n");
 214                 rtl8723e_phy_set_rf_reg(hw, RF90_PATH_A, 0x1e, 0xfffff,
 215                                         rtlpriv->btcoexist.bt_rfreg_origin_1e);
 216         }
 217 }
 218
 219 static void dm_bt_set_sw_penalty_tx_rate_adapt(struct ieee80211_hw *hw,
 220                                                u8 ra_type)
 221 {
 222         struct rtl_priv *rtlpriv = rtl_priv(hw);
 223         u8 tmp_u1;
 224
 225         tmp_u1 = rtl_read_byte(rtlpriv, 0x4fd);
 226         tmp_u1 |= BIT(0);
 227         if (BT_TX_RATE_ADAPTIVE_LOW_PENALTY == ra_type) {
 228                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 229                         "Tx rate adaptive, set low penalty!!\n");
 230                 tmp_u1 &= ~BIT(2);
 231                 rtlpriv->btcoexist.sw_coexist_all_off = false;
 232         } else if (BT_TX_RATE_ADAPTIVE_NORMAL == ra_type) {
 233                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 234                         "Tx rate adaptive, set normal!!\n");
 235                 tmp_u1 |= BIT(2);
 236         }
 237
 238         rtl_write_byte(rtlpriv, 0x4fd, tmp_u1);
 239 }
 240
 241 static void rtl8723e_dm_bt_btdm_structure_reload(struct ieee80211_hw *hw,
 242                                                  struct btdm_8723 *btdm)
 243 {
 244         btdm->all_off = false;
 245         btdm->agc_table_en = false;
 246         btdm->adc_back_off_on = false;
 247         btdm->b2_ant_hid_en = false;
 248         btdm->low_penalty_rate_adaptive = false;
 249         btdm->rf_rx_lpf_shrink = false;
 250         btdm->reject_aggre_pkt = false;
 251
 252         btdm->tdma_on = false;
 253         btdm->tdma_ant = TDMA_2ANT;
 254         btdm->tdma_nav = TDMA_NAV_OFF;
 255         btdm->tdma_dac_swing = TDMA_DAC_SWING_OFF;
 256         btdm->fw_dac_swing_lvl = 0x20;
 257
 258         btdm->tra_tdma_on = false;
 259         btdm->tra_tdma_ant = TDMA_2ANT;
 260         btdm->tra_tdma_nav = TDMA_NAV_OFF;
 261         btdm->ignore_wlan_act = false;
 262
 263         btdm->ps_tdma_on = false;
 264         btdm->ps_tdma_byte[0] = 0x0;
 265         btdm->ps_tdma_byte[1] = 0x0;
 266         btdm->ps_tdma_byte[2] = 0x0;
 267         btdm->ps_tdma_byte[3] = 0x8;
 268         btdm->ps_tdma_byte[4] = 0x0;
 269
 270         btdm->pta_on = true;
 271         btdm->val_0x6c0 = 0x5a5aaaaa;
 272         btdm->val_0x6c8 = 0xcc;
 273         btdm->val_0x6cc = 0x3;
 274
 275         btdm->sw_dac_swing_on = false;
 276         btdm->sw_dac_swing_lvl = 0xc0;
 277         btdm->wlan_act_hi = 0x20;
 278         btdm->wlan_act_lo = 0x10;
 279         btdm->bt_retry_index = 2;
 280
 281         btdm->dec_bt_pwr = false;
 282 }
 283
 284 static void rtl8723e_dm_bt_btdm_structure_reload_all_off(struct ieee80211_hw *hw,
 285                                                          struct btdm_8723 *btdm)
 286 {
 287         rtl8723e_dm_bt_btdm_structure_reload(hw, btdm);
 288         btdm->all_off = true;
 289         btdm->pta_on = false;
 290         btdm->wlan_act_hi = 0x10;
 291 }
 292
 293 static bool rtl8723e_dm_bt_is_2_ant_common_action(struct ieee80211_hw *hw)
 294 {
 295         struct rtl_priv *rtlpriv = rtl_priv(hw);
 296         struct btdm_8723 btdm8723;
 297         bool b_common = false;
 298
 299         rtl8723e_dm_bt_btdm_structure_reload(hw, &btdm8723);
 300
 301         if (!rtl8723e_dm_bt_is_wifi_busy(hw) &&
 302             !rtlpriv->btcoexist.bt_busy) {
 303                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 304                          "Wifi idle + Bt idle, bt coex mechanism always off!!\n");
 305                 rtl8723e_dm_bt_btdm_structure_reload_all_off(hw, &btdm8723);
 306                 b_common = true;
 307         } else if (rtl8723e_dm_bt_is_wifi_busy(hw) &&
 308                    !rtlpriv->btcoexist.bt_busy) {
 309                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 310                          "Wifi non-idle + Bt disabled/idle!!\n");
 311                 btdm8723.low_penalty_rate_adaptive = true;
 312                 btdm8723.rf_rx_lpf_shrink = false;
 313                 btdm8723.reject_aggre_pkt = false;
 314
 315                 /* sw mechanism */
 316                 btdm8723.agc_table_en = false;
 317                 btdm8723.adc_back_off_on = false;
 318                 btdm8723.sw_dac_swing_on = false;
 319
 320                 btdm8723.pta_on = true;
 321                 btdm8723.val_0x6c0 = 0x5a5aaaaa;
 322                 btdm8723.val_0x6c8 = 0xcccc;
 323                 btdm8723.val_0x6cc = 0x3;
 324
 325                 btdm8723.tdma_on = false;
 326                 btdm8723.tdma_dac_swing = TDMA_DAC_SWING_OFF;
 327                 btdm8723.b2_ant_hid_en = false;
 328
 329                 b_common = true;
 330         } else if (rtlpriv->btcoexist.bt_busy) {
 331                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 332                         "Bt non-idle!\n");
 333                 if (mgnt_link_status_query(hw) == RT_MEDIA_CONNECT) {
 334                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 335                                 "Wifi connection exist\n");
 336                         b_common = false;
 337                 } else {
 338                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 339                                 "No Wifi connection!\n");
 340                         btdm8723.rf_rx_lpf_shrink = true;
 341                         btdm8723.low_penalty_rate_adaptive = false;
 342                         btdm8723.reject_aggre_pkt = false;
 343
 344                         /* sw mechanism */
 345                         btdm8723.agc_table_en = false;
 346                         btdm8723.adc_back_off_on = false;
 347                         btdm8723.sw_dac_swing_on = false;
 348
 349                         btdm8723.pta_on = true;
 350                         btdm8723.val_0x6c0 = 0x55555555;
 351                         btdm8723.val_0x6c8 = 0x0000ffff;
 352                         btdm8723.val_0x6cc = 0x3;
 353
 354                         btdm8723.tdma_on = false;
 355                         btdm8723.tdma_dac_swing = TDMA_DAC_SWING_OFF;
 356                         btdm8723.b2_ant_hid_en = false;
 357
 358                         b_common = true;
 359                 }
 360         }
 361
 362         if (rtl8723e_dm_bt_need_to_dec_bt_pwr(hw))
 363                 btdm8723.dec_bt_pwr = true;
 364
 365         if (b_common)
 366                 rtlpriv->btcoexist.cstate |=
 367                         BT_COEX_STATE_BTINFO_COMMON;
 368
 369         if (b_common && rtl8723e_dm_bt_is_coexist_state_changed(hw))
 370                 rtl8723e_dm_bt_set_bt_dm(hw, &btdm8723);
 371
 372         return b_common;
 373 }
 374
 375 static void rtl8723e_dm_bt_set_sw_full_time_dac_swing(
 376                 struct ieee80211_hw *hw,
 377                 bool sw_dac_swing_on,
 378                 u32 sw_dac_swing_lvl)
 379 {
 380         struct rtl_priv *rtlpriv = rtl_priv(hw);
 381
 382         if (sw_dac_swing_on) {
 383                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 384                          "[BTCoex], SwDacSwing = 0x%x\n", sw_dac_swing_lvl);
 385                 rtl8723_phy_set_bb_reg(hw, 0x880, 0xff000000,
 386                                        sw_dac_swing_lvl);
 387                 rtlpriv->btcoexist.sw_coexist_all_off = false;
 388         } else {
 389                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 390                          "[BTCoex], SwDacSwing Off!\n");
 391                 rtl8723_phy_set_bb_reg(hw, 0x880, 0xff000000, 0xc0);
 392         }
 393 }
 394
 395 static void rtl8723e_dm_bt_set_fw_dec_bt_pwr(
 396                 struct ieee80211_hw *hw, bool dec_bt_pwr)
 397 {
 398         struct rtl_priv *rtlpriv = rtl_priv(hw);
 399         u8 h2c_parameter[1] = {0};
 400
 401         h2c_parameter[0] = 0;
 402
 403         if (dec_bt_pwr) {
 404                 h2c_parameter[0] |= BIT(1);
 405                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 406         }
 407
 408         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 409                  "[BTCoex], decrease Bt Power : %s, write 0x21=0x%x\n",
 410                  (dec_bt_pwr ? "Yes!!" : "No!!"), h2c_parameter[0]);
 411
 412         rtl8723e_fill_h2c_cmd(hw, 0x21, 1, h2c_parameter);
 413 }
 414
 415 static void rtl8723e_dm_bt_set_fw_2_ant_hid(struct ieee80211_hw *hw,
 416                                             bool b_enable, bool b_dac_swing_on)
 417 {
 418         struct rtl_priv *rtlpriv = rtl_priv(hw);
 419         u8 h2c_parameter[1] = {0};
 420
 421         if (b_enable) {
 422                 h2c_parameter[0] |= BIT(0);
 423                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 424         }
 425         if (b_dac_swing_on)
 426                 h2c_parameter[0] |= BIT(1); /* Dac Swing default enable */
 427
 428         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 429                  "[BTCoex], turn 2-Ant+HID mode %s, DACSwing:%s, write 0x15=0x%x\n",
 430                  (b_enable ? "ON!!" : "OFF!!"), (b_dac_swing_on ? "ON" : "OFF"),
 431                  h2c_parameter[0]);
 432
 433         rtl8723e_fill_h2c_cmd(hw, 0x15, 1, h2c_parameter);
 434 }
 435
 436 static void rtl8723e_dm_bt_set_fw_tdma_ctrl(struct ieee80211_hw *hw,
 437                                             bool b_enable, u8 ant_num,
 438                                             u8 nav_en, u8 dac_swing_en)
 439 {
 440         struct rtl_priv *rtlpriv = rtl_priv(hw);
 441         u8 h2c_parameter[1] = {0};
 442         u8 h2c_parameter1[1] = {0};
 443
 444         h2c_parameter[0] = 0;
 445         h2c_parameter1[0] = 0;
 446
 447         if (b_enable) {
 448                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 449                          "[BTCoex], set BT PTA update manager to trigger update!!\n");
 450                 h2c_parameter1[0] |= BIT(0);
 451
 452                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 453                         "[BTCoex], turn TDMA mode ON!!\n");
 454                 h2c_parameter[0] |= BIT(0);             /* function enable */
 455                 if (TDMA_1ANT == ant_num) {
 456                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 457                         "[BTCoex], TDMA_1ANT\n");
 458                         h2c_parameter[0] |= BIT(1);
 459                 } else if (TDMA_2ANT == ant_num) {
 460                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 461                         "[BTCoex], TDMA_2ANT\n");
 462                 } else {
 463                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 464                         "[BTCoex], Unknown Ant\n");
 465                 }
 466
 467                 if (TDMA_NAV_OFF == nav_en) {
 468                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 469                         "[BTCoex], TDMA_NAV_OFF\n");
 470                 } else if (TDMA_NAV_ON == nav_en) {
 471                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 472                         "[BTCoex], TDMA_NAV_ON\n");
 473                         h2c_parameter[0] |= BIT(2);
 474                 }
 475
 476                 if (TDMA_DAC_SWING_OFF == dac_swing_en) {
 477                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 478                                 "[BTCoex], TDMA_DAC_SWING_OFF\n");
 479                 } else if (TDMA_DAC_SWING_ON == dac_swing_en) {
 480                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 481                                 "[BTCoex], TDMA_DAC_SWING_ON\n");
 482                         h2c_parameter[0] |= BIT(4);
 483                 }
 484                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 485         } else {
 486                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 487                          "[BTCoex], set BT PTA update manager to no update!!\n");
 488                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 489                          "[BTCoex], turn TDMA mode OFF!!\n");
 490         }
 491
 492         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 493                  "[BTCoex], FW2AntTDMA, write 0x26=0x%x\n",
 494                  h2c_parameter1[0]);
 495         rtl8723e_fill_h2c_cmd(hw, 0x26, 1, h2c_parameter1);
 496
 497         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 498                 "[BTCoex], FW2AntTDMA, write 0x14=0x%x\n",
 499                 h2c_parameter[0]);
 500         rtl8723e_fill_h2c_cmd(hw, 0x14, 1, h2c_parameter);
 501 }
 502
 503 static void rtl8723e_dm_bt_set_fw_ignore_wlan_act(struct ieee80211_hw *hw,
 504                                                   bool b_enable)
 505 {
 506         struct rtl_priv *rtlpriv = rtl_priv(hw);
 507         u8 h2c_parameter[1] = {0};
 508
 509         if (b_enable) {
 510                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 511                         "[BTCoex], BT Ignore Wlan_Act !!\n");
 512                 h2c_parameter[0] |= BIT(0);             /* function enable */
 513                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 514         } else {
 515                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 516                         "[BTCoex], BT don't ignore Wlan_Act !!\n");
 517         }
 518
 519         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 520                  "[BTCoex], set FW for BT Ignore Wlan_Act, write 0x25=0x%x\n",
 521                  h2c_parameter[0]);
 522
 523         rtl8723e_fill_h2c_cmd(hw, 0x25, 1, h2c_parameter);
 524 }
 525
 526 static void rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(struct ieee80211_hw *hw,
 527                                                 bool b_enable, u8 ant_num,
 528                                                 u8 nav_en)
 529 {
 530         struct rtl_priv *rtlpriv = rtl_priv(hw);
 531         struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
 532
 533         u8 h2c_parameter[2] = {0};
 534
 535         /* Only 8723 B cut should do this */
 536         if (IS_VENDOR_8723_A_CUT(rtlhal->version)) {
 537                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 538                          "[BTCoex], not 8723B cut, don't set Traditional TDMA!!\n");
 539                 return;
 540         }
 541
 542         if (b_enable) {
 543                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 544                          "[BTCoex], turn TTDMA mode ON!!\n");
 545                 h2c_parameter[0] |= BIT(0);     /* function enable */
 546                 if (TDMA_1ANT == ant_num) {
 547                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 548                                  "[BTCoex], TTDMA_1ANT\n");
 549                         h2c_parameter[0] |= BIT(1);
 550                 } else if (TDMA_2ANT == ant_num) {
 551                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 552                         "[BTCoex], TTDMA_2ANT\n");
 553                 } else {
 554                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 555                         "[BTCoex], Unknown Ant\n");
 556                 }
 557
 558                 if (TDMA_NAV_OFF == nav_en) {
 559                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 560                         "[BTCoex], TTDMA_NAV_OFF\n");
 561                 } else if (TDMA_NAV_ON == nav_en) {
 562                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 563                         "[BTCoex], TTDMA_NAV_ON\n");
 564                         h2c_parameter[1] |= BIT(0);
 565                 }
 566
 567                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 568         } else {
 569                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 570                         "[BTCoex], turn TTDMA mode OFF!!\n");
 571         }
 572
 573         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 574                 "[BTCoex], FW Traditional TDMA, write 0x33=0x%x\n",
 575                 h2c_parameter[0] << 8 | h2c_parameter[1]);
 576
 577         rtl8723e_fill_h2c_cmd(hw, 0x33, 2, h2c_parameter);
 578 }
 579
 580 static void rtl8723e_dm_bt_set_fw_dac_swing_level(struct ieee80211_hw *hw,
 581                                                   u8 dac_swing_lvl)
 582 {
 583         struct rtl_priv *rtlpriv = rtl_priv(hw);
 584         u8 h2c_parameter[1] = {0};
 585         h2c_parameter[0] = dac_swing_lvl;
 586
 587         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 588                 "[BTCoex], Set Dac Swing Level=0x%x\n", dac_swing_lvl);
 589         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 590                 "[BTCoex], write 0x29=0x%x\n", h2c_parameter[0]);
 591
 592         rtl8723e_fill_h2c_cmd(hw, 0x29, 1, h2c_parameter);
 593 }
 594
 595 static void rtl8723e_dm_bt_set_fw_bt_hid_info(struct ieee80211_hw *hw,
 596                                               bool b_enable)
 597 {
 598         struct rtl_priv *rtlpriv = rtl_priv(hw);
 599         u8 h2c_parameter[1] = {0};
 600         h2c_parameter[0] = 0;
 601
 602         if (b_enable) {
 603                 h2c_parameter[0] |= BIT(0);
 604                 rtlpriv->btcoexist.fw_coexist_all_off = false;
 605         }
 606         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 607                 "[BTCoex], Set BT HID information=0x%x\n", b_enable);
 608         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 609                 "[BTCoex], write 0x24=0x%x\n", h2c_parameter[0]);
 610
 611         rtl8723e_fill_h2c_cmd(hw, 0x24, 1, h2c_parameter);
 612 }
 613
 614 static void rtl8723e_dm_bt_set_fw_bt_retry_index(struct ieee80211_hw *hw,
 615                                                  u8 retry_index)
 616 {
 617         struct rtl_priv *rtlpriv = rtl_priv(hw);
 618         u8 h2c_parameter[1] = {0};
 619         h2c_parameter[0] = retry_index;
 620
 621         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 622                 "[BTCoex], Set BT Retry Index=%d\n", retry_index);
 623         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 624                 "[BTCoex], write 0x23=0x%x\n", h2c_parameter[0]);
 625
 626         rtl8723e_fill_h2c_cmd(hw, 0x23, 1, h2c_parameter);
 627 }
 628
 629 static void rtl8723e_dm_bt_set_fw_wlan_act(struct ieee80211_hw *hw,
 630                                            u8 wlan_act_hi, u8 wlan_act_lo)
 631 {
 632         struct rtl_priv *rtlpriv = rtl_priv(hw);
 633         u8 h2c_parameter_hi[1] = {0};
 634         u8 h2c_parameter_lo[1] = {0};
 635         h2c_parameter_hi[0] = wlan_act_hi;
 636         h2c_parameter_lo[0] = wlan_act_lo;
 637
 638         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 639                 "[BTCoex], Set WLAN_ACT Hi:Lo=0x%x/0x%x\n",
 640                 wlan_act_hi, wlan_act_lo);
 641         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 642                 "[BTCoex], write 0x22=0x%x\n", h2c_parameter_hi[0]);
 643         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 644                 "[BTCoex], write 0x11=0x%x\n", h2c_parameter_lo[0]);
 645
 646         /* WLAN_ACT = High duration, unit:ms */
 647         rtl8723e_fill_h2c_cmd(hw, 0x22, 1, h2c_parameter_hi);
 648         /*  WLAN_ACT = Low duration, unit:3*625us */
 649         rtl8723e_fill_h2c_cmd(hw, 0x11, 1, h2c_parameter_lo);
 650 }
 651
 652 void rtl8723e_dm_bt_set_bt_dm(struct ieee80211_hw *hw,
 653                               struct btdm_8723 *btdm)
 654 {
 655         struct rtl_priv *rtlpriv = rtl_priv(hw);
 656         struct btdm_8723 *btdm_8723 = &hal_coex_8723.btdm;
 657         u8 i;
 658
 659         bool fw_current_inpsmode = false;
 660         bool fw_ps_awake = true;
 661
 662         rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FW_PSMODE_STATUS,
 663                                               (u8 *)(&fw_current_inpsmode));
 664         rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_FWLPS_RF_ON,
 665                                               (u8 *)(&fw_ps_awake));
 666
 667         /* check new setting is different with the old one, */
 668         /* if all the same, don't do the setting again. */
 669         if (memcmp(btdm_8723, btdm, sizeof(struct btdm_8723)) == 0) {
 670                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 671                         "[BTCoex], the same coexist setting, return!!\n");
 672                 return;
 673         } else {        /* save the new coexist setting */
 674                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 675                         "[BTCoex], UPDATE TO NEW COEX SETTING!!\n");
 676                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 677                         "[BTCoex], original/new bAllOff=0x%x/ 0x%x\n",
 678                         btdm_8723->all_off, btdm->all_off);
 679                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 680                         "[BTCoex], original/new agc_table_en=0x%x/ 0x%x\n",
 681                         btdm_8723->agc_table_en, btdm->agc_table_en);
 682                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 683                          "[BTCoex], original/new adc_back_off_on=0x%x/ 0x%x\n",
 684                          btdm_8723->adc_back_off_on,
 685                          btdm->adc_back_off_on);
 686                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 687                          "[BTCoex], original/new b2_ant_hid_en=0x%x/ 0x%x\n",
 688                          btdm_8723->b2_ant_hid_en, btdm->b2_ant_hid_en);
 689                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 690                          "[BTCoex], original/new bLowPenaltyRateAdaptive=0x%x/ 0x%x\n",
 691                          btdm_8723->low_penalty_rate_adaptive,
 692                          btdm->low_penalty_rate_adaptive);
 693                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 694                          "[BTCoex], original/new bRfRxLpfShrink=0x%x/ 0x%x\n",
 695                          btdm_8723->rf_rx_lpf_shrink,
 696                          btdm->rf_rx_lpf_shrink);
 697                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 698                          "[BTCoex], original/new bRejectAggrePkt=0x%x/ 0x%x\n",
 699                          btdm_8723->reject_aggre_pkt,
 700                          btdm->reject_aggre_pkt);
 701                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 702                          "[BTCoex], original/new tdma_on=0x%x/ 0x%x\n",
 703                          btdm_8723->tdma_on, btdm->tdma_on);
 704                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 705                          "[BTCoex], original/new tdmaAnt=0x%x/ 0x%x\n",
 706                          btdm_8723->tdma_ant, btdm->tdma_ant);
 707                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 708                          "[BTCoex], original/new tdmaNav=0x%x/ 0x%x\n",
 709                          btdm_8723->tdma_nav, btdm->tdma_nav);
 710                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 711                          "[BTCoex], original/new tdma_dac_swing=0x%x/ 0x%x\n",
 712                          btdm_8723->tdma_dac_swing, btdm->tdma_dac_swing);
 713                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 714                          "[BTCoex], original/new fw_dac_swing_lvl=0x%x/ 0x%x\n",
 715                          btdm_8723->fw_dac_swing_lvl,
 716                          btdm->fw_dac_swing_lvl);
 717
 718                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 719                          "[BTCoex], original/new bTraTdmaOn=0x%x/ 0x%x\n",
 720                          btdm_8723->tra_tdma_on, btdm->tra_tdma_on);
 721                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 722                          "[BTCoex], original/new traTdmaAnt=0x%x/ 0x%x\n",
 723                          btdm_8723->tra_tdma_ant, btdm->tra_tdma_ant);
 724                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 725                          "[BTCoex], original/new traTdmaNav=0x%x/ 0x%x\n",
 726                          btdm_8723->tra_tdma_nav, btdm->tra_tdma_nav);
 727                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 728                          "[BTCoex], original/new bPsTdmaOn=0x%x/ 0x%x\n",
 729                          btdm_8723->ps_tdma_on, btdm->ps_tdma_on);
 730                 for (i = 0; i < 5; i++) {
 731                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 732                                  "[BTCoex], original/new psTdmaByte[i]=0x%x/ 0x%x\n",
 733                                  btdm_8723->ps_tdma_byte[i],
 734                                  btdm->ps_tdma_byte[i]);
 735                 }
 736                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 737                         "[BTCoex], original/new bIgnoreWlanAct=0x%x/ 0x%x\n",
 738                         btdm_8723->ignore_wlan_act,
 739                         btdm->ignore_wlan_act);
 740
 741
 742                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 743                         "[BTCoex], original/new bPtaOn=0x%x/ 0x%x\n",
 744                         btdm_8723->pta_on, btdm->pta_on);
 745                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 746                         "[BTCoex], original/new val_0x6c0=0x%x/ 0x%x\n",
 747                         btdm_8723->val_0x6c0, btdm->val_0x6c0);
 748                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 749                         "[BTCoex], original/new val_0x6c8=0x%x/ 0x%x\n",
 750                         btdm_8723->val_0x6c8, btdm->val_0x6c8);
 751                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 752                         "[BTCoex], original/new val_0x6cc=0x%x/ 0x%x\n",
 753                         btdm_8723->val_0x6cc, btdm->val_0x6cc);
 754                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 755                          "[BTCoex], original/new sw_dac_swing_on=0x%x/ 0x%x\n",
 756                          btdm_8723->sw_dac_swing_on,
 757                          btdm->sw_dac_swing_on);
 758                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 759                          "[BTCoex], original/new sw_dac_swing_lvl=0x%x/ 0x%x\n",
 760                          btdm_8723->sw_dac_swing_lvl,
 761                          btdm->sw_dac_swing_lvl);
 762                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 763                          "[BTCoex], original/new wlanActHi=0x%x/ 0x%x\n",
 764                          btdm_8723->wlan_act_hi, btdm->wlan_act_hi);
 765                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 766                          "[BTCoex], original/new wlanActLo=0x%x/ 0x%x\n",
 767                          btdm_8723->wlan_act_lo, btdm->wlan_act_lo);
 768                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 769                          "[BTCoex], original/new btRetryIndex=0x%x/ 0x%x\n",
 770                          btdm_8723->bt_retry_index, btdm->bt_retry_index);
 771
 772                 memcpy(btdm_8723, btdm, sizeof(struct btdm_8723));
 773         }
 774         /* Here we only consider when Bt Operation
 775          * inquiry/paging/pairing is ON
 776          * we only need to turn off TDMA
 777          */
 778
 779         if (rtlpriv->btcoexist.hold_for_bt_operation) {
 780                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 781                         "[BTCoex], set to ignore wlanAct for BT OP!!\n");
 782                 rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw, true);
 783                 return;
 784         }
 785
 786         if (btdm->all_off) {
 787                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
 788                         "[BTCoex], disable all coexist mechanism !!\n");
 789                 rtl8723e_btdm_coex_all_off(hw);
 790                 return;
 791         }
 792
 793         rtl8723e_dm_bt_reject_ap_aggregated_packet(hw, btdm->reject_aggre_pkt);
 794
 795         if (btdm->low_penalty_rate_adaptive)
 796                 dm_bt_set_sw_penalty_tx_rate_adapt(hw, BT_TX_RATE_ADAPTIVE_LOW_PENALTY);
 797         else
 798                 dm_bt_set_sw_penalty_tx_rate_adapt(hw,
 799                                                    BT_TX_RATE_ADAPTIVE_NORMAL);
 800
 801         if (btdm->rf_rx_lpf_shrink)
 802                 rtl8723e_dm_bt_set_sw_rf_rx_lpf_corner(hw,
 803                                 BT_RF_RX_LPF_CORNER_SHRINK);
 804         else
 805                 rtl8723e_dm_bt_set_sw_rf_rx_lpf_corner(hw,
 806                                 BT_RF_RX_LPF_CORNER_RESUME);
 807
 808         if (btdm->agc_table_en)
 809                 rtl8723e_dm_bt_agc_table(hw, BT_AGCTABLE_ON);
 810         else
 811                 rtl8723e_dm_bt_agc_table(hw, BT_AGCTABLE_OFF);
 812
 813         if (btdm->adc_back_off_on)
 814                 rtl8723e_dm_bt_bb_back_off_level(hw, BT_BB_BACKOFF_ON);
 815         else
 816                 rtl8723e_dm_bt_bb_back_off_level(hw, BT_BB_BACKOFF_OFF);
 817
 818         rtl8723e_dm_bt_set_fw_bt_retry_index(hw, btdm->bt_retry_index);
 819
 820         rtl8723e_dm_bt_set_fw_dac_swing_level(hw, btdm->fw_dac_swing_lvl);
 821         rtl8723e_dm_bt_set_fw_wlan_act(hw, btdm->wlan_act_hi,
 822                                        btdm->wlan_act_lo);
 823
 824         rtl8723e_dm_bt_set_coex_table(hw, btdm->val_0x6c0,
 825                                       btdm->val_0x6c8, btdm->val_0x6cc);
 826         rtl8723e_dm_bt_set_hw_pta_mode(hw, btdm->pta_on);
 827
 828         /* Note: There is a constraint between TDMA and 2AntHID
 829          * Only one of 2AntHid and tdma can be turn on
 830          * We should turn off those mechanisms should be turned off first
 831          * and then turn on those mechanisms should be turned on.
 832         */
 833         if (btdm->b2_ant_hid_en) {
 834                 /* turn off tdma */
 835                 rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(hw, btdm->tra_tdma_on,
 836                                                     btdm->tra_tdma_ant,
 837                                                     btdm->tra_tdma_nav);
 838                 rtl8723e_dm_bt_set_fw_tdma_ctrl(hw, false, btdm->tdma_ant,
 839                                                 btdm->tdma_nav,
 840                                                 btdm->tdma_dac_swing);
 841
 842                 /* turn off Pstdma */
 843                 rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw,
 844                                                       btdm->ignore_wlan_act);
 845                 /* Antenna control by PTA, 0x870 = 0x300. */
 846                 rtl8723e_dm_bt_set_fw_3a(hw, 0x0, 0x0, 0x0, 0x8, 0x0);
 847
 848                 /* turn on 2AntHid */
 849                 rtl8723e_dm_bt_set_fw_bt_hid_info(hw, true);
 850                 rtl8723e_dm_bt_set_fw_2_ant_hid(hw, true, true);
 851         } else if (btdm->tdma_on) {
 852                 /* turn off 2AntHid */
 853                 rtl8723e_dm_bt_set_fw_bt_hid_info(hw, false);
 854                 rtl8723e_dm_bt_set_fw_2_ant_hid(hw, false, false);
 855
 856                 /* turn off pstdma */
 857                 rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw,
 858                                                       btdm->ignore_wlan_act);
 859                 /* Antenna control by PTA, 0x870 = 0x300. */
 860                 rtl8723e_dm_bt_set_fw_3a(hw, 0x0, 0x0, 0x0, 0x8, 0x0);
 861
 862                 /* turn on tdma */
 863                 rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(hw, btdm->tra_tdma_on,
 864                                                     btdm->tra_tdma_ant,
 865                                                     btdm->tra_tdma_nav);
 866                 rtl8723e_dm_bt_set_fw_tdma_ctrl(hw, true, btdm->tdma_ant,
 867                                                 btdm->tdma_nav,
 868                                                 btdm->tdma_dac_swing);
 869         } else if (btdm->ps_tdma_on) {
 870                 /* turn off 2AntHid */
 871                 rtl8723e_dm_bt_set_fw_bt_hid_info(hw, false);
 872                 rtl8723e_dm_bt_set_fw_2_ant_hid(hw, false, false);
 873
 874                 /* turn off tdma */
 875                 rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(hw, btdm->tra_tdma_on,
 876                                                     btdm->tra_tdma_ant,
 877                                                     btdm->tra_tdma_nav);
 878                 rtl8723e_dm_bt_set_fw_tdma_ctrl(hw, false, btdm->tdma_ant,
 879                                                 btdm->tdma_nav,
 880                                                 btdm->tdma_dac_swing);
 881
 882                 /* turn on pstdma */
 883                 rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw,
 884                                                       btdm->ignore_wlan_act);
 885                 rtl8723e_dm_bt_set_fw_3a(hw, btdm->ps_tdma_byte[0],
 886                                          btdm->ps_tdma_byte[1],
 887                                          btdm->ps_tdma_byte[2],
 888                                          btdm->ps_tdma_byte[3],
 889                                          btdm->ps_tdma_byte[4]);
 890         } else {
 891                 /* turn off 2AntHid */
 892                 rtl8723e_dm_bt_set_fw_bt_hid_info(hw, false);
 893                 rtl8723e_dm_bt_set_fw_2_ant_hid(hw, false, false);
 894
 895                 /* turn off tdma */
 896                 rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(hw, btdm->tra_tdma_on,
 897                                                     btdm->tra_tdma_ant,
 898                                                     btdm->tra_tdma_nav);
 899                 rtl8723e_dm_bt_set_fw_tdma_ctrl(hw, false, btdm->tdma_ant,
 900                                                 btdm->tdma_nav,
 901                                                 btdm->tdma_dac_swing);
 902
 903                 /* turn off pstdma */
 904                 rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw,
 905                                                 btdm->ignore_wlan_act);
 906                 /* Antenna control by PTA, 0x870 = 0x300. */
 907                 rtl8723e_dm_bt_set_fw_3a(hw, 0x0, 0x0, 0x0, 0x8, 0x0);
 908         }
 909
 910         /* Note:
 911          * We should add delay for making sure
 912          *      sw DacSwing can be set sucessfully.
 913          * because of that rtl8723e_dm_bt_set_fw_2_ant_hid()
 914          *      and rtl8723e_dm_bt_set_fw_tdma_ctrl()
 915          * will overwrite the reg 0x880.
 916         */
 917         mdelay(30);
 918         rtl8723e_dm_bt_set_sw_full_time_dac_swing(hw, btdm->sw_dac_swing_on,
 919                                                   btdm->sw_dac_swing_lvl);
 920         rtl8723e_dm_bt_set_fw_dec_bt_pwr(hw, btdm->dec_bt_pwr);
 921 }
 922
 923 /* ============================================================ */
 924 /* extern function start with BTDM_ */
 925 /* ============================================================i
 926  */
 927 static u32 rtl8723e_dm_bt_tx_rx_couter_h(struct ieee80211_hw *hw)
 928 {
 929         u32     counters = 0;
 930
 931         counters = hal_coex_8723.high_priority_tx +
 932                         hal_coex_8723.high_priority_rx;
 933         return counters;
 934 }
 935
 936 static u32 rtl8723e_dm_bt_tx_rx_couter_l(struct ieee80211_hw *hw)
 937 {
 938         u32 counters = 0;
 939
 940         counters = hal_coex_8723.low_priority_tx +
 941                         hal_coex_8723.low_priority_rx;
 942         return counters;
 943 }
 944
 945 static u8 rtl8723e_dm_bt_bt_tx_rx_counter_level(struct ieee80211_hw *hw)
 946 {
 947         struct rtl_priv *rtlpriv = rtl_priv(hw);
 948         u32     bt_tx_rx_cnt = 0;
 949         u8      bt_tx_rx_cnt_lvl = 0;
 950
 951         bt_tx_rx_cnt = rtl8723e_dm_bt_tx_rx_couter_h(hw)
 952                                 + rtl8723e_dm_bt_tx_rx_couter_l(hw);
 953         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 954                  "[BTCoex], BT TxRx Counters = %d\n", bt_tx_rx_cnt);
 955
 956         rtlpriv->btcoexist.cstate_h &= ~
 957                  (BT_COEX_STATE_BT_CNT_LEVEL_0 | BT_COEX_STATE_BT_CNT_LEVEL_1|
 958                   BT_COEX_STATE_BT_CNT_LEVEL_2);
 959
 960         if (bt_tx_rx_cnt >= BT_TXRX_CNT_THRES_3) {
 961                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 962                          "[BTCoex], BT TxRx Counters at level 3\n");
 963                 bt_tx_rx_cnt_lvl = BT_TXRX_CNT_LEVEL_3;
 964                 rtlpriv->btcoexist.cstate_h |=
 965                         BT_COEX_STATE_BT_CNT_LEVEL_3;
 966         } else if (bt_tx_rx_cnt >= BT_TXRX_CNT_THRES_2) {
 967                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 968                          "[BTCoex], BT TxRx Counters at level 2\n");
 969                 bt_tx_rx_cnt_lvl = BT_TXRX_CNT_LEVEL_2;
 970                 rtlpriv->btcoexist.cstate_h |=
 971                         BT_COEX_STATE_BT_CNT_LEVEL_2;
 972         } else if (bt_tx_rx_cnt >= BT_TXRX_CNT_THRES_1) {
 973                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 974                          "[BTCoex], BT TxRx Counters at level 1\n");
 975                 bt_tx_rx_cnt_lvl = BT_TXRX_CNT_LEVEL_1;
 976                 rtlpriv->btcoexist.cstate_h  |=
 977                         BT_COEX_STATE_BT_CNT_LEVEL_1;
 978         } else {
 979                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
 980                          "[BTCoex], BT TxRx Counters at level 0\n");
 981                 bt_tx_rx_cnt_lvl = BT_TXRX_CNT_LEVEL_0;
 982                 rtlpriv->btcoexist.cstate_h |=
 983                         BT_COEX_STATE_BT_CNT_LEVEL_0;
 984         }
 985         return bt_tx_rx_cnt_lvl;
 986 }
 987
 988 static void rtl8723e_dm_bt_2_ant_hid_sco_esco(struct ieee80211_hw *hw)
 989 {
 990         struct rtl_priv *rtlpriv = rtl_priv(hw);
 991         struct rtl_phy *rtlphy = &(rtlpriv->phy);
 992         struct btdm_8723 btdm8723;
 993         u8 bt_rssi_state, bt_rssi_state1;
 994         u8      bt_tx_rx_cnt_lvl = 0;
 995
 996         rtl8723e_dm_bt_btdm_structure_reload(hw, &btdm8723);
 997
 998         btdm8723.rf_rx_lpf_shrink = true;
 999         btdm8723.low_penalty_rate_adaptive = true;
1000         btdm8723.reject_aggre_pkt = false;
1001
1002         bt_tx_rx_cnt_lvl = rtl8723e_dm_bt_bt_tx_rx_counter_level(hw);
1003         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1004                  "[BTCoex], BT TxRx Counters = %d\n", bt_tx_rx_cnt_lvl);
1005
1006         if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40) {
1007                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG, "HT40\n");
1008                 /* coex table */
1009                 btdm8723.val_0x6c0 = 0x55555555;
1010                 btdm8723.val_0x6c8 = 0xffff;
1011                 btdm8723.val_0x6cc = 0x3;
1012
1013                 /* sw mechanism */
1014                 btdm8723.agc_table_en = false;
1015                 btdm8723.adc_back_off_on = false;
1016                 btdm8723.sw_dac_swing_on = false;
1017
1018                 /* fw mechanism */
1019                 btdm8723.ps_tdma_on = true;
1020                 if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1021                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1022                                  "[BTCoex], BT TxRx Counters >= 1400\n");
1023                         btdm8723.ps_tdma_byte[0] = 0xa3;
1024                         btdm8723.ps_tdma_byte[1] = 0x5;
1025                         btdm8723.ps_tdma_byte[2] = 0x5;
1026                         btdm8723.ps_tdma_byte[3] = 0x2;
1027                         btdm8723.ps_tdma_byte[4] = 0x80;
1028                 } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1029                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1030                                  "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1031                         btdm8723.ps_tdma_byte[0] = 0xa3;
1032                         btdm8723.ps_tdma_byte[1] = 0xa;
1033                         btdm8723.ps_tdma_byte[2] = 0xa;
1034                         btdm8723.ps_tdma_byte[3] = 0x2;
1035                         btdm8723.ps_tdma_byte[4] = 0x80;
1036                 } else {
1037                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1038                                  "[BTCoex], BT TxRx Counters < 1200\n");
1039                         btdm8723.ps_tdma_byte[0] = 0xa3;
1040                         btdm8723.ps_tdma_byte[1] = 0xf;
1041                         btdm8723.ps_tdma_byte[2] = 0xf;
1042                         btdm8723.ps_tdma_byte[3] = 0x2;
1043                         btdm8723.ps_tdma_byte[4] = 0x80;
1044                 }
1045         } else {
1046                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1047                          "HT20 or Legacy\n");
1048                 bt_rssi_state =
1049                   rtl8723e_dm_bt_check_coex_rssi_state(hw, 2, 47, 0);
1050                 bt_rssi_state1 =
1051                   rtl8723e_dm_bt_check_coex_rssi_state1(hw, 2, 27, 0);
1052
1053                 /* coex table */
1054                 btdm8723.val_0x6c0 = 0x55555555;
1055                 btdm8723.val_0x6c8 = 0xffff;
1056                 btdm8723.val_0x6cc = 0x3;
1057
1058                 /* sw mechanism */
1059                 if ((bt_rssi_state == BT_RSSI_STATE_HIGH) ||
1060                         (bt_rssi_state == BT_RSSI_STATE_STAY_HIGH)) {
1061                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1062                                         "Wifi rssi high\n");
1063                         btdm8723.agc_table_en = true;
1064                         btdm8723.adc_back_off_on = true;
1065                         btdm8723.sw_dac_swing_on = false;
1066                 } else {
1067                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1068                                         "Wifi rssi low\n");
1069                         btdm8723.agc_table_en = false;
1070                         btdm8723.adc_back_off_on = false;
1071                         btdm8723.sw_dac_swing_on = false;
1072                 }
1073
1074                 /* fw mechanism */
1075                 btdm8723.ps_tdma_on = true;
1076                 if ((bt_rssi_state1 == BT_RSSI_STATE_HIGH) ||
1077                         (bt_rssi_state1 == BT_RSSI_STATE_STAY_HIGH)) {
1078                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1079                                  "Wifi rssi-1 high\n");
1080                         /* only rssi high we need to do this, */
1081                         /* when rssi low, the value will modified by fw */
1082                         rtl_write_byte(rtlpriv, 0x883, 0x40);
1083                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1084                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1085                                 "[BTCoex], BT TxRx Counters >= 1400\n");
1086                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1087                                 btdm8723.ps_tdma_byte[1] = 0x5;
1088                                 btdm8723.ps_tdma_byte[2] = 0x5;
1089                                 btdm8723.ps_tdma_byte[3] = 0x83;
1090                                 btdm8723.ps_tdma_byte[4] = 0x80;
1091                         } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1092                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1093                                          "[BTCoex], BT TxRx Counters>= 1200 && < 1400\n");
1094                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1095                                 btdm8723.ps_tdma_byte[1] = 0xa;
1096                                 btdm8723.ps_tdma_byte[2] = 0xa;
1097                                 btdm8723.ps_tdma_byte[3] = 0x83;
1098                                 btdm8723.ps_tdma_byte[4] = 0x80;
1099                         } else {
1100                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1101                                          "[BTCoex], BT TxRx Counters < 1200\n");
1102                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1103                                 btdm8723.ps_tdma_byte[1] = 0xf;
1104                                 btdm8723.ps_tdma_byte[2] = 0xf;
1105                                 btdm8723.ps_tdma_byte[3] = 0x83;
1106                                 btdm8723.ps_tdma_byte[4] = 0x80;
1107                         }
1108                 } else {
1109                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1110                                         "Wifi rssi-1 low\n");
1111                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1112                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1113                                          "[BTCoex], BT TxRx Counters >= 1400\n");
1114                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1115                                 btdm8723.ps_tdma_byte[1] = 0x5;
1116                                 btdm8723.ps_tdma_byte[2] = 0x5;
1117                                 btdm8723.ps_tdma_byte[3] = 0x2;
1118                                 btdm8723.ps_tdma_byte[4] = 0x80;
1119                         } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1120                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1121                                          "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1122                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1123                                 btdm8723.ps_tdma_byte[1] = 0xa;
1124                                 btdm8723.ps_tdma_byte[2] = 0xa;
1125                                 btdm8723.ps_tdma_byte[3] = 0x2;
1126                                 btdm8723.ps_tdma_byte[4] = 0x80;
1127                         } else {
1128                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1129                                          "[BTCoex], BT TxRx Counters < 1200\n");
1130                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1131                                 btdm8723.ps_tdma_byte[1] = 0xf;
1132                                 btdm8723.ps_tdma_byte[2] = 0xf;
1133                                 btdm8723.ps_tdma_byte[3] = 0x2;
1134                                 btdm8723.ps_tdma_byte[4] = 0x80;
1135                         }
1136                 }
1137         }
1138
1139         if (rtl8723e_dm_bt_need_to_dec_bt_pwr(hw))
1140                 btdm8723.dec_bt_pwr = true;
1141
1142         /* Always ignore WlanAct if bHid|bSCOBusy|bSCOeSCO */
1143
1144         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1145                  "[BTCoex], BT btInqPageStartTime = 0x%x, btTxRxCntLvl = %d\n",
1146                  hal_coex_8723.bt_inq_page_start_time, bt_tx_rx_cnt_lvl);
1147         if ((hal_coex_8723.bt_inq_page_start_time) ||
1148             (BT_TXRX_CNT_LEVEL_3 == bt_tx_rx_cnt_lvl)) {
1149                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1150                          "[BTCoex], Set BT inquiry / page scan 0x3a setting\n");
1151                 btdm8723.ps_tdma_on = true;
1152                 btdm8723.ps_tdma_byte[0] = 0xa3;
1153                 btdm8723.ps_tdma_byte[1] = 0x5;
1154                 btdm8723.ps_tdma_byte[2] = 0x5;
1155                 btdm8723.ps_tdma_byte[3] = 0x2;
1156                 btdm8723.ps_tdma_byte[4] = 0x80;
1157         }
1158
1159         if (rtl8723e_dm_bt_is_coexist_state_changed(hw))
1160                 rtl8723e_dm_bt_set_bt_dm(hw, &btdm8723);
1161
1162 }
1163
1164 static void rtl8723e_dm_bt_2_ant_ftp_a2dp(struct ieee80211_hw *hw)
1165 {
1166         struct rtl_priv *rtlpriv = rtl_priv(hw);
1167         struct rtl_phy *rtlphy = &(rtlpriv->phy);
1168         struct btdm_8723 btdm8723;
1169
1170         u8 bt_rssi_state, bt_rssi_state1;
1171         u32 bt_tx_rx_cnt_lvl = 0;
1172
1173         rtl8723e_dm_bt_btdm_structure_reload(hw, &btdm8723);
1174
1175         btdm8723.rf_rx_lpf_shrink = true;
1176         btdm8723.low_penalty_rate_adaptive = true;
1177         btdm8723.reject_aggre_pkt = false;
1178
1179         bt_tx_rx_cnt_lvl = rtl8723e_dm_bt_bt_tx_rx_counter_level(hw);
1180
1181         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1182         "[BTCoex], BT TxRx Counters = %d\n", bt_tx_rx_cnt_lvl);
1183
1184         if (rtlphy->current_chan_bw == HT_CHANNEL_WIDTH_20_40) {
1185                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG, "HT40\n");
1186                 bt_rssi_state =
1187                   rtl8723e_dm_bt_check_coex_rssi_state(hw, 2, 37, 0);
1188
1189                 /* coex table */
1190                 btdm8723.val_0x6c0 = 0x55555555;
1191                 btdm8723.val_0x6c8 = 0xffff;
1192                 btdm8723.val_0x6cc = 0x3;
1193
1194                 /* sw mechanism */
1195                 btdm8723.agc_table_en = false;
1196                 btdm8723.adc_back_off_on = true;
1197                 btdm8723.sw_dac_swing_on = false;
1198
1199                 /* fw mechanism */
1200                 btdm8723.ps_tdma_on = true;
1201                 if ((bt_rssi_state == BT_RSSI_STATE_HIGH) ||
1202                         (bt_rssi_state == BT_RSSI_STATE_STAY_HIGH)) {
1203                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1204                                                 "Wifi rssi high\n");
1205                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1206                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1207                                 "[BTCoex], BT TxRx Counters >= 1400\n");
1208                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1209                                 btdm8723.ps_tdma_byte[1] = 0x5;
1210                                 btdm8723.ps_tdma_byte[2] = 0x5;
1211                                 btdm8723.ps_tdma_byte[3] = 0x81;
1212                                 btdm8723.ps_tdma_byte[4] = 0x80;
1213                         } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1214                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1215                                          "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1216                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1217                                 btdm8723.ps_tdma_byte[1] = 0xa;
1218                                 btdm8723.ps_tdma_byte[2] = 0xa;
1219                                 btdm8723.ps_tdma_byte[3] = 0x81;
1220                                 btdm8723.ps_tdma_byte[4] = 0x80;
1221                         } else {
1222                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1223                                          "[BTCoex], BT TxRx Counters < 1200\n");
1224                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1225                                 btdm8723.ps_tdma_byte[1] = 0xf;
1226                                 btdm8723.ps_tdma_byte[2] = 0xf;
1227                                 btdm8723.ps_tdma_byte[3] = 0x81;
1228                                 btdm8723.ps_tdma_byte[4] = 0x80;
1229                         }
1230                 } else {
1231                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1232                                  "Wifi rssi low\n");
1233                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1234                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1235                                          "[BTCoex], BT TxRx Counters >= 1400\n");
1236                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1237                                 btdm8723.ps_tdma_byte[1] = 0x5;
1238                                 btdm8723.ps_tdma_byte[2] = 0x5;
1239                                 btdm8723.ps_tdma_byte[3] = 0x0;
1240                                 btdm8723.ps_tdma_byte[4] = 0x80;
1241                         } else if (bt_tx_rx_cnt_lvl ==
1242                                 BT_TXRX_CNT_LEVEL_1) {
1243                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1244                                          "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1245                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1246                                 btdm8723.ps_tdma_byte[1] = 0xa;
1247                                 btdm8723.ps_tdma_byte[2] = 0xa;
1248                                 btdm8723.ps_tdma_byte[3] = 0x0;
1249                                 btdm8723.ps_tdma_byte[4] = 0x80;
1250                         } else {
1251                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1252                                          "[BTCoex], BT TxRx Counters < 1200\n");
1253                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1254                                 btdm8723.ps_tdma_byte[1] = 0xf;
1255                                 btdm8723.ps_tdma_byte[2] = 0xf;
1256                                 btdm8723.ps_tdma_byte[3] = 0x0;
1257                                 btdm8723.ps_tdma_byte[4] = 0x80;
1258                         }
1259                 }
1260         } else {
1261                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1262                          "HT20 or Legacy\n");
1263                 bt_rssi_state =
1264                   rtl8723e_dm_bt_check_coex_rssi_state(hw, 2, 47, 0);
1265                 bt_rssi_state1 =
1266                   rtl8723e_dm_bt_check_coex_rssi_state1(hw, 2, 27, 0);
1267
1268                 /* coex table */
1269                 btdm8723.val_0x6c0 = 0x55555555;
1270                 btdm8723.val_0x6c8 = 0xffff;
1271                 btdm8723.val_0x6cc = 0x3;
1272
1273                 /* sw mechanism */
1274                 if ((bt_rssi_state == BT_RSSI_STATE_HIGH) ||
1275                         (bt_rssi_state == BT_RSSI_STATE_STAY_HIGH)) {
1276                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1277                                  "Wifi rssi high\n");
1278                         btdm8723.agc_table_en = true;
1279                         btdm8723.adc_back_off_on = true;
1280                         btdm8723.sw_dac_swing_on = false;
1281                 } else {
1282                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1283                                  "Wifi rssi low\n");
1284                         btdm8723.agc_table_en = false;
1285                         btdm8723.adc_back_off_on = false;
1286                         btdm8723.sw_dac_swing_on = false;
1287                 }
1288
1289                 /* fw mechanism */
1290                 btdm8723.ps_tdma_on = true;
1291                 if ((bt_rssi_state1 == BT_RSSI_STATE_HIGH) ||
1292                         (bt_rssi_state1 == BT_RSSI_STATE_STAY_HIGH)) {
1293                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1294                                  "Wifi rssi-1 high\n");
1295                         /* only rssi high we need to do this, */
1296                         /* when rssi low, the value will modified by fw */
1297                         rtl_write_byte(rtlpriv, 0x883, 0x40);
1298                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1299                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1300                                          "[BTCoex], BT TxRx Counters >= 1400\n");
1301                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1302                                 btdm8723.ps_tdma_byte[1] = 0x5;
1303                                 btdm8723.ps_tdma_byte[2] = 0x5;
1304                                 btdm8723.ps_tdma_byte[3] = 0x81;
1305                                 btdm8723.ps_tdma_byte[4] = 0x80;
1306                         } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1307                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1308                                          "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1309                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1310                                 btdm8723.ps_tdma_byte[1] = 0xa;
1311                                 btdm8723.ps_tdma_byte[2] = 0xa;
1312                                 btdm8723.ps_tdma_byte[3] = 0x81;
1313                                 btdm8723.ps_tdma_byte[4] = 0x80;
1314                         } else {
1315                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1316                                          "[BTCoex], BT TxRx Counters < 1200\n");
1317                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1318                                 btdm8723.ps_tdma_byte[1] = 0xf;
1319                                 btdm8723.ps_tdma_byte[2] = 0xf;
1320                                 btdm8723.ps_tdma_byte[3] = 0x81;
1321                                 btdm8723.ps_tdma_byte[4] = 0x80;
1322                         }
1323                 } else {
1324                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1325                                  "Wifi rssi-1 low\n");
1326                         if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_2) {
1327                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1328                                          "[BTCoex], BT TxRx Counters >= 1400\n");
1329                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1330                                 btdm8723.ps_tdma_byte[1] = 0x5;
1331                                 btdm8723.ps_tdma_byte[2] = 0x5;
1332                                 btdm8723.ps_tdma_byte[3] = 0x0;
1333                                 btdm8723.ps_tdma_byte[4] = 0x80;
1334                         } else if (bt_tx_rx_cnt_lvl == BT_TXRX_CNT_LEVEL_1) {
1335                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1336                                          "[BTCoex], BT TxRx Counters >= 1200 && < 1400\n");
1337                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1338                                 btdm8723.ps_tdma_byte[1] = 0xa;
1339                                 btdm8723.ps_tdma_byte[2] = 0xa;
1340                                 btdm8723.ps_tdma_byte[3] = 0x0;
1341                                 btdm8723.ps_tdma_byte[4] = 0x80;
1342                         } else {
1343                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1344                                          "[BTCoex], BT TxRx Counters < 1200\n");
1345                                 btdm8723.ps_tdma_byte[0] = 0xa3;
1346                                 btdm8723.ps_tdma_byte[1] = 0xf;
1347                                 btdm8723.ps_tdma_byte[2] = 0xf;
1348                                 btdm8723.ps_tdma_byte[3] = 0x0;
1349                                 btdm8723.ps_tdma_byte[4] = 0x80;
1350                         }
1351                 }
1352         }
1353
1354         if (rtl8723e_dm_bt_need_to_dec_bt_pwr(hw))
1355                 btdm8723.dec_bt_pwr = true;
1356
1357         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1358                  "[BTCoex], BT btInqPageStartTime = 0x%x, btTxRxCntLvl = %d\n",
1359                  hal_coex_8723.bt_inq_page_start_time, bt_tx_rx_cnt_lvl);
1360
1361         if ((hal_coex_8723.bt_inq_page_start_time) ||
1362             (BT_TXRX_CNT_LEVEL_3 == bt_tx_rx_cnt_lvl)) {
1363                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1364                          "[BTCoex], Set BT inquiry / page scan 0x3a setting\n");
1365                 btdm8723.ps_tdma_on = true;
1366                 btdm8723.ps_tdma_byte[0] = 0xa3;
1367                 btdm8723.ps_tdma_byte[1] = 0x5;
1368                 btdm8723.ps_tdma_byte[2] = 0x5;
1369                 btdm8723.ps_tdma_byte[3] = 0x83;
1370                 btdm8723.ps_tdma_byte[4] = 0x80;
1371         }
1372
1373         if (rtl8723e_dm_bt_is_coexist_state_changed(hw))
1374                 rtl8723e_dm_bt_set_bt_dm(hw, &btdm8723);
1375
1376 }
1377
1378 static void rtl8723e_dm_bt_inq_page_monitor(struct ieee80211_hw *hw)
1379 {
1380         struct rtl_priv *rtlpriv = rtl_priv(hw);
1381         u32 cur_time;
1382
1383         cur_time = jiffies;
1384         if (hal_coex_8723.c2h_bt_inquiry_page) {
1385                 /* bt inquiry or page is started. */
1386                 if (hal_coex_8723.bt_inq_page_start_time == 0) {
1387                         rtlpriv->btcoexist.cstate  |=
1388                         BT_COEX_STATE_BT_INQ_PAGE;
1389                         hal_coex_8723.bt_inq_page_start_time = cur_time;
1390                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1391                                  "[BTCoex], BT Inquiry/page is started at time : 0x%x\n",
1392                                  hal_coex_8723.bt_inq_page_start_time);
1393                 }
1394         }
1395         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1396                  "[BTCoex], BT Inquiry/page started time : 0x%x, cur_time : 0x%x\n",
1397                  hal_coex_8723.bt_inq_page_start_time, cur_time);
1398
1399         if (hal_coex_8723.bt_inq_page_start_time) {
1400                 if ((((long)cur_time -
1401                         (long)hal_coex_8723.bt_inq_page_start_time) / HZ)
1402                         >= 10) {
1403                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1404                                 "[BTCoex], BT Inquiry/page >= 10sec!!!");
1405                         hal_coex_8723.bt_inq_page_start_time = 0;
1406                         rtlpriv->btcoexist.cstate &=
1407                                 ~BT_COEX_STATE_BT_INQ_PAGE;
1408                 }
1409         }
1410 }
1411
1412 static void rtl8723e_dm_bt_reset_action_profile_state(struct ieee80211_hw *hw)
1413 {
1414         struct rtl_priv *rtlpriv = rtl_priv(hw);
1415
1416         rtlpriv->btcoexist.cstate &= ~
1417                 (BT_COEX_STATE_PROFILE_HID | BT_COEX_STATE_PROFILE_A2DP|
1418                 BT_COEX_STATE_PROFILE_PAN | BT_COEX_STATE_PROFILE_SCO);
1419
1420         rtlpriv->btcoexist.cstate &= ~
1421                 (BT_COEX_STATE_BTINFO_COMMON |
1422                 BT_COEX_STATE_BTINFO_B_HID_SCOESCO|
1423                 BT_COEX_STATE_BTINFO_B_FTP_A2DP);
1424 }
1425
1426 static void _rtl8723e_dm_bt_coexist_2_ant(struct ieee80211_hw *hw)
1427 {
1428         struct rtl_priv *rtlpriv = rtl_priv(hw);
1429         u8 bt_retry_cnt;
1430         u8 bt_info_original;
1431         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1432                 "[BTCoex] Get bt info by fw!!\n");
1433
1434         _rtl8723_dm_bt_check_wifi_state(hw);
1435
1436         if (hal_coex_8723.c2h_bt_info_req_sent) {
1437                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1438                                 "[BTCoex] c2h for bt_info not rcvd yet!!\n");
1439         }
1440
1441         bt_retry_cnt = hal_coex_8723.bt_retry_cnt;
1442         bt_info_original = hal_coex_8723.c2h_bt_info_original;
1443
1444         /* when bt inquiry or page scan, we have to set h2c 0x25 */
1445         /* ignore wlanact for continuous 4x2secs */
1446         rtl8723e_dm_bt_inq_page_monitor(hw);
1447         rtl8723e_dm_bt_reset_action_profile_state(hw);
1448
1449         if (rtl8723e_dm_bt_is_2_ant_common_action(hw)) {
1450                 rtlpriv->btcoexist.bt_profile_case = BT_COEX_MECH_COMMON;
1451                 rtlpriv->btcoexist.bt_profile_action = BT_COEX_MECH_COMMON;
1452                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1453                 "Action 2-Ant common.\n");
1454         } else {
1455                 if ((bt_info_original & BTINFO_B_HID) ||
1456                         (bt_info_original & BTINFO_B_SCO_BUSY) ||
1457                         (bt_info_original & BTINFO_B_SCO_ESCO)) {
1458                                 rtlpriv->btcoexist.cstate |=
1459                                         BT_COEX_STATE_BTINFO_B_HID_SCOESCO;
1460                                 rtlpriv->btcoexist.bt_profile_case =
1461                                         BT_COEX_MECH_HID_SCO_ESCO;
1462                                 rtlpriv->btcoexist.bt_profile_action =
1463                                         BT_COEX_MECH_HID_SCO_ESCO;
1464                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1465                                          "[BTCoex], BTInfo: bHid|bSCOBusy|bSCOeSCO\n");
1466                                 rtl8723e_dm_bt_2_ant_hid_sco_esco(hw);
1467                 } else if ((bt_info_original & BTINFO_B_FTP) ||
1468                                 (bt_info_original & BTINFO_B_A2DP)) {
1469                                 rtlpriv->btcoexist.cstate |=
1470                                         BT_COEX_STATE_BTINFO_B_FTP_A2DP;
1471                                 rtlpriv->btcoexist.bt_profile_case =
1472                                         BT_COEX_MECH_FTP_A2DP;
1473                                 rtlpriv->btcoexist.bt_profile_action =
1474                                         BT_COEX_MECH_FTP_A2DP;
1475                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1476                                          "BTInfo: bFTP|bA2DP\n");
1477                                 rtl8723e_dm_bt_2_ant_ftp_a2dp(hw);
1478                 } else {
1479                                 rtlpriv->btcoexist.cstate |=
1480                                         BT_COEX_STATE_BTINFO_B_HID_SCOESCO;
1481                                 rtlpriv->btcoexist.bt_profile_case =
1482                                         BT_COEX_MECH_NONE;
1483                                 rtlpriv->btcoexist.bt_profile_action =
1484                                         BT_COEX_MECH_NONE;
1485                                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1486                                          "[BTCoex], BTInfo: undefined case!!!!\n");
1487                                 rtl8723e_dm_bt_2_ant_hid_sco_esco(hw);
1488                 }
1489         }
1490 }
1491
1492 static void _rtl8723e_dm_bt_coexist_1_ant(struct ieee80211_hw *hw)
1493 {
1494         return;
1495 }
1496
1497 void rtl8723e_dm_bt_hw_coex_all_off_8723a(struct ieee80211_hw *hw)
1498 {
1499         rtl8723e_dm_bt_set_coex_table(hw, 0x5a5aaaaa, 0xcc, 0x3);
1500         rtl8723e_dm_bt_set_hw_pta_mode(hw, true);
1501 }
1502
1503 void rtl8723e_dm_bt_fw_coex_all_off_8723a(struct ieee80211_hw *hw)
1504 {
1505         rtl8723e_dm_bt_set_fw_ignore_wlan_act(hw, false);
1506         rtl8723e_dm_bt_set_fw_3a(hw, 0x0, 0x0, 0x0, 0x8, 0x0);
1507         rtl8723e_dm_bt_set_fw_2_ant_hid(hw, false, false);
1508         rtl8723e_dm_bt_set_fw_tra_tdma_ctrl(hw, false, TDMA_2ANT,
1509                                             TDMA_NAV_OFF);
1510         rtl8723e_dm_bt_set_fw_tdma_ctrl(hw, false, TDMA_2ANT, TDMA_NAV_OFF,
1511                                         TDMA_DAC_SWING_OFF);
1512         rtl8723e_dm_bt_set_fw_dac_swing_level(hw, 0);
1513         rtl8723e_dm_bt_set_fw_bt_hid_info(hw, false);
1514         rtl8723e_dm_bt_set_fw_bt_retry_index(hw, 2);
1515         rtl8723e_dm_bt_set_fw_wlan_act(hw, 0x10, 0x10);
1516         rtl8723e_dm_bt_set_fw_dec_bt_pwr(hw, false);
1517 }
1518
1519 void rtl8723e_dm_bt_sw_coex_all_off_8723a(struct ieee80211_hw *hw)
1520 {
1521         rtl8723e_dm_bt_agc_table(hw, BT_AGCTABLE_OFF);
1522         rtl8723e_dm_bt_bb_back_off_level(hw, BT_BB_BACKOFF_OFF);
1523         rtl8723e_dm_bt_reject_ap_aggregated_packet(hw, false);
1524
1525         dm_bt_set_sw_penalty_tx_rate_adapt(hw, BT_TX_RATE_ADAPTIVE_NORMAL);
1526         rtl8723e_dm_bt_set_sw_rf_rx_lpf_corner(hw, BT_RF_RX_LPF_CORNER_RESUME);
1527         rtl8723e_dm_bt_set_sw_full_time_dac_swing(hw, false, 0xc0);
1528 }
1529
1530 static void rtl8723e_dm_bt_query_bt_information(struct ieee80211_hw *hw)
1531 {
1532         struct rtl_priv *rtlpriv = rtl_priv(hw);
1533         u8 h2c_parameter[1] = {0};
1534
1535         hal_coex_8723.c2h_bt_info_req_sent = true;
1536
1537         h2c_parameter[0] |=  BIT(0);
1538
1539         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1540                 "Query Bt information, write 0x38=0x%x\n", h2c_parameter[0]);
1541
1542         rtl8723e_fill_h2c_cmd(hw, 0x38, 1, h2c_parameter);
1543 }
1544
1545 static void rtl8723e_dm_bt_bt_hw_counters_monitor(struct ieee80211_hw *hw)
1546 {
1547         struct rtl_priv *rtlpriv = rtl_priv(hw);
1548         u32 reg_hp_tx_rx, reg_lp_tx_rx, u32_tmp;
1549         u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0;
1550
1551         reg_hp_tx_rx = REG_HIGH_PRIORITY_TXRX;
1552         reg_lp_tx_rx = REG_LOW_PRIORITY_TXRX;
1553
1554         u32_tmp = rtl_read_dword(rtlpriv, reg_hp_tx_rx);
1555         reg_hp_tx = u32_tmp & MASKLWORD;
1556         reg_hp_rx = (u32_tmp & MASKHWORD)>>16;
1557
1558         u32_tmp = rtl_read_dword(rtlpriv, reg_lp_tx_rx);
1559         reg_lp_tx = u32_tmp & MASKLWORD;
1560         reg_lp_rx = (u32_tmp & MASKHWORD)>>16;
1561
1562         if (rtlpriv->btcoexist.lps_counter > 1) {
1563                 reg_hp_tx %= rtlpriv->btcoexist.lps_counter;
1564                 reg_hp_rx %= rtlpriv->btcoexist.lps_counter;
1565                 reg_lp_tx %= rtlpriv->btcoexist.lps_counter;
1566                 reg_lp_rx %= rtlpriv->btcoexist.lps_counter;
1567         }
1568
1569         hal_coex_8723.high_priority_tx = reg_hp_tx;
1570         hal_coex_8723.high_priority_rx = reg_hp_rx;
1571         hal_coex_8723.low_priority_tx = reg_lp_tx;
1572         hal_coex_8723.low_priority_rx = reg_lp_rx;
1573
1574         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1575                 "High Priority Tx/Rx (reg 0x%x)=%x(%d)/%x(%d)\n",
1576                 reg_hp_tx_rx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx);
1577         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1578                 "Low Priority Tx/Rx (reg 0x%x)=%x(%d)/%x(%d)\n",
1579                 reg_lp_tx_rx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx);
1580         rtlpriv->btcoexist.lps_counter = 0;
1581         /* rtl_write_byte(rtlpriv, 0x76e, 0xc); */
1582 }
1583
1584 static void rtl8723e_dm_bt_bt_enable_disable_check(struct ieee80211_hw *hw)
1585 {
1586         struct rtl_priv *rtlpriv = rtl_priv(hw);
1587         bool bt_alife = true;
1588
1589         if (hal_coex_8723.high_priority_tx == 0 &&
1590             hal_coex_8723.high_priority_rx == 0 &&
1591             hal_coex_8723.low_priority_tx == 0 &&
1592             hal_coex_8723.low_priority_rx == 0) {
1593                 bt_alife = false;
1594         }
1595         if (hal_coex_8723.high_priority_tx == 0xeaea &&
1596             hal_coex_8723.high_priority_rx == 0xeaea &&
1597             hal_coex_8723.low_priority_tx == 0xeaea &&
1598             hal_coex_8723.low_priority_rx == 0xeaea) {
1599                 bt_alife = false;
1600         }
1601         if (hal_coex_8723.high_priority_tx == 0xffff &&
1602             hal_coex_8723.high_priority_rx == 0xffff &&
1603             hal_coex_8723.low_priority_tx == 0xffff &&
1604             hal_coex_8723.low_priority_rx == 0xffff) {
1605                 bt_alife = false;
1606         }
1607         if (bt_alife) {
1608                 rtlpriv->btcoexist.bt_active_zero_cnt = 0;
1609                 rtlpriv->btcoexist.cur_bt_disabled = false;
1610                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1611                          "8723A BT is enabled !!\n");
1612         } else {
1613                 rtlpriv->btcoexist.bt_active_zero_cnt++;
1614                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1615                          "8723A bt all counters=0, %d times!!\n",
1616                          rtlpriv->btcoexist.bt_active_zero_cnt);
1617                 if (rtlpriv->btcoexist.bt_active_zero_cnt >= 2) {
1618                         rtlpriv->btcoexist.cur_bt_disabled = true;
1619                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1620                                  "8723A BT is disabled !!\n");
1621                 }
1622         }
1623         if (rtlpriv->btcoexist.pre_bt_disabled !=
1624                 rtlpriv->btcoexist.cur_bt_disabled) {
1625                 RT_TRACE(rtlpriv, COMP_BT_COEXIST,
1626                          DBG_TRACE, "8723A BT is from %s to %s!!\n",
1627                          (rtlpriv->btcoexist.pre_bt_disabled ?
1628                                 "disabled" : "enabled"),
1629                          (rtlpriv->btcoexist.cur_bt_disabled ?
1630                                 "disabled" : "enabled"));
1631                 rtlpriv->btcoexist.pre_bt_disabled
1632                         = rtlpriv->btcoexist.cur_bt_disabled;
1633         }
1634 }
1635
1636
1637 void rtl8723e_dm_bt_coexist_8723(struct ieee80211_hw *hw)
1638 {
1639         struct rtl_priv *rtlpriv = rtl_priv(hw);
1640
1641         rtl8723e_dm_bt_query_bt_information(hw);
1642         rtl8723e_dm_bt_bt_hw_counters_monitor(hw);
1643         rtl8723e_dm_bt_bt_enable_disable_check(hw);
1644
1645         if (rtlpriv->btcoexist.bt_ant_num == ANT_X2) {
1646                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1647                         "[BTCoex], 2 Ant mechanism\n");
1648                 _rtl8723e_dm_bt_coexist_2_ant(hw);
1649         } else {
1650                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1651                         "[BTCoex], 1 Ant mechanism\n");
1652                 _rtl8723e_dm_bt_coexist_1_ant(hw);
1653         }
1654
1655         if (!rtl8723e_dm_bt_is_same_coexist_state(hw)) {
1656                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1657                          "[BTCoex], Coexist State[bitMap] change from 0x%x%8x to 0x%x%8x\n",
1658                          rtlpriv->btcoexist.previous_state_h,
1659                          rtlpriv->btcoexist.previous_state,
1660                          rtlpriv->btcoexist.cstate_h,
1661                          rtlpriv->btcoexist.cstate);
1662                 rtlpriv->btcoexist.previous_state
1663                         = rtlpriv->btcoexist.cstate;
1664                 rtlpriv->btcoexist.previous_state_h
1665                         = rtlpriv->btcoexist.cstate_h;
1666         }
1667 }
1668
1669 static void rtl8723e_dm_bt_parse_bt_info(struct ieee80211_hw *hw,
1670                                          u8 *tmp_buf, u8 len)
1671 {
1672         struct rtl_priv *rtlpriv = rtl_priv(hw);
1673         u8 bt_info;
1674         u8 i;
1675
1676         hal_coex_8723.c2h_bt_info_req_sent = false;
1677         hal_coex_8723.bt_retry_cnt = 0;
1678         for (i = 0; i < len; i++) {
1679                 if (i == 0)
1680                         hal_coex_8723.c2h_bt_info_original = tmp_buf[i];
1681                 else if (i == 1)
1682                         hal_coex_8723.bt_retry_cnt = tmp_buf[i];
1683                 if (i == len-1)
1684                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1685                                  "0x%2x]", tmp_buf[i]);
1686                 else
1687                         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_TRACE,
1688                                  "0x%2x, ", tmp_buf[i]);
1689
1690         }
1691         RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1692                 "BT info bt_info (Data)= 0x%x\n",
1693                         hal_coex_8723.c2h_bt_info_original);
1694         bt_info = hal_coex_8723.c2h_bt_info_original;
1695
1696         if (bt_info & BIT(2))
1697                 hal_coex_8723.c2h_bt_inquiry_page = true;
1698         else
1699                 hal_coex_8723.c2h_bt_inquiry_page = false;
1700
1701
1702         if (bt_info & BTINFO_B_CONNECTION) {
1703                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1704                         "[BTC2H], BTInfo: bConnect=true\n");
1705                 rtlpriv->btcoexist.bt_busy = true;
1706                 rtlpriv->btcoexist.cstate &= ~BT_COEX_STATE_BT_IDLE;
1707         } else {
1708                 RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_DMESG,
1709                         "[BTC2H], BTInfo: bConnect=false\n");
1710                 rtlpriv->btcoexist.bt_busy = false;
1711                 rtlpriv->btcoexist.cstate |= BT_COEX_STATE_BT_IDLE;
1712         }
1713 }
1714 void rtl_8723e_c2h_command_handle(struct ieee80211_hw *hw)
1715 {
1716         struct rtl_priv *rtlpriv = rtl_priv(hw);
1717         struct c2h_evt_hdr c2h_event;
1718         u8 *ptmp_buf = NULL;
1719         u8 index = 0;
1720         u8 u1b_tmp = 0;
1721         memset(&c2h_event, 0, sizeof(c2h_event));
1722         u1b_tmp = rtl_read_byte(rtlpriv, REG_C2HEVT_MSG_NORMAL);
1723         RT_TRACE(rtlpriv, COMP_FW, DBG_DMESG,
1724                 "&&&&&&: REG_C2HEVT_MSG_NORMAL is 0x%x\n", u1b_tmp);
1725         c2h_event.cmd_id = u1b_tmp & 0xF;
1726         c2h_event.cmd_len = (u1b_tmp & 0xF0) >> 4;
1727         c2h_event.cmd_seq = rtl_read_byte(rtlpriv, REG_C2HEVT_MSG_NORMAL + 1);
1728         RT_TRACE(rtlpriv, COMP_FW, DBG_DMESG,
1729                  "cmd_id: %d, cmd_len: %d, cmd_seq: %d\n",
1730                  c2h_event.cmd_id , c2h_event.cmd_len, c2h_event.cmd_seq);
1731         u1b_tmp = rtl_read_byte(rtlpriv, 0x01AF);
1732         if (u1b_tmp == C2H_EVT_HOST_CLOSE) {
1733                 return;
1734         } else if (u1b_tmp != C2H_EVT_FW_CLOSE) {
1735                 rtl_write_byte(rtlpriv, 0x1AF, 0x00);
1736                 return;
1737         }
1738         ptmp_buf = kzalloc(c2h_event.cmd_len, GFP_KERNEL);
1739         if (ptmp_buf == NULL) {
1740                 RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE,
1741                          "malloc cmd buf failed\n");
1742                 return;
1743         }
1744
1745         /* Read the content */
1746         for (index = 0; index < c2h_event.cmd_len; index++)
1747                 ptmp_buf[index] = rtl_read_byte(rtlpriv,
1748                                         REG_C2HEVT_MSG_NORMAL + 2 + index);
1749
1750
1751         switch (c2h_event.cmd_id) {
1752         case C2H_BT_RSSI:
1753                         break;
1754
1755         case C2H_BT_OP_MODE:
1756                         break;
1757
1758         case BT_INFO:
1759                 RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE,
1760                         "BT info Byte[0] (ID) is 0x%x\n",
1761                         c2h_event.cmd_id);
1762                 RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE,
1763                         "BT info Byte[1] (Seq) is 0x%x\n",
1764                         c2h_event.cmd_seq);
1765                 RT_TRACE(rtlpriv, COMP_FW, DBG_TRACE,
1766                         "BT info Byte[2] (Data)= 0x%x\n", ptmp_buf[0]);
1767
1768                 rtl8723e_dm_bt_parse_bt_info(hw, ptmp_buf, c2h_event.cmd_len);
1769
1770                 if (rtlpriv->cfg->ops->get_btc_status())
1771                         rtlpriv->btcoexist.btc_ops->btc_periodical(rtlpriv);
1772
1773                 break;
1774         default:
1775                 break;
1776         }
1777         kfree(ptmp_buf);
1778
1779         rtl_write_byte(rtlpriv, 0x01AF, C2H_EVT_HOST_CLOSE);
1780 }