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