| // SPDX-License-Identifier: GPL-2.0 |
| /****************************************************************************** |
| * |
| * Copyright(c) 2016 Realtek Corporation. |
| * |
| * Contact Information: |
| * wlanfae <wlanfae@realtek.com> |
| * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, |
| * Hsinchu 300, Taiwan. |
| * |
| * Larry Finger <Larry.Finger@lwfinger.net> |
| * |
| *****************************************************************************/ |
| /* ************************************************************ |
| * Description: |
| * |
| * This file is for RTL8822B Co-exist mechanism |
| * |
| * History |
| * 2012/11/15 Cosa first check in. |
| * |
| * *************************************************************/ |
| |
| /* ************************************************************ |
| * include files |
| * *************************************************************/ |
| #include "halbt_precomp.h" |
| |
| /* ************************************************************ |
| * Global variables, these are static variables |
| * *************************************************************/ |
| static struct coex_dm_8822b_2ant glcoex_dm_8822b_2ant; |
| static struct coex_dm_8822b_2ant *coex_dm = &glcoex_dm_8822b_2ant; |
| static struct coex_sta_8822b_2ant glcoex_sta_8822b_2ant; |
| static struct coex_sta_8822b_2ant *coex_sta = &glcoex_sta_8822b_2ant; |
| static struct psdscan_sta_8822b_2ant gl_psd_scan_8822b_2ant; |
| static struct psdscan_sta_8822b_2ant *psd_scan = &gl_psd_scan_8822b_2ant; |
| static struct rfe_type_8822b_2ant gl_rfe_type_8822b_2ant; |
| static struct rfe_type_8822b_2ant *rfe_type = &gl_rfe_type_8822b_2ant; |
| |
| static const char *const glbt_info_src_8822b_2ant[] = { |
| "BT Info[wifi fw]", "BT Info[bt rsp]", "BT Info[bt auto report]", |
| }; |
| |
| static u32 glcoex_ver_date_8822b_2ant = 20170327; |
| static u32 glcoex_ver_8822b_2ant = 0x44; |
| static u32 glcoex_ver_btdesired_8822b_2ant = 0x42; |
| |
| /* ************************************************************ |
| * local function proto type if needed |
| * ************************************************************ |
| * ************************************************************ |
| * local function start with halbtc8822b2ant_ |
| * *************************************************************/ |
| static u8 halbtc8822b2ant_bt_rssi_state(struct btc_coexist *btcoexist, |
| u8 *ppre_bt_rssi_state, u8 level_num, |
| u8 rssi_thresh, u8 rssi_thresh1) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| s32 bt_rssi = 0; |
| u8 bt_rssi_state = *ppre_bt_rssi_state; |
| |
| bt_rssi = coex_sta->bt_rssi; |
| |
| if (level_num == 2) { |
| if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || |
| (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { |
| if (bt_rssi >= |
| (rssi_thresh + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| bt_rssi_state = BTC_RSSI_STATE_HIGH; |
| else |
| bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; |
| } else { |
| if (bt_rssi < rssi_thresh) |
| bt_rssi_state = BTC_RSSI_STATE_LOW; |
| else |
| bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; |
| } |
| } else if (level_num == 3) { |
| if (rssi_thresh > rssi_thresh1) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BT Rssi thresh error!!\n"); |
| return *ppre_bt_rssi_state; |
| } |
| |
| if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || |
| (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { |
| if (bt_rssi >= |
| (rssi_thresh + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| bt_rssi_state = BTC_RSSI_STATE_MEDIUM; |
| else |
| bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; |
| } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || |
| (*ppre_bt_rssi_state == |
| BTC_RSSI_STATE_STAY_MEDIUM)) { |
| if (bt_rssi >= (rssi_thresh1 + |
| BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| bt_rssi_state = BTC_RSSI_STATE_HIGH; |
| else if (bt_rssi < rssi_thresh) |
| bt_rssi_state = BTC_RSSI_STATE_LOW; |
| else |
| bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; |
| } else { |
| if (bt_rssi < rssi_thresh1) |
| bt_rssi_state = BTC_RSSI_STATE_MEDIUM; |
| else |
| bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; |
| } |
| } |
| |
| *ppre_bt_rssi_state = bt_rssi_state; |
| |
| return bt_rssi_state; |
| } |
| |
| static u8 halbtc8822b2ant_wifi_rssi_state(struct btc_coexist *btcoexist, |
| u8 *pprewifi_rssi_state, u8 level_num, |
| u8 rssi_thresh, u8 rssi_thresh1) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| s32 wifi_rssi = 0; |
| u8 wifi_rssi_state = *pprewifi_rssi_state; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); |
| |
| if (level_num == 2) { |
| if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || |
| (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { |
| if (wifi_rssi >= |
| (rssi_thresh + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| wifi_rssi_state = BTC_RSSI_STATE_HIGH; |
| else |
| wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; |
| } else { |
| if (wifi_rssi < rssi_thresh) |
| wifi_rssi_state = BTC_RSSI_STATE_LOW; |
| else |
| wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; |
| } |
| } else if (level_num == 3) { |
| if (rssi_thresh > rssi_thresh1) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], wifi RSSI thresh error!!\n"); |
| return *pprewifi_rssi_state; |
| } |
| |
| if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || |
| (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { |
| if (wifi_rssi >= |
| (rssi_thresh + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; |
| else |
| wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; |
| } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || |
| (*pprewifi_rssi_state == |
| BTC_RSSI_STATE_STAY_MEDIUM)) { |
| if (wifi_rssi >= (rssi_thresh1 + |
| BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) |
| wifi_rssi_state = BTC_RSSI_STATE_HIGH; |
| else if (wifi_rssi < rssi_thresh) |
| wifi_rssi_state = BTC_RSSI_STATE_LOW; |
| else |
| wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; |
| } else { |
| if (wifi_rssi < rssi_thresh1) |
| wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; |
| else |
| wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; |
| } |
| } |
| |
| *pprewifi_rssi_state = wifi_rssi_state; |
| |
| return wifi_rssi_state; |
| } |
| |
| static void halbtc8822b2ant_coex_switch_threshold(struct btc_coexist *btcoexist, |
| u8 isolation_measuared) |
| { |
| s8 interference_wl_tx = 0, interference_bt_tx = 0; |
| |
| interference_wl_tx = |
| BT_8822B_2ANT_WIFI_MAX_TX_POWER - isolation_measuared; |
| interference_bt_tx = |
| BT_8822B_2ANT_BT_MAX_TX_POWER - isolation_measuared; |
| |
| coex_sta->wifi_coex_thres = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; |
| coex_sta->wifi_coex_thres2 = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; |
| |
| coex_sta->bt_coex_thres = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1; |
| coex_sta->bt_coex_thres2 = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES2; |
| } |
| |
| static void halbtc8822b2ant_query_bt_info(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| u8 h2c_parameter[1] = {0}; |
| |
| if (coex_sta->bt_disabled) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], No query BT info because BT is disabled!\n"); |
| return; |
| } |
| |
| h2c_parameter[0] |= BIT(0); /* trigger */ |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); |
| } |
| |
| static void halbtc8822b2ant_monitor_bt_ctr(struct btc_coexist *btcoexist) |
| { |
| u32 reg_hp_txrx, reg_lp_txrx, u32tmp; |
| u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; |
| static u8 num_of_bt_counter_chk, cnt_slave, cnt_autoslot_hang; |
| |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| reg_hp_txrx = 0x770; |
| reg_lp_txrx = 0x774; |
| |
| u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); |
| reg_hp_tx = u32tmp & MASKLWORD; |
| reg_hp_rx = (u32tmp & MASKHWORD) >> 16; |
| |
| u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); |
| reg_lp_tx = u32tmp & MASKLWORD; |
| reg_lp_rx = (u32tmp & MASKHWORD) >> 16; |
| |
| coex_sta->high_priority_tx = reg_hp_tx; |
| coex_sta->high_priority_rx = reg_hp_rx; |
| coex_sta->low_priority_tx = reg_lp_tx; |
| coex_sta->low_priority_rx = reg_lp_rx; |
| |
| /* reset counter */ |
| btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); |
| |
| if ((coex_sta->low_priority_tx > 1050) && |
| (!coex_sta->c2h_bt_inquiry_page)) |
| coex_sta->pop_event_cnt++; |
| |
| if ((coex_sta->low_priority_rx >= 950) && |
| (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && |
| (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && |
| (coex_sta->bt_link_exist)) { |
| if (cnt_slave >= 2) { |
| bt_link_info->slave_role = true; |
| cnt_slave = 2; |
| } else { |
| cnt_slave++; |
| } |
| } else { |
| if (cnt_slave == 0) { |
| bt_link_info->slave_role = false; |
| cnt_slave = 0; |
| } else { |
| cnt_slave--; |
| } |
| } |
| |
| if (coex_sta->is_tdma_btautoslot) { |
| if ((coex_sta->low_priority_tx >= 1300) && |
| (coex_sta->low_priority_rx <= 150)) { |
| if (cnt_autoslot_hang >= 2) { |
| coex_sta->is_tdma_btautoslot_hang = true; |
| cnt_autoslot_hang = 2; |
| } else { |
| cnt_autoslot_hang++; |
| } |
| } else { |
| if (cnt_autoslot_hang == 0) { |
| coex_sta->is_tdma_btautoslot_hang = false; |
| cnt_autoslot_hang = 0; |
| } else { |
| cnt_autoslot_hang--; |
| } |
| } |
| } |
| |
| if (coex_sta->sco_exist) { |
| if ((coex_sta->high_priority_tx >= 400) && |
| (coex_sta->high_priority_rx >= 400)) |
| coex_sta->is_esco_mode = false; |
| else |
| coex_sta->is_esco_mode = true; |
| } |
| |
| if (bt_link_info->hid_only) { |
| if (coex_sta->low_priority_rx > 50) |
| coex_sta->is_hid_low_pri_tx_overhead = true; |
| else |
| coex_sta->is_hid_low_pri_tx_overhead = false; |
| } |
| |
| if ((coex_sta->high_priority_tx == 0) && |
| (coex_sta->high_priority_rx == 0) && |
| (coex_sta->low_priority_tx == 0) && |
| (coex_sta->low_priority_rx == 0)) { |
| num_of_bt_counter_chk++; |
| if (num_of_bt_counter_chk >= 3) { |
| halbtc8822b2ant_query_bt_info(btcoexist); |
| num_of_bt_counter_chk = 0; |
| } |
| } |
| } |
| |
| static void halbtc8822b2ant_monitor_wifi_ctr(struct btc_coexist *btcoexist) |
| { |
| s32 wifi_rssi = 0; |
| bool wifi_busy = false, wifi_under_b_mode = false, wifi_scan = false; |
| bool bt_idle = false; |
| static u8 cck_lock_counter, wl_noisy_count0, wl_noisy_count1 = 3, |
| wl_noisy_count2; |
| u32 total_cnt, cck_cnt; |
| u32 cnt_crcok = 0, cnt_crcerr = 0; |
| static u8 cnt; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, |
| &wifi_under_b_mode); |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); |
| |
| coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_OK_CCK"); |
| coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_OK_LEGACY"); |
| coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_OK_HT"); |
| coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_OK_VHT"); |
| |
| coex_sta->crc_err_cck = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_ERROR_CCK"); |
| coex_sta->crc_err_11g = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_ERROR_LEGACY"); |
| coex_sta->crc_err_11n = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_ERROR_HT"); |
| coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_phy_counter( |
| btcoexist, "PHYDM_INFO_CRC32_ERROR_VHT"); |
| |
| cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + |
| coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; |
| |
| cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + |
| coex_sta->crc_err_11n + coex_sta->crc_err_11n_vht; |
| |
| if ((wifi_busy) && (cnt_crcerr != 0)) { |
| coex_sta->now_crc_ratio = cnt_crcok / cnt_crcerr; |
| |
| if (cnt == 0) |
| coex_sta->acc_crc_ratio = coex_sta->now_crc_ratio; |
| else |
| coex_sta->acc_crc_ratio = |
| (coex_sta->acc_crc_ratio * 7 + |
| coex_sta->now_crc_ratio * 3) / |
| 10; |
| |
| if (cnt >= 10) |
| cnt = 0; |
| else |
| cnt++; |
| } |
| |
| cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; |
| |
| if ((coex_dm->bt_status == |
| BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE) || |
| (coex_dm->bt_status == BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE) || |
| (coex_sta->bt_disabled)) |
| bt_idle = true; |
| |
| if (cck_cnt > 250) { |
| if (wl_noisy_count2 < 3) |
| wl_noisy_count2++; |
| |
| if (wl_noisy_count2 == 3) { |
| wl_noisy_count0 = 0; |
| wl_noisy_count1 = 0; |
| } |
| |
| } else if (cck_cnt < 50) { |
| if (wl_noisy_count0 < 3) |
| wl_noisy_count0++; |
| |
| if (wl_noisy_count0 == 3) { |
| wl_noisy_count1 = 0; |
| wl_noisy_count2 = 0; |
| } |
| |
| } else { |
| if (wl_noisy_count1 < 3) |
| wl_noisy_count1++; |
| |
| if (wl_noisy_count1 == 3) { |
| wl_noisy_count0 = 0; |
| wl_noisy_count2 = 0; |
| } |
| } |
| |
| if (wl_noisy_count2 == 3) |
| coex_sta->wl_noisy_level = 2; |
| else if (wl_noisy_count1 == 3) |
| coex_sta->wl_noisy_level = 1; |
| else |
| coex_sta->wl_noisy_level = 0; |
| |
| if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { |
| total_cnt = cnt_crcok; |
| |
| if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || |
| (coex_dm->bt_status == |
| BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) || |
| (coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { |
| if (coex_sta->crc_ok_cck > |
| (total_cnt - coex_sta->crc_ok_cck)) { |
| if (cck_lock_counter < 3) |
| cck_lock_counter++; |
| } else { |
| if (cck_lock_counter > 0) |
| cck_lock_counter--; |
| } |
| |
| } else { |
| if (cck_lock_counter > 0) |
| cck_lock_counter--; |
| } |
| } else { |
| if (cck_lock_counter > 0) |
| cck_lock_counter--; |
| } |
| |
| if (!coex_sta->pre_ccklock) { |
| if (cck_lock_counter >= 3) |
| coex_sta->cck_lock = true; |
| else |
| coex_sta->cck_lock = false; |
| } else { |
| if (cck_lock_counter == 0) |
| coex_sta->cck_lock = false; |
| else |
| coex_sta->cck_lock = true; |
| } |
| |
| if (coex_sta->cck_lock) |
| coex_sta->cck_ever_lock = true; |
| |
| coex_sta->pre_ccklock = coex_sta->cck_lock; |
| } |
| |
| static bool |
| halbtc8822b2ant_is_wifibt_status_changed(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static bool pre_wifi_busy, pre_under_4way, pre_bt_hs_on, pre_bt_off, |
| pre_bt_slave, pre_hid_low_pri_tx_overhead, pre_wifi_under_lps, |
| pre_bt_setup_link; |
| static u8 pre_hid_busy_num, pre_wl_noisy_level; |
| bool wifi_busy = false, under_4way = false, bt_hs_on = false; |
| bool wifi_connected = false; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, |
| &wifi_connected); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, |
| &under_4way); |
| |
| if (coex_sta->bt_disabled != pre_bt_off) { |
| pre_bt_off = coex_sta->bt_disabled; |
| |
| if (coex_sta->bt_disabled) |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BT is disabled !!\n"); |
| else |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BT is enabled !!\n"); |
| |
| coex_sta->bt_coex_supported_feature = 0; |
| coex_sta->bt_coex_supported_version = 0; |
| coex_sta->bt_ble_scan_type = 0; |
| coex_sta->bt_ble_scan_para[0] = 0; |
| coex_sta->bt_ble_scan_para[1] = 0; |
| coex_sta->bt_ble_scan_para[2] = 0; |
| coex_sta->bt_reg_vendor_ac = 0xffff; |
| coex_sta->bt_reg_vendor_ae = 0xffff; |
| return true; |
| } |
| |
| if (wifi_connected) { |
| if (wifi_busy != pre_wifi_busy) { |
| pre_wifi_busy = wifi_busy; |
| return true; |
| } |
| if (under_4way != pre_under_4way) { |
| pre_under_4way = under_4way; |
| return true; |
| } |
| if (bt_hs_on != pre_bt_hs_on) { |
| pre_bt_hs_on = bt_hs_on; |
| return true; |
| } |
| if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { |
| pre_wl_noisy_level = coex_sta->wl_noisy_level; |
| return true; |
| } |
| if (coex_sta->under_lps != pre_wifi_under_lps) { |
| pre_wifi_under_lps = coex_sta->under_lps; |
| if (coex_sta->under_lps) |
| return true; |
| } |
| } |
| |
| if (!coex_sta->bt_disabled) { |
| if (coex_sta->hid_busy_num != pre_hid_busy_num) { |
| pre_hid_busy_num = coex_sta->hid_busy_num; |
| return true; |
| } |
| |
| if (bt_link_info->slave_role != pre_bt_slave) { |
| pre_bt_slave = bt_link_info->slave_role; |
| return true; |
| } |
| |
| if (pre_hid_low_pri_tx_overhead != |
| coex_sta->is_hid_low_pri_tx_overhead) { |
| pre_hid_low_pri_tx_overhead = |
| coex_sta->is_hid_low_pri_tx_overhead; |
| return true; |
| } |
| |
| if (pre_bt_setup_link != coex_sta->is_setup_link) { |
| pre_bt_setup_link = coex_sta->is_setup_link; |
| return true; |
| } |
| } |
| |
| return false; |
| } |
| |
| static void halbtc8822b2ant_update_bt_link_info(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| bool bt_hs_on = false; |
| bool bt_busy = false; |
| |
| coex_sta->num_of_profile = 0; |
| |
| /* set link exist status */ |
| if (!(coex_sta->bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { |
| coex_sta->bt_link_exist = false; |
| coex_sta->pan_exist = false; |
| coex_sta->a2dp_exist = false; |
| coex_sta->hid_exist = false; |
| coex_sta->sco_exist = false; |
| } else { /* connection exists */ |
| coex_sta->bt_link_exist = true; |
| if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_FTP) { |
| coex_sta->pan_exist = true; |
| coex_sta->num_of_profile++; |
| } else { |
| coex_sta->pan_exist = false; |
| } |
| |
| if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_A2DP) { |
| coex_sta->a2dp_exist = true; |
| coex_sta->num_of_profile++; |
| } else { |
| coex_sta->a2dp_exist = false; |
| } |
| |
| if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_HID) { |
| coex_sta->hid_exist = true; |
| coex_sta->num_of_profile++; |
| } else { |
| coex_sta->hid_exist = false; |
| } |
| |
| if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { |
| coex_sta->sco_exist = true; |
| coex_sta->num_of_profile++; |
| } else { |
| coex_sta->sco_exist = false; |
| } |
| } |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); |
| |
| bt_link_info->bt_link_exist = coex_sta->bt_link_exist; |
| bt_link_info->sco_exist = coex_sta->sco_exist; |
| bt_link_info->a2dp_exist = coex_sta->a2dp_exist; |
| bt_link_info->pan_exist = coex_sta->pan_exist; |
| bt_link_info->hid_exist = coex_sta->hid_exist; |
| bt_link_info->acl_busy = coex_sta->acl_busy; |
| |
| /* work around for HS mode. */ |
| if (bt_hs_on) { |
| bt_link_info->pan_exist = true; |
| bt_link_info->bt_link_exist = true; |
| } |
| |
| /* check if Sco only */ |
| if (bt_link_info->sco_exist && !bt_link_info->a2dp_exist && |
| !bt_link_info->pan_exist && !bt_link_info->hid_exist) |
| bt_link_info->sco_only = true; |
| else |
| bt_link_info->sco_only = false; |
| |
| /* check if A2dp only */ |
| if (!bt_link_info->sco_exist && bt_link_info->a2dp_exist && |
| !bt_link_info->pan_exist && !bt_link_info->hid_exist) |
| bt_link_info->a2dp_only = true; |
| else |
| bt_link_info->a2dp_only = false; |
| |
| /* check if Pan only */ |
| if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && |
| bt_link_info->pan_exist && !bt_link_info->hid_exist) |
| bt_link_info->pan_only = true; |
| else |
| bt_link_info->pan_only = false; |
| |
| /* check if Hid only */ |
| if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && |
| !bt_link_info->pan_exist && bt_link_info->hid_exist) |
| bt_link_info->hid_only = true; |
| else |
| bt_link_info->hid_only = false; |
| |
| if (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_INQ_PAGE) { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_INQ_PAGE; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); |
| } else if (!(coex_sta->bt_info & BT_INFO_8822B_2ANT_B_CONNECTION)) { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); |
| } else if (coex_sta->bt_info == BT_INFO_8822B_2ANT_B_CONNECTION) { |
| /* connection exists but no busy */ |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); |
| } else if (((coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_ESCO) || |
| (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_BUSY)) && |
| (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_ACL_BUSY)) { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); |
| } else if ((coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_ESCO) || |
| (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_BUSY)) { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_SCO_BUSY; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); |
| } else if (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_ACL_BUSY) { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_ACL_BUSY; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); |
| } else { |
| coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_MAX; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); |
| } |
| |
| if ((coex_dm->bt_status == BT_8822B_2ANT_BT_STATUS_ACL_BUSY) || |
| (coex_dm->bt_status == BT_8822B_2ANT_BT_STATUS_SCO_BUSY) || |
| (coex_dm->bt_status == BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY)) |
| bt_busy = true; |
| else |
| bt_busy = false; |
| |
| btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); |
| } |
| |
| static void halbtc8822b2ant_update_wifi_ch_info(struct btc_coexist *btcoexist, |
| u8 type) |
| { |
| u8 h2c_parameter[3] = {0}; |
| u32 wifi_bw; |
| u8 wifi_central_chnl; |
| u32 RTL97F_8822B = 0; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| /* only 2.4G we need to inform bt the chnl mask */ |
| btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, |
| &wifi_central_chnl); |
| if ((type == BTC_MEDIA_CONNECT) && (wifi_central_chnl <= 14)) { |
| /* enable BT AFH skip WL channel for 8822b |
| * because BT Rx LO interference |
| */ |
| h2c_parameter[0] = 0x1; |
| h2c_parameter[1] = wifi_central_chnl; |
| btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); |
| if (wifi_bw == BTC_WIFI_BW_HT40) |
| h2c_parameter[2] = 0x30; |
| else |
| h2c_parameter[2] = 0x20; |
| } |
| |
| coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; |
| coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; |
| coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); |
| } |
| |
| static void |
| halbtc8822b2ant_set_fw_dac_swing_level(struct btc_coexist *btcoexist, |
| u8 dac_swing_lvl) |
| { |
| u8 h2c_parameter[1] = {0}; |
| u32 RTL97F_8822B = 0; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| /* There are several type of dacswing */ |
| /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ |
| h2c_parameter[0] = dac_swing_lvl; |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); |
| } |
| |
| static void halbtc8822b2ant_fw_dac_swing_lvl(struct btc_coexist *btcoexist, |
| bool force_exec, |
| u8 fw_dac_swing_lvl) |
| { |
| u32 RTL97F_8822B = 0; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; |
| |
| if (!force_exec) { |
| if (coex_dm->pre_fw_dac_swing_lvl == |
| coex_dm->cur_fw_dac_swing_lvl) |
| return; |
| } |
| |
| halbtc8822b2ant_set_fw_dac_swing_level(btcoexist, |
| coex_dm->cur_fw_dac_swing_lvl); |
| |
| coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; |
| } |
| |
| static void halbtc8822b2ant_set_fw_dec_bt_pwr(struct btc_coexist *btcoexist, |
| u8 dec_bt_pwr_lvl) |
| { |
| u32 RTL97F_8822B = 0; |
| u8 h2c_parameter[1] = {0}; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| h2c_parameter[0] = dec_bt_pwr_lvl; |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); |
| } |
| |
| static void halbtc8822b2ant_dec_bt_pwr(struct btc_coexist *btcoexist, |
| bool force_exec, u8 dec_bt_pwr_lvl) |
| { |
| coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; |
| |
| if (!force_exec) { |
| if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) |
| return; |
| } |
| halbtc8822b2ant_set_fw_dec_bt_pwr(btcoexist, |
| coex_dm->cur_bt_dec_pwr_lvl); |
| |
| coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; |
| } |
| |
| static void halbtc8822b2ant_low_penalty_ra(struct btc_coexist *btcoexist, |
| bool force_exec, bool low_penalty_ra) |
| { |
| coex_dm->cur_low_penalty_ra = low_penalty_ra; |
| |
| if (!force_exec) { |
| if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) |
| return; |
| } |
| |
| if (low_penalty_ra) |
| btcoexist->btc_phydm_modify_ra_pcr_threshold(btcoexist, 0, 50); |
| else |
| btcoexist->btc_phydm_modify_ra_pcr_threshold(btcoexist, 0, 0); |
| |
| coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; |
| } |
| |
| static void halbtc8822b2ant_write_score_board(struct btc_coexist *btcoexist, |
| u16 bitpos, bool state) |
| { |
| static u16 originalval = 0x8002; |
| |
| if (state) |
| originalval = originalval | bitpos; |
| else |
| originalval = originalval & (~bitpos); |
| |
| btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); |
| } |
| |
| static void halbtc8822b2ant_read_score_board(struct btc_coexist *btcoexist, |
| u16 *score_board_val) |
| { |
| *score_board_val = |
| (btcoexist->btc_read_2byte(btcoexist, 0xaa)) & 0x7fff; |
| } |
| |
| static void halbtc8822b2ant_post_state_to_bt(struct btc_coexist *btcoexist, |
| u16 type, bool state) |
| { |
| halbtc8822b2ant_write_score_board(btcoexist, (u16)type, state); |
| } |
| |
| static void |
| halbtc8822b2ant_monitor_bt_enable_disable(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u32 bt_disable_cnt; |
| bool bt_active = true, bt_disabled = false, wifi_under_5g = false; |
| u16 u16tmp; |
| |
| /* This function check if bt is disabled */ |
| |
| /* Read BT on/off status from scoreboard[1], |
| * enable this only if BT patch support this feature |
| */ |
| halbtc8822b2ant_read_score_board(btcoexist, &u16tmp); |
| |
| bt_active = u16tmp & BIT(1); |
| |
| if (bt_active) { |
| bt_disable_cnt = 0; |
| bt_disabled = false; |
| btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, |
| &bt_disabled); |
| } else { |
| bt_disable_cnt++; |
| if (bt_disable_cnt >= 10) { |
| bt_disabled = true; |
| bt_disable_cnt = 10; |
| } |
| |
| btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, |
| &bt_disabled); |
| } |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); |
| |
| if ((wifi_under_5g) || (bt_disabled)) |
| halbtc8822b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); |
| else |
| halbtc8822b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); |
| |
| if (coex_sta->bt_disabled != bt_disabled) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], BT is from %s to %s!!\n", |
| (coex_sta->bt_disabled ? "disabled" : "enabled"), |
| (bt_disabled ? "disabled" : "enabled")); |
| coex_sta->bt_disabled = bt_disabled; |
| } |
| } |
| |
| static void halbtc8822b2ant_enable_gnt_to_gpio(struct btc_coexist *btcoexist, |
| bool isenable) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 bit_val[5] = {0, 0, 0, 0, 0}; |
| |
| if (!btcoexist->dbg_mode_2ant) |
| return; |
| |
| if (isenable) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], enable_gnt_to_gpio!!\n"); |
| |
| /* enable GNT_WL, GNT_BT to GPIO for debug */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); |
| |
| /* store original value */ |
| bit_val[0] = |
| (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >> |
| 4; /*0x66[4] */ |
| bit_val[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & |
| BIT(0)); /*0x66[8] */ |
| bit_val[2] = |
| (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> |
| 3; /*0x40[19] */ |
| bit_val[3] = |
| (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> |
| 7; /*0x64[15] */ |
| bit_val[4] = |
| (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> |
| 2; /*0x70[18] */ |
| |
| /* switch GPIO Mux */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), |
| 0x0); /*0x66[4] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), |
| 0x0); /*0x66[8] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), |
| 0x0); /*0x40[19] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), |
| 0x0); /*0x64[15] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), |
| 0x0); /*0x70[18] = 0 */ |
| |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], disable_gnt_to_gpio!!\n"); |
| |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); |
| |
| /* Restore original value */ |
| /* switch GPIO Mux */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), |
| bit_val[0]); /*0x66[4] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), |
| bit_val[1]); /*0x66[8] = 0 */ |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x42, BIT(3), bit_val[2]); /*0x40[19] = 0 */ |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x65, BIT(7), bit_val[3]); /*0x64[15] = 0 */ |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x72, BIT(2), bit_val[4]); /*0x70[18] = 0 */ |
| } |
| } |
| |
| static u32 |
| halbtc8822b2ant_ltecoex_indirect_read_reg(struct btc_coexist *btcoexist, |
| u16 reg_addr) |
| { |
| u32 delay_count = 0; |
| |
| while (1) { |
| if ((btcoexist->btc_read_1byte(btcoexist, 0x1703) & BIT(5)) == |
| 0) { |
| mdelay(50); |
| delay_count++; |
| if (delay_count >= 10) { |
| delay_count = 0; |
| break; |
| } |
| } else { |
| break; |
| } |
| } |
| |
| /* wait for ready bit before access 0x1700 */ |
| btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); |
| |
| return btcoexist->btc_read_4byte(btcoexist, 0x1708); /* get read data */ |
| } |
| |
| static void |
| halbtc8822b2ant_ltecoex_indirect_write_reg(struct btc_coexist *btcoexist, |
| u16 reg_addr, u32 bit_mask, |
| u32 reg_value) |
| { |
| u32 val, i = 0, bitpos = 0, delay_count = 0; |
| |
| if (bit_mask == 0x0) |
| return; |
| if (bit_mask == 0xffffffff) { |
| /* wait for ready bit before access 0x1700/0x1704 */ |
| while (1) { |
| if ((btcoexist->btc_read_1byte(btcoexist, 0x1703) & |
| BIT(5)) == 0) { |
| mdelay(50); |
| delay_count++; |
| if (delay_count >= 10) { |
| delay_count = 0; |
| break; |
| } |
| } else { |
| break; |
| } |
| } |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x1704, |
| reg_value); /* put write data */ |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x1700, |
| 0xc00F0000 | reg_addr); |
| } else { |
| for (i = 0; i <= 31; i++) { |
| if (((bit_mask >> i) & 0x1) == 0x1) { |
| bitpos = i; |
| break; |
| } |
| } |
| |
| /* read back register value before write */ |
| val = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, |
| reg_addr); |
| val = (val & (~bit_mask)) | (reg_value << bitpos); |
| |
| /* wait for ready bit before access 0x1700/0x1704 */ |
| while (1) { |
| if ((btcoexist->btc_read_1byte(btcoexist, 0x1703) & |
| BIT(5)) == 0) { |
| mdelay(50); |
| delay_count++; |
| if (delay_count >= 10) { |
| delay_count = 0; |
| break; |
| } |
| } else { |
| break; |
| } |
| } |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x1704, |
| val); /* put write data */ |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x1700, |
| 0xc00F0000 | reg_addr); |
| } |
| } |
| |
| static void halbtc8822b2ant_ltecoex_enable(struct btc_coexist *btcoexist, |
| bool enable) |
| { |
| u8 val; |
| |
| val = (enable) ? 1 : 0; |
| halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, |
| val); /* 0x38[7] */ |
| } |
| |
| static void |
| halbtc8822b2ant_ltecoex_pathcontrol_owner(struct btc_coexist *btcoexist, |
| bool wifi_control) |
| { |
| u8 val; |
| |
| val = (wifi_control) ? 1 : 0; |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, |
| val); /* 0x70[26] */ |
| } |
| |
| static void halbtc8822b2ant_ltecoex_set_gnt_bt(struct btc_coexist *btcoexist, |
| u8 control_block, |
| bool sw_control, u8 state) |
| { |
| u32 val = 0, bit_mask; |
| |
| state = state & 0x1; |
| val = (sw_control) ? ((state << 1) | 0x1) : 0; |
| |
| switch (control_block) { |
| case BT_8822B_2ANT_GNT_BLOCK_RFC_BB: |
| default: |
| bit_mask = 0xc000; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[15:14] */ |
| bit_mask = 0x0c00; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[11:10] */ |
| break; |
| case BT_8822B_2ANT_GNT_BLOCK_RFC: |
| bit_mask = 0xc000; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[15:14] */ |
| break; |
| case BT_8822B_2ANT_GNT_BLOCK_BB: |
| bit_mask = 0x0c00; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[11:10] */ |
| break; |
| } |
| } |
| |
| static void halbtc8822b2ant_ltecoex_set_gnt_wl(struct btc_coexist *btcoexist, |
| u8 control_block, |
| bool sw_control, u8 state) |
| { |
| u32 val = 0, bit_mask; |
| |
| state = state & 0x1; |
| val = (sw_control) ? ((state << 1) | 0x1) : 0; |
| |
| switch (control_block) { |
| case BT_8822B_2ANT_GNT_BLOCK_RFC_BB: |
| default: |
| bit_mask = 0x3000; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[13:12] */ |
| bit_mask = 0x0300; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[9:8] */ |
| break; |
| case BT_8822B_2ANT_GNT_BLOCK_RFC: |
| bit_mask = 0x3000; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[13:12] */ |
| break; |
| case BT_8822B_2ANT_GNT_BLOCK_BB: |
| bit_mask = 0x0300; |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, 0x38, bit_mask, val); /* 0x38[9:8] */ |
| break; |
| } |
| } |
| |
| static void |
| halbtc8822b2ant_ltecoex_set_coex_table(struct btc_coexist *btcoexist, |
| u8 table_type, u16 table_content) |
| { |
| u16 reg_addr = 0x0000; |
| |
| switch (table_type) { |
| case BT_8822B_2ANT_CTT_WL_VS_LTE: |
| reg_addr = 0xa0; |
| break; |
| case BT_8822B_2ANT_CTT_BT_VS_LTE: |
| reg_addr = 0xa4; |
| break; |
| } |
| |
| if (reg_addr != 0x0000) |
| halbtc8822b2ant_ltecoex_indirect_write_reg( |
| btcoexist, reg_addr, 0xffff, |
| table_content); /* 0xa0[15:0] or 0xa4[15:0] */ |
| } |
| |
| static void halbtc8822b2ant_set_wltoggle_coex_table( |
| struct btc_coexist *btcoexist, bool force_exec, u8 interval, |
| u8 val0x6c4_b0, u8 val0x6c4_b1, u8 val0x6c4_b2, u8 val0x6c4_b3) |
| { |
| static u8 pre_h2c_parameter[6] = {0}; |
| u8 cur_h2c_parameter[6] = {0}; |
| u8 i, match_cnt = 0; |
| |
| cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ |
| |
| cur_h2c_parameter[1] = interval; |
| cur_h2c_parameter[2] = val0x6c4_b0; |
| cur_h2c_parameter[3] = val0x6c4_b1; |
| cur_h2c_parameter[4] = val0x6c4_b2; |
| cur_h2c_parameter[5] = val0x6c4_b3; |
| |
| if (!force_exec) { |
| for (i = 1; i <= 5; i++) { |
| if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) |
| break; |
| |
| match_cnt++; |
| } |
| |
| if (match_cnt == 5) |
| return; |
| } |
| |
| for (i = 1; i <= 5; i++) |
| pre_h2c_parameter[i] = cur_h2c_parameter[i]; |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); |
| } |
| |
| static void halbtc8822b2ant_set_coex_table(struct btc_coexist *btcoexist, |
| u32 val0x6c0, u32 val0x6c4, |
| u32 val0x6c8, u8 val0x6cc) |
| { |
| btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); |
| |
| btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); |
| |
| btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); |
| } |
| |
| static void halbtc8822b2ant_coex_table(struct btc_coexist *btcoexist, |
| bool force_exec, u32 val0x6c0, |
| u32 val0x6c4, u32 val0x6c8, u8 val0x6cc) |
| { |
| coex_dm->cur_val0x6c0 = val0x6c0; |
| coex_dm->cur_val0x6c4 = val0x6c4; |
| coex_dm->cur_val0x6c8 = val0x6c8; |
| coex_dm->cur_val0x6cc = val0x6cc; |
| |
| if (!force_exec) { |
| if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && |
| (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && |
| (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && |
| (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) |
| return; |
| } |
| halbtc8822b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, |
| val0x6cc); |
| |
| coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; |
| coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; |
| coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; |
| coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; |
| } |
| |
| static void halbtc8822b2ant_coex_table_with_type(struct btc_coexist *btcoexist, |
| bool force_exec, u8 type) |
| { |
| u32 break_table; |
| u8 select_table; |
| |
| coex_sta->coex_table_type = type; |
| |
| if (coex_sta->concurrent_rx_mode_on) { |
| break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ |
| /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ |
| select_table = 0xb; |
| } else { |
| break_table = 0xffffff; |
| select_table = 0x3; |
| } |
| |
| switch (type) { |
| case 0: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0xffffffff, |
| 0xffffffff, break_table, |
| select_table); |
| break; |
| case 1: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x55555555, |
| 0x5a5a5a5a, break_table, |
| select_table); |
| break; |
| case 2: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, |
| 0x5a5a5a5a, break_table, |
| select_table); |
| break; |
| case 3: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x55555555, |
| 0x5a5a5a5a, break_table, |
| select_table); |
| break; |
| case 4: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x55555555, |
| 0x5a5a5a5a, break_table, |
| select_table); |
| break; |
| case 5: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x55555555, |
| 0x55555555, break_table, |
| select_table); |
| break; |
| case 6: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0xa5555555, |
| 0xfafafafa, break_table, |
| select_table); |
| break; |
| case 7: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0xa5555555, |
| 0xaa5a5a5a, break_table, |
| select_table); |
| break; |
| case 8: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0xa5555555, |
| 0xfafafafa, break_table, |
| select_table); |
| break; |
| case 9: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, |
| 0xaaaa5aaa, break_table, |
| select_table); |
| break; |
| case 10: |
| halbtc8822b2ant_coex_table(btcoexist, force_exec, 0x55555555, |
| 0x5a5a555a, break_table, |
| select_table); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void |
| halbtc8822b2ant_set_fw_ignore_wlan_act(struct btc_coexist *btcoexist, |
| bool enable) |
| { |
| u8 h2c_parameter[1] = {0}; |
| u32 RTL97F_8822B = 0; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| if (enable) |
| h2c_parameter[0] |= BIT(0); /* function enable */ |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); |
| } |
| |
| static void halbtc8822b2ant_ignore_wlan_act(struct btc_coexist *btcoexist, |
| bool force_exec, bool enable) |
| { |
| coex_dm->cur_ignore_wlan_act = enable; |
| |
| if (!force_exec) { |
| if (coex_dm->pre_ignore_wlan_act == |
| coex_dm->cur_ignore_wlan_act) |
| return; |
| } |
| halbtc8822b2ant_set_fw_ignore_wlan_act(btcoexist, enable); |
| |
| coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; |
| } |
| |
| static void halbtc8822b2ant_set_lps_rpwm(struct btc_coexist *btcoexist, |
| u8 lps_val, u8 rpwm_val) |
| { |
| u8 lps = lps_val; |
| u8 rpwm = rpwm_val; |
| |
| btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); |
| btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); |
| } |
| |
| static void halbtc8822b2ant_lps_rpwm(struct btc_coexist *btcoexist, |
| bool force_exec, u8 lps_val, u8 rpwm_val) |
| { |
| coex_dm->cur_lps = lps_val; |
| coex_dm->cur_rpwm = rpwm_val; |
| |
| if (!force_exec) { |
| if ((coex_dm->pre_lps == coex_dm->cur_lps) && |
| (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) |
| return; |
| } |
| halbtc8822b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); |
| |
| coex_dm->pre_lps = coex_dm->cur_lps; |
| coex_dm->pre_rpwm = coex_dm->cur_rpwm; |
| } |
| |
| static void halbtc8822b2ant_ps_tdma_check_for_power_save_state( |
| struct btc_coexist *btcoexist, bool new_ps_state) |
| { |
| u8 lps_mode = 0x0; |
| u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; |
| u32 RTL97F_8822B = 0; |
| |
| if (RTL97F_8822B) |
| return; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); |
| |
| if (lps_mode) { /* already under LPS state */ |
| if (new_ps_state) { |
| /* keep state under LPS, do nothing. */ |
| } else { |
| /* will leave LPS state, turn off psTdma first */ |
| btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, |
| h2c_parameter); |
| } |
| } else { /* NO PS state */ |
| if (new_ps_state) { |
| /* will enter LPS state, turn off psTdma first */ |
| btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, |
| h2c_parameter); |
| } else { |
| /* keep state under NO PS state, do nothing. */ |
| } |
| } |
| } |
| |
| static bool halbtc8822b2ant_power_save_state(struct btc_coexist *btcoexist, |
| u8 ps_type, u8 lps_val, |
| u8 rpwm_val) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| bool low_pwr_disable = false, result = true; |
| |
| switch (ps_type) { |
| case BTC_PS_WIFI_NATIVE: |
| coex_sta->force_lps_ctrl = false; |
| /* recover to original 32k low power setting */ |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == BTC_PS_WIFI_NATIVE\n", __func__); |
| |
| low_pwr_disable = false; |
| btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, |
| &low_pwr_disable); |
| btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, NULL); |
| break; |
| case BTC_PS_LPS_ON: |
| coex_sta->force_lps_ctrl = true; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == BTC_PS_LPS_ON\n", __func__); |
| |
| halbtc8822b2ant_ps_tdma_check_for_power_save_state(btcoexist, |
| true); |
| halbtc8822b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, |
| rpwm_val); |
| /* when coex force to enter LPS, do not enter 32k low power. */ |
| low_pwr_disable = true; |
| btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, |
| &low_pwr_disable); |
| /* power save must executed before psTdma. */ |
| btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, NULL); |
| break; |
| case BTC_PS_LPS_OFF: |
| coex_sta->force_lps_ctrl = true; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == BTC_PS_LPS_OFF\n", __func__); |
| |
| halbtc8822b2ant_ps_tdma_check_for_power_save_state(btcoexist, |
| false); |
| result = btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, |
| NULL); |
| break; |
| default: |
| break; |
| } |
| |
| return result; |
| } |
| |
| static void halbtc8822b2ant_set_fw_pstdma(struct btc_coexist *btcoexist, |
| u8 byte1, u8 byte2, u8 byte3, |
| u8 byte4, u8 byte5) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| u8 h2c_parameter[5] = {0}; |
| u8 real_byte1 = byte1, real_byte5 = byte5; |
| bool ap_enable = false, result = false; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| if (byte5 & BIT(2)) |
| coex_sta->is_tdma_btautoslot = true; |
| else |
| coex_sta->is_tdma_btautoslot = false; |
| |
| /* release bt-auto slot for auto-slot hang is detected!! */ |
| if (coex_sta->is_tdma_btautoslot) |
| if ((coex_sta->is_tdma_btautoslot_hang) || |
| (bt_link_info->slave_role)) |
| byte5 = byte5 & 0xfb; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, |
| &ap_enable); |
| |
| if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == FW for AP mode\n", __func__); |
| |
| real_byte1 &= ~BIT(4); |
| real_byte1 |= BIT(5); |
| |
| real_byte5 |= BIT(5); |
| real_byte5 &= ~BIT(6); |
| |
| halbtc8822b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, |
| 0x0, 0x0); |
| } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == Force LPS (byte1 = 0x%x)\n", |
| __func__, byte1); |
| |
| if (!halbtc8822b2ant_power_save_state(btcoexist, BTC_PS_LPS_OFF, |
| 0x50, 0x4)) |
| result = true; |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == Native LPS (byte1 = 0x%x)\n", |
| __func__, byte1); |
| |
| halbtc8822b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, |
| 0x0, 0x0); |
| } |
| |
| coex_sta->is_set_ps_state_fail = result; |
| |
| if (!coex_sta->is_set_ps_state_fail) { |
| h2c_parameter[0] = real_byte1; |
| h2c_parameter[1] = byte2; |
| h2c_parameter[2] = byte3; |
| h2c_parameter[3] = byte4; |
| h2c_parameter[4] = real_byte5; |
| |
| coex_dm->ps_tdma_para[0] = real_byte1; |
| coex_dm->ps_tdma_para[1] = byte2; |
| coex_dm->ps_tdma_para[2] = byte3; |
| coex_dm->ps_tdma_para[3] = byte4; |
| coex_dm->ps_tdma_para[4] = real_byte5; |
| |
| btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); |
| } else { |
| coex_sta->cnt_set_ps_state_fail++; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], %s == Force Leave LPS Fail (cnt = %d)\n", |
| __func__, coex_sta->cnt_set_ps_state_fail); |
| } |
| } |
| |
| static void halbtc8822b2ant_ps_tdma(struct btc_coexist *btcoexist, |
| bool force_exec, bool turn_on, u8 type) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 ps_tdma_byte4_modify, pre_ps_tdma_byte4_modify; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| coex_dm->cur_ps_tdma_on = turn_on; |
| coex_dm->cur_ps_tdma = type; |
| |
| /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ |
| if (bt_link_info->slave_role) |
| ps_tdma_byte4_modify = 0x1; |
| else |
| ps_tdma_byte4_modify = 0x0; |
| |
| if (pre_ps_tdma_byte4_modify != ps_tdma_byte4_modify) { |
| force_exec = true; |
| pre_ps_tdma_byte4_modify = ps_tdma_byte4_modify; |
| } |
| |
| if (!force_exec) { |
| if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && |
| (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", |
| (coex_dm->cur_ps_tdma_on ? "on" : "off"), |
| coex_dm->cur_ps_tdma); |
| return; |
| } |
| } |
| |
| if (coex_dm->cur_ps_tdma_on) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], ********** TDMA(on, %d) **********\n", |
| coex_dm->cur_ps_tdma); |
| |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x550, 0x8, 0x1); /* enable TBTT nterrupt */ |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], ********** TDMA(off, %d) **********\n", |
| coex_dm->cur_ps_tdma); |
| } |
| |
| if (turn_on) { |
| switch (type) { |
| case 1: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x10, 0x03, 0x91, |
| 0x54 | ps_tdma_byte4_modify); |
| break; |
| case 2: |
| default: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x35, 0x03, 0x11, |
| 0x11 | ps_tdma_byte4_modify); |
| break; |
| case 3: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x3a, 0x3, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 4: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x21, 0x3, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 5: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x25, 0x3, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 6: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x10, 0x3, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 7: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x20, 0x3, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 8: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x15, |
| 0x03, 0x11, 0x11); |
| break; |
| case 10: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x30, |
| 0x03, 0x11, 0x10); |
| break; |
| case 11: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x35, 0x03, 0x11, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 12: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, |
| 0x03, 0x11, 0x11); |
| break; |
| case 13: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x1c, 0x03, 0x11, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 14: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x20, |
| 0x03, 0x11, 0x11); |
| break; |
| case 15: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x10, |
| 0x03, 0x11, 0x14); |
| break; |
| case 16: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x10, |
| 0x03, 0x11, 0x15); |
| break; |
| case 21: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x30, |
| 0x03, 0x11, 0x10); |
| break; |
| case 22: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x25, |
| 0x03, 0x11, 0x10); |
| break; |
| case 23: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, 0x10, |
| 0x03, 0x11, 0x10); |
| break; |
| case 51: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x10, 0x03, 0x91, |
| 0x10 | ps_tdma_byte4_modify); |
| break; |
| case 101: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x25, 0x03, 0x11, |
| 0x11 | ps_tdma_byte4_modify); |
| break; |
| case 102: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x35, 0x03, 0x11, |
| 0x11 | ps_tdma_byte4_modify); |
| break; |
| case 103: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x3a, 0x3, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 104: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x21, 0x3, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 105: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x30, 0x3, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 106: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x10, 0x3, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 107: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x10, 0x7, 0x10, |
| 0x54 | ps_tdma_byte4_modify); |
| break; |
| case 108: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x30, 0x3, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 109: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x10, 0x03, 0x10, |
| 0x54 | ps_tdma_byte4_modify); |
| break; |
| case 110: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x55, 0x30, 0x03, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| case 111: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x61, 0x25, 0x03, 0x11, |
| 0x11 | ps_tdma_byte4_modify); |
| break; |
| case 151: |
| halbtc8822b2ant_set_fw_pstdma( |
| btcoexist, 0x51, 0x10, 0x03, 0x10, |
| 0x50 | ps_tdma_byte4_modify); |
| break; |
| } |
| } else { |
| /* disable PS tdma */ |
| switch (type) { |
| case 0: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, 0x0, 0x0, |
| 0x40, 0x0); |
| break; |
| case 1: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, 0x0, 0x0, |
| 0x48, 0x0); |
| break; |
| default: |
| halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, 0x0, 0x0, |
| 0x40, 0x0); |
| break; |
| } |
| } |
| |
| if (!coex_sta->is_set_ps_state_fail) { |
| /* update pre state */ |
| coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; |
| coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; |
| } |
| } |
| |
| /*anttenna control by bb mac bt antdiv pta to write 0x4c 0xcb4,0xcbd*/ |
| static void halbtc8822b2ant_set_ext_ant_switch(struct btc_coexist *btcoexist, |
| bool force_exec, u8 ctrl_type, |
| u8 pos_type) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| bool switch_polatiry_inverse = false; |
| u8 regval_0xcbc = 0, regval_0x64; |
| u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; |
| |
| if (!rfe_type->ext_ant_switch_exist) |
| return; |
| |
| coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; |
| |
| if (!force_exec) { |
| if (coex_dm->pre_ext_ant_switch_status == |
| coex_dm->cur_ext_ant_switch_status) |
| return; |
| } |
| coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; |
| |
| /* Ext switch buffer mux */ |
| btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); |
| |
| switch (ctrl_type) { |
| default: |
| case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x1); /* 0x4c[24] = 1 */ |
| /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, |
| 0x77); |
| |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x03, 01); |
| |
| break; |
| case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x1); /* 0x4c[24] = 1 */ |
| /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, |
| 0x66); |
| |
| /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, |
| * DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 |
| */ |
| regval_0xcbc = (!switch_polatiry_inverse ? 0x2 : 0x1); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbc, 0x03, |
| regval_0xcbc); |
| |
| break; |
| case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x1); /* 0x4c[24] = 1 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, |
| 0x88); |
| break; |
| case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x1); /* 0x4c[23] = 1 */ |
| |
| /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, |
| * DPDT_SEL_N =1, DPDT_SEL_P =0 |
| */ |
| regval_0x64 = (!switch_polatiry_inverse ? 0x0 : 0x1); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, |
| regval_0x64); |
| break; |
| case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x0); /* 0x4c[24] = 0 */ |
| |
| /* no setup required, because antenna switch control value by |
| * BT vendor 0x1c[1:0] |
| */ |
| break; |
| } |
| |
| /* PAPE, LNA_ON control by BT while WLAN off for current leakage issue*/ |
| if (ctrl_type == BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT) { |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x67, 0x20, 0x0); /* PAPE 0x64[29] = 0 */ |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x67, 0x10, 0x0); /* LNA_ON 0x64[28] = 0 */ |
| } else { |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x67, 0x20, 0x1); /* PAPE 0x64[29] = 1 */ |
| btcoexist->btc_write_1byte_bitmask( |
| btcoexist, 0x67, 0x10, 0x1); /* LNA_ON 0x64[28] = 1 */ |
| } |
| |
| if (btcoexist->dbg_mode_2ant) { |
| u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); |
| u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); |
| u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; |
| |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x\n", |
| u32tmp1, u32tmp2, u32tmp3); |
| } |
| } |
| |
| /* rf4 type by efuse, and for ant at main aux inverse use, |
| * because is 2x2, and control types are the same, does not need |
| */ |
| static void halbtc8822b2ant_set_rfe_type(struct btc_coexist *btcoexist) |
| { |
| struct btc_board_info *board_info = &btcoexist->board_info; |
| |
| rfe_type->ext_band_switch_exist = false; |
| rfe_type->ext_band_switch_type = |
| BT_8822B_2ANT_EXT_BAND_SWITCH_USE_SPDT; /* SPDT; */ |
| rfe_type->ext_band_switch_ctrl_polarity = 0; |
| /* Ext switch buffer mux */ |
| btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); |
| |
| if (rfe_type->ext_band_switch_exist) { |
| /* band switch use RFE_ctrl1 (pin name: PAPE_A) and |
| * RFE_ctrl3 (pin name: LNAON_A) |
| */ |
| |
| /* set RFE_ctrl1 as software control */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); |
| |
| /* set RFE_ctrl3 as software control */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); |
| } |
| |
| /* the following setup should be got from Efuse in the future */ |
| rfe_type->rfe_module_type = board_info->rfe_type; |
| |
| rfe_type->ext_ant_switch_ctrl_polarity = 0; |
| |
| switch (rfe_type->rfe_module_type) { |
| case 0: |
| default: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 1: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 2: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 3: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 4: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 5: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 6: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| case 7: |
| rfe_type->ext_ant_switch_exist = true; |
| rfe_type->ext_ant_switch_type = |
| BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; |
| break; |
| } |
| } |
| |
| /* set gnt_wl gnt_bt control by sw high low, or hwpta while in |
| * power on, ini, wlan off, wlan only, wl2g non-currrent, wl2g current, wl5g |
| */ |
| static void halbtc8822b2ant_set_ant_path(struct btc_coexist *btcoexist, |
| u8 ant_pos_type, bool force_exec, |
| u8 phase) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| u8 u8tmp = 0; |
| u32 u32tmp1 = 0; |
| u32 u32tmp2 = 0, u32tmp3 = 0; |
| |
| u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); |
| |
| /* To avoid indirect access fail */ |
| if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { |
| force_exec = true; |
| coex_sta->gnt_error_cnt++; |
| } |
| |
| /* Ext switch buffer mux */ |
| btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x1); /* 0x4c[24] = 1 */ |
| |
| coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; |
| |
| if (!force_exec) { |
| if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) |
| return; |
| } |
| |
| coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; |
| |
| if (btcoexist->dbg_mode_2ant) { |
| u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, |
| 0x38); |
| u32tmp2 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, |
| 0x54); |
| u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); |
| |
| u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); |
| |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", |
| u32tmp3, u8tmp, u32tmp1, u32tmp2); |
| } |
| |
| switch (phase) { |
| case BT_8822B_2ANT_PHASE_COEX_POWERON: |
| |
| /* set Path control owner to WL at initial step */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_BTSIDE); |
| |
| /* set GNT_BT to SW high */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| /* Set GNT_WL to SW high */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| |
| coex_sta->run_time_state = false; |
| |
| break; |
| case BT_8822B_2ANT_PHASE_COEX_INIT: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x1); /* 0x4c[24] = 1 */ |
| /* Disable LTE Coex Function in WiFi side |
| * (this should be on if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); |
| |
| /* GNT_WL_LTE always = 1 |
| * (this should be config if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_set_coex_table( |
| btcoexist, BT_8822B_2ANT_CTT_WL_VS_LTE, 0xffff); |
| |
| /* GNT_BT_LTE always = 1 |
| * (this should be config if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_set_coex_table( |
| btcoexist, BT_8822B_2ANT_CTT_BT_VS_LTE, 0xffff); |
| |
| /* set Path control owner to WL at initial step */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_WLSIDE); |
| |
| /* set GNT_BT to SW high */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| /* Set GNT_WL to SW high */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| |
| coex_sta->run_time_state = false; |
| |
| break; |
| case BT_8822B_2ANT_PHASE_WLANONLY_INIT: |
| /* Disable LTE Coex Function in WiFi side |
| * (this should be on if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); |
| |
| /* GNT_WL_LTE always = 1 |
| * (this should be config if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_set_coex_table( |
| btcoexist, BT_8822B_2ANT_CTT_WL_VS_LTE, 0xffff); |
| |
| /* GNT_BT_LTE always = 1 |
| * (this should be config if LTE coex is required) |
| */ |
| halbtc8822b2ant_ltecoex_set_coex_table( |
| btcoexist, BT_8822B_2ANT_CTT_BT_VS_LTE, 0xffff); |
| |
| /* set Path control owner to WL at initial step */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_WLSIDE); |
| |
| /* set GNT_BT to SW Low */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_LOW); |
| /* Set GNT_WL to SW high */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| |
| coex_sta->run_time_state = false; |
| |
| break; |
| case BT_8822B_2ANT_PHASE_WLAN_OFF: |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, |
| 0x0); /* 0x4c[23] = 0 */ |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, |
| 0x0); /* 0x4c[24] = 0 */ |
| /* Disable LTE Coex Function in WiFi side */ |
| halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); |
| |
| /* set Path control owner to BT */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_BTSIDE); |
| |
| /* Set Ext Ant Switch to BT control at wifi off step */ |
| halbtc8822b2ant_set_ext_ant_switch( |
| btcoexist, FORCE_EXEC, |
| BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, |
| BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); |
| coex_sta->run_time_state = false; |
| break; |
| case BT_8822B_2ANT_PHASE_2G_RUNTIME: |
| case BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT: |
| |
| /* set Path control owner to WL at runtime step */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_WLSIDE); |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, |
| 0x66); |
| if (phase == BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT) { |
| /* set GNT_BT to PTA */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, |
| BT_8822B_2ANT_SIG_STA_SET_BY_HW); |
| |
| /* Set GNT_WL to SW High */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| } else { |
| /* set GNT_BT to PTA */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, |
| BT_8822B_2ANT_SIG_STA_SET_BY_HW); |
| |
| /* Set GNT_WL to PTA */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, |
| BT_8822B_2ANT_SIG_STA_SET_BY_HW); |
| } |
| |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], ************* under2g 0xcbd setting =2 *************\n"); |
| |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x03, 02); |
| break; |
| |
| case BT_8822B_2ANT_PHASE_5G_RUNTIME: |
| |
| /* set Path control owner to WL at runtime step */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_WLSIDE); |
| |
| /* set GNT_BT to SW Hi */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| /* Set GNT_WL to SW Hi */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| coex_sta->run_time_state = true; |
| |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], ************* under5g 0xcbd setting =1 *************\n"); |
| |
| btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x03, 01); |
| |
| break; |
| case BT_8822B_2ANT_PHASE_BTMPMODE: |
| /* Disable LTE Coex Function in WiFi side */ |
| halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); |
| |
| /* set Path control owner to WL */ |
| halbtc8822b2ant_ltecoex_pathcontrol_owner( |
| btcoexist, BT_8822B_2ANT_PCO_WLSIDE); |
| |
| /* set GNT_BT to SW Hi */ |
| halbtc8822b2ant_ltecoex_set_gnt_bt( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); |
| |
| /* Set GNT_WL to SW Lo */ |
| halbtc8822b2ant_ltecoex_set_gnt_wl( |
| btcoexist, BT_8822B_2ANT_GNT_BLOCK_RFC_BB, |
| BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, |
| BT_8822B_2ANT_SIG_STA_SET_TO_LOW); |
| |
| coex_sta->run_time_state = false; |
| break; |
| } |
| |
| if (btcoexist->dbg_mode_2ant) { |
| u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, |
| 0x38); |
| u32tmp2 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, |
| 0x54); |
| u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); |
| u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); |
| |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", |
| phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); |
| } |
| } |
| |
| static u8 halbtc8822b2ant_action_algorithm(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| bool bt_hs_on = false; |
| u8 algorithm = BT_8822B_2ANT_COEX_ALGO_UNDEFINED; |
| u8 num_of_diff_profile = 0; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); |
| |
| if (!bt_link_info->bt_link_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], No BT link exists!!!\n"); |
| return algorithm; |
| } |
| |
| if (bt_link_info->sco_exist) |
| num_of_diff_profile++; |
| if (bt_link_info->hid_exist) |
| num_of_diff_profile++; |
| if (bt_link_info->pan_exist) |
| num_of_diff_profile++; |
| if (bt_link_info->a2dp_exist) |
| num_of_diff_profile++; |
| |
| if (num_of_diff_profile == 0) { |
| if (bt_link_info->acl_busy) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], No-Profile busy\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_NOPROFILEBUSY; |
| } |
| } else if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], A2DP Sink\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_A2DPSINK; |
| } else if (num_of_diff_profile == 1) { |
| if (bt_link_info->sco_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], SCO only\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; |
| } else { |
| if (bt_link_info->hid_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], HID only\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_HID; |
| } else if (bt_link_info->a2dp_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], A2DP only\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_A2DP; |
| } else if (bt_link_info->pan_exist) { |
| if (bt_hs_on) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], PAN(HS) only\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANHS; |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], PAN(EDR) only\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR; |
| } |
| } |
| } |
| } else if (num_of_diff_profile == 2) { |
| if (bt_link_info->sco_exist) { |
| if (bt_link_info->hid_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], SCO + HID\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; |
| } else if (bt_link_info->a2dp_exist) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], SCO + A2DP ==> A2DP\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_A2DP; |
| } else if (bt_link_info->pan_exist) { |
| if (bt_hs_on) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + PAN(HS)\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + PAN(EDR)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR; |
| } |
| } |
| } else { |
| if (bt_link_info->hid_exist && |
| bt_link_info->a2dp_exist) { |
| { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], HID + A2DP\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_HID_A2DP; |
| } |
| } else if (bt_link_info->hid_exist && |
| bt_link_info->pan_exist) { |
| if (bt_hs_on) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], HID + PAN(HS)\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_HID; |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], HID + PAN(EDR)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; |
| } |
| } else if (bt_link_info->pan_exist && |
| bt_link_info->a2dp_exist) { |
| if (bt_hs_on) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], A2DP + PAN(HS)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_A2DP_PANHS; |
| } else { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], A2DP + PAN(EDR)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP; |
| } |
| } |
| } |
| } else if (num_of_diff_profile == 3) { |
| if (bt_link_info->sco_exist) { |
| if (bt_link_info->hid_exist && |
| bt_link_info->a2dp_exist) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); |
| algorithm = BT_8822B_2ANT_COEX_ALGO_HID_A2DP; |
| } else if (bt_link_info->hid_exist && |
| bt_link_info->pan_exist) { |
| if (bt_hs_on) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + HID + PAN(HS)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; |
| } else { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + HID + PAN(EDR)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; |
| } |
| } else if (bt_link_info->pan_exist && |
| bt_link_info->a2dp_exist) { |
| if (bt_hs_on) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + A2DP + PAN(HS)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_A2DP_PANHS; |
| } else { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP; |
| } |
| } |
| } else { |
| if (bt_link_info->hid_exist && |
| bt_link_info->pan_exist && |
| bt_link_info->a2dp_exist) { |
| if (bt_hs_on) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], HID + A2DP + PAN(HS)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; |
| } else { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], HID + A2DP + PAN(EDR)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; |
| } |
| } |
| } |
| } else if (num_of_diff_profile >= 3) { |
| if (bt_link_info->sco_exist) { |
| if (bt_link_info->hid_exist && |
| bt_link_info->pan_exist && |
| bt_link_info->a2dp_exist) { |
| if (bt_hs_on) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; |
| } else { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, |
| DBG_LOUD, |
| "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); |
| algorithm = |
| BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; |
| } |
| } |
| } |
| } |
| |
| return algorithm; |
| } |
| |
| static void halbtc8822b2ant_action_coex_all_off(struct btc_coexist *btcoexist) |
| { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); |
| |
| /* fw all off */ |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| } |
| |
| static void halbtc8822b2ant_action_wifi_under5g(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| |
| /* fw all off */ |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], ************* under5g *************\n"); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| |
| halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, |
| BT_8822B_2ANT_PHASE_5G_RUNTIME); |
| } |
| |
| static void |
| halbtc8822b2ant_action_wifi_native_lps(struct btc_coexist *btcoexist) |
| { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } |
| |
| static void halbtc8822b2ant_action_bt_inquiry(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| bool wifi_connected = false; |
| bool wifi_scan = false, wifi_link = false, wifi_roam = false; |
| bool wifi_busy = false; |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, |
| &wifi_connected); |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); |
| |
| if ((coex_sta->bt_create_connection) && |
| ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) || |
| (coex_sta->wifi_is_high_pri_task))) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 15); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 11); |
| } else if ((!wifi_connected) && (!wifi_scan)) { |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n"); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else if (bt_link_info->pan_exist) { |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| } else if (bt_link_info->a2dp_exist) { |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, |
| 10); |
| } else { |
| if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) || |
| (coex_sta->wifi_is_high_pri_task)) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 21); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 23); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| } |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); |
| } |
| |
| static void |
| halbtc8822b2ant_action_wifi_link_process(struct btc_coexist *btcoexist) |
| { |
| struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd4); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| if (bt_link_info->pan_exist) { |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| } else if (bt_link_info->a2dp_exist) { |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| } else { |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| } |
| } |
| |
| static void |
| halbtc8822b2ant_action_wifi_nonconnected(struct btc_coexist *btcoexist) |
| { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| /* fw all off */ |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| } |
| |
| static void halbtc8822b2ant_action_bt_relink(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], run bt multi link function\n"); |
| |
| if (coex_sta->is_bt_multi_link) |
| return; |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "[BTCoex], run bt re-link function\n"); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); |
| } |
| |
| static void halbtc8822b2ant_action_bt_idle(struct btc_coexist *btcoexist) |
| { |
| bool wifi_busy = false; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| |
| if (!wifi_busy) { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); |
| } else { /* if wl busy */ |
| |
| if (BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == |
| coex_dm->bt_status) { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, |
| 0); |
| } else { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 8); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 12); |
| } |
| } |
| |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); |
| } |
| |
| /* SCO only or SCO+PAN(HS) */ |
| static void halbtc8822b2ant_action_sco(struct btc_coexist *btcoexist) |
| { |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false; |
| u32 wifi_bw = 1; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| if (coex_sta->is_esco_mode) |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 1); |
| else /* 2-Ant free run if SCO mode */ |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); |
| } |
| } |
| |
| static void halbtc8822b2ant_action_hid(struct btc_coexist *btcoexist) |
| { |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false; |
| u32 wifi_bw = 1; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| if (coex_sta->is_hid_low_pri_tx_overhead) { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 4); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 108); |
| } else if (wifi_bw == 0) { /* if 11bg mode */ |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 8); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 111); |
| } else { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 8); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 111); |
| } |
| } |
| } |
| |
| static void halbtc8822b2ant_action_a2dpsink(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false, wifi_turbo = false; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, |
| &coex_sta->scan_ap_num); |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", |
| coex_sta->scan_ap_num, coex_sta->wl_noisy_level); |
| |
| if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) |
| wifi_turbo = true; |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && |
| BTC_RSSI_HIGH(bt_rssi_state2)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); |
| |
| if (wifi_busy) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 1); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 16); |
| } else { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = true; |
| |
| if ((coex_sta->bt_relink_downcount != 0) && (wifi_busy)) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, |
| 0); |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 5); |
| |
| } else { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 8); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 105); |
| } |
| } |
| } |
| |
| /* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ |
| static void halbtc8822b2ant_action_a2dp(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false, wifi_turbo = false; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, |
| &coex_sta->scan_ap_num); |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", |
| coex_sta->scan_ap_num, coex_sta->wl_noisy_level); |
| |
| if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) |
| wifi_turbo = true; |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && |
| BTC_RSSI_HIGH(bt_rssi_state2)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); |
| |
| if (wifi_busy) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 1); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 16); |
| } else { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = true; |
| |
| if ((coex_sta->bt_relink_downcount != 0) && (wifi_busy)) { |
| RT_TRACE( |
| rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, |
| 0); |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 5); |
| |
| } else { |
| halbtc8822b2ant_coex_table_with_type(btcoexist, |
| NORMAL_EXEC, 10); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 109); |
| } |
| } |
| } |
| |
| static void halbtc8822b2ant_action_pan_edr(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false, wifi_turbo = false; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, |
| &coex_sta->scan_ap_num); |
| RT_TRACE(rtlpriv, COMP_BT_COEXIST, DBG_LOUD, |
| "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", |
| coex_sta->scan_ap_num, coex_sta->wl_noisy_level); |
| |
| if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) |
| wifi_turbo = true; |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && |
| BTC_RSSI_HIGH(bt_rssi_state2)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); |
| |
| if (wifi_busy) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 3); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 4); |
| } else { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = true; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); |
| |
| if (wifi_busy) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 103); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 104); |
| } |
| } |
| |
| static void halbtc8822b2ant_action_hid_a2dp(struct btc_coexist *btcoexist) |
| { |
| struct rtl_priv *rtlpriv = btcoexist->adapter; |
| static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state, bt_rssi_state; |
| |
| static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; |
| static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; |
| u8 wifi_rssi_state2, bt_rssi_state2; |
| bool wifi_busy = false; |
| u32 wifi_bw = 1; |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); |
| |
| btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); |
| |
| wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state, 2, coex_sta->wifi_coex_thres, |
| 0); |
| |
| wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state( |
| btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2, |
| 0); |
| |
| bt_rssi_state = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state, 2, coex_sta->bt_coex_thres, 0); |
| |
| bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state( |
| btcoexist, &pre_bt_rssi_state2, 2, coex_sta->bt_coex_thres2, 0); |
| |
| if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); |
| } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && |
| BTC_RSSI_HIGH(bt_rssi_state2)) { |
| halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); |
| halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); |
| |
| coex_dm->is_switch_to_1dot5_ant = false; |
| |
| halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); |
| |
| if (wifi_busy) |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, |
| 1); |
| else |
| halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, |