mirror of
https://github.com/aircrack-ng/rtl8812au.git
synced 2024-11-23 05:44:40 +00:00
5412 lines
156 KiB
C
5412 lines
156 KiB
C
|
/* ************************************************************
|
||
|
* Description:
|
||
|
*
|
||
|
* This file is for RTL8723D Co-exist mechanism
|
||
|
*
|
||
|
* History
|
||
|
* 2012/11/15 Cosa first check in.
|
||
|
*
|
||
|
* ************************************************************ */
|
||
|
|
||
|
/* ************************************************************
|
||
|
* include files
|
||
|
* ************************************************************ */
|
||
|
#include "Mp_Precomp.h"
|
||
|
|
||
|
#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1)
|
||
|
|
||
|
#if (RTL8723D_SUPPORT == 1)
|
||
|
/* ************************************************************
|
||
|
* Global variables, these are static variables
|
||
|
* ************************************************************ */
|
||
|
static u8 *trace_buf = &gl_btc_trace_buf[0];
|
||
|
static struct coex_dm_8723d_2ant glcoex_dm_8723d_2ant;
|
||
|
static struct coex_dm_8723d_2ant *coex_dm = &glcoex_dm_8723d_2ant;
|
||
|
static struct coex_sta_8723d_2ant glcoex_sta_8723d_2ant;
|
||
|
static struct coex_sta_8723d_2ant *coex_sta = &glcoex_sta_8723d_2ant;
|
||
|
static struct psdscan_sta_8723d_2ant gl_psd_scan_8723d_2ant;
|
||
|
static struct psdscan_sta_8723d_2ant *psd_scan = &gl_psd_scan_8723d_2ant;
|
||
|
|
||
|
const char *const glbt_info_src_8723d_2ant[] = {
|
||
|
"BT Info[wifi fw]",
|
||
|
"BT Info[bt rsp]",
|
||
|
"BT Info[bt auto report]",
|
||
|
};
|
||
|
|
||
|
u32 glcoex_ver_date_8723d_2ant = 20160218;
|
||
|
u32 glcoex_ver_8723d_2ant = 0x05;
|
||
|
|
||
|
/* ************************************************************
|
||
|
* local function proto type if needed
|
||
|
* ************************************************************
|
||
|
* ************************************************************
|
||
|
* local function start with halbtc8723d2ant_
|
||
|
* ************************************************************ */
|
||
|
u8 halbtc8723d2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num,
|
||
|
u8 rssi_thresh, u8 rssi_thresh1)
|
||
|
{
|
||
|
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_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT Rssi thresh error!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
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_8723D_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_8723D_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;
|
||
|
}
|
||
|
|
||
|
u8 halbtc8723d2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh,
|
||
|
IN u8 rssi_thresh1)
|
||
|
{
|
||
|
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_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], wifi RSSI thresh error!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
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_8723D_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_8723D_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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 isolation_measuared)
|
||
|
{
|
||
|
s8 interference_wl_tx = 0, interference_bt_tx = 0;
|
||
|
|
||
|
|
||
|
interference_wl_tx = BT_8723D_2ANT_WIFI_MAX_TX_POWER - isolation_measuared;
|
||
|
interference_bt_tx = BT_8723D_2ANT_BT_MAX_TX_POWER - isolation_measuared;
|
||
|
|
||
|
|
||
|
|
||
|
coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1;
|
||
|
coex_sta->wifi_coex_thres2 = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2;
|
||
|
|
||
|
coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1;
|
||
|
coex_sta->bt_coex_thres2 = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2;
|
||
|
|
||
|
|
||
|
/*
|
||
|
coex_sta->wifi_coex_thres = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES1;
|
||
|
coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES2;
|
||
|
|
||
|
coex_sta->bt_coex_thres = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES1;
|
||
|
coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES2;
|
||
|
*/
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
/*
|
||
|
if ( BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared -
|
||
|
BT_8723D_2ANT_DEFAULT_ISOLATION) )
|
||
|
coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1;
|
||
|
else
|
||
|
coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared -
|
||
|
BT_8723D_2ANT_DEFAULT_ISOLATION);
|
||
|
|
||
|
if ( BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared -
|
||
|
BT_8723D_2ANT_DEFAULT_ISOLATION) )
|
||
|
coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1;
|
||
|
else
|
||
|
coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared -
|
||
|
BT_8723D_2ANT_DEFAULT_ISOLATION);
|
||
|
|
||
|
*/
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_limited_rx(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN boolean rej_ap_agg_pkt,
|
||
|
IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size)
|
||
|
{
|
||
|
boolean reject_rx_agg = rej_ap_agg_pkt;
|
||
|
boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size;
|
||
|
u8 rx_agg_size = agg_buf_size;
|
||
|
|
||
|
/* ============================================ */
|
||
|
/* Rx Aggregation related setting */
|
||
|
/* ============================================ */
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT,
|
||
|
&reject_rx_agg);
|
||
|
/* decide BT control aggregation buf size or not */
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE,
|
||
|
&bt_ctrl_rx_agg_size);
|
||
|
/* aggregation buf size, only work when BT control Rx aggregation size. */
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size);
|
||
|
/* real update aggregation setting */
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_query_bt_info(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
u8 h2c_parameter[1] = {0};
|
||
|
|
||
|
coex_sta->c2h_bt_info_req_sent = true;
|
||
|
|
||
|
h2c_parameter[0] |= BIT(0); /* trigger */
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_monitor_bt_ctr(IN 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 = 0, cnt_slave = 0;
|
||
|
|
||
|
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->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) {
|
||
|
halbtc8723d2ant_query_bt_info(btcoexist);
|
||
|
num_of_bt_counter_chk = 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
|
||
|
|
||
|
if (coex_sta->under_ips) {
|
||
|
coex_sta->crc_ok_cck = 0;
|
||
|
coex_sta->crc_ok_11g = 0;
|
||
|
coex_sta->crc_ok_11n = 0;
|
||
|
coex_sta->crc_ok_11n_agg = 0;
|
||
|
|
||
|
coex_sta->crc_err_cck = 0;
|
||
|
coex_sta->crc_err_11g = 0;
|
||
|
coex_sta->crc_err_11n = 0;
|
||
|
coex_sta->crc_err_11n_agg = 0;
|
||
|
} else {
|
||
|
coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist,
|
||
|
0xf88);
|
||
|
coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xf94);
|
||
|
coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xf90);
|
||
|
coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xfb8);
|
||
|
|
||
|
coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist,
|
||
|
0xf84);
|
||
|
coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xf96);
|
||
|
coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xf92);
|
||
|
coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xfba);
|
||
|
}
|
||
|
|
||
|
/* reset counter */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1);
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0);
|
||
|
}
|
||
|
|
||
|
|
||
|
boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
static boolean pre_wifi_busy = false, pre_under_4way = false,
|
||
|
pre_bt_hs_on = false, pre_bt_off = false;
|
||
|
static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW;
|
||
|
boolean wifi_busy = false, under_4way = false, bt_hs_on = false;
|
||
|
boolean wifi_connected = false;
|
||
|
u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH;
|
||
|
|
||
|
|
||
|
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)
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is disabled !!\n");
|
||
|
else
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is enabled !!\n");
|
||
|
|
||
|
BTC_TRACE(trace_buf);
|
||
|
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;
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
boolean bt_hs_on = 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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
u8 h2c_parameter[3] = {0};
|
||
|
u32 wifi_bw;
|
||
|
u8 wifi_central_chnl;
|
||
|
|
||
|
/* 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 ((BTC_MEDIA_CONNECT == type) &&
|
||
|
(wifi_central_chnl <= 14)) {
|
||
|
h2c_parameter[0] =
|
||
|
0x1; /* enable BT AFH skip WL channel for 8723d because BT Rx LO interference */
|
||
|
/* h2c_parameter[0] = 0x0; */
|
||
|
h2c_parameter[1] = wifi_central_chnl;
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw);
|
||
|
if (BTC_WIFI_BW_HT40 == wifi_bw)
|
||
|
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);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 dac_swing_lvl)
|
||
|
{
|
||
|
u8 h2c_parameter[1] = {0};
|
||
|
|
||
|
/* 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);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN u8 fw_dac_swing_lvl)
|
||
|
{
|
||
|
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;
|
||
|
}
|
||
|
|
||
|
halbtc8723d2ant_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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 dec_bt_pwr_lvl)
|
||
|
{
|
||
|
u8 h2c_parameter[1] = {0};
|
||
|
|
||
|
h2c_parameter[0] = dec_bt_pwr_lvl;
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN 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;
|
||
|
}
|
||
|
halbtc8723d2ant_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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist
|
||
|
*btcoexist, IN boolean low_penalty_ra)
|
||
|
{
|
||
|
u8 h2c_parameter[6] = {0};
|
||
|
|
||
|
h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */
|
||
|
|
||
|
if (low_penalty_ra) {
|
||
|
h2c_parameter[1] |= BIT(0);
|
||
|
h2c_parameter[2] =
|
||
|
0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */
|
||
|
h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */
|
||
|
h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */
|
||
|
h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */
|
||
|
}
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_low_penalty_ra(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN boolean 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;
|
||
|
}
|
||
|
halbtc8723d2ant_set_fw_low_penalty_ra(btcoexist,
|
||
|
coex_dm->cur_low_penalty_ra);
|
||
|
|
||
|
coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean enable_auto_report)
|
||
|
{
|
||
|
u8 h2c_parameter[1] = {0};
|
||
|
|
||
|
h2c_parameter[0] = 0;
|
||
|
|
||
|
if (enable_auto_report)
|
||
|
h2c_parameter[0] |= BIT(0);
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_bt_auto_report(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN boolean enable_auto_report)
|
||
|
{
|
||
|
coex_dm->cur_bt_auto_report = enable_auto_report;
|
||
|
|
||
|
if (!force_exec) {
|
||
|
if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report)
|
||
|
return;
|
||
|
}
|
||
|
halbtc8723d2ant_set_bt_auto_report(btcoexist,
|
||
|
coex_dm->cur_bt_auto_report);
|
||
|
|
||
|
coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_sw_mechanism1(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean shrink_rx_lpf, IN boolean low_penalty_ra,
|
||
|
IN boolean limited_dig, IN boolean bt_lna_constrain)
|
||
|
{
|
||
|
|
||
|
halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_sw_mechanism2(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean agc_table_shift, IN boolean adc_back_off,
|
||
|
IN boolean sw_dac_swing, IN u32 dac_swing_lvl)
|
||
|
{
|
||
|
/* halbtc8723d2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */
|
||
|
/* halbtc8723d2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_write_score_board(
|
||
|
IN struct btc_coexist *btcoexist,
|
||
|
IN u16 bitpos,
|
||
|
IN BOOLEAN state
|
||
|
)
|
||
|
{
|
||
|
|
||
|
static u16 originalval = 0x8002;
|
||
|
|
||
|
if (state)
|
||
|
originalval = originalval | bitpos;
|
||
|
else
|
||
|
originalval = originalval & (~bitpos);
|
||
|
|
||
|
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_read_score_board(
|
||
|
IN struct btc_coexist *btcoexist,
|
||
|
IN u16 *score_board_val
|
||
|
)
|
||
|
{
|
||
|
|
||
|
*score_board_val = (btcoexist->btc_read_2byte(btcoexist,
|
||
|
0xaa)) & 0x7fff;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_post_activestate_to_bt(
|
||
|
IN struct btc_coexist *btcoexist,
|
||
|
IN boolean wifi_active
|
||
|
)
|
||
|
{
|
||
|
|
||
|
if (wifi_active)
|
||
|
halbtc8723d2ant_write_score_board(btcoexist, (u16) BIT(0), TRUE);
|
||
|
else
|
||
|
halbtc8723d2ant_write_score_board(btcoexist, (u16) BIT(0), FALSE);
|
||
|
|
||
|
/* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_post_onoffstate_to_bt(
|
||
|
IN struct btc_coexist *btcoexist,
|
||
|
IN boolean wifi_on
|
||
|
)
|
||
|
{
|
||
|
|
||
|
if (wifi_on)
|
||
|
halbtc8723d2ant_write_score_board(btcoexist, (u16) BIT(1), TRUE);
|
||
|
else
|
||
|
halbtc8723d2ant_write_score_board(btcoexist, (u16) BIT(1), FALSE);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
static u32 bt_disable_cnt = 0;
|
||
|
boolean bt_active = true, bt_disabled = false;
|
||
|
u16 u16tmp;
|
||
|
|
||
|
/* This function check if bt is disabled */
|
||
|
#if 0
|
||
|
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)
|
||
|
bt_active = false;
|
||
|
if (coex_sta->high_priority_tx == 0xffff &&
|
||
|
coex_sta->high_priority_rx == 0xffff &&
|
||
|
coex_sta->low_priority_tx == 0xffff &&
|
||
|
coex_sta->low_priority_rx == 0xffff)
|
||
|
bt_active = false;
|
||
|
|
||
|
|
||
|
#else
|
||
|
|
||
|
/* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */
|
||
|
halbtc8723d2ant_read_score_board(btcoexist, &u16tmp);
|
||
|
|
||
|
bt_active = u16tmp & BIT(1);
|
||
|
|
||
|
|
||
|
#endif
|
||
|
|
||
|
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 >= 2) {
|
||
|
bt_disabled = true;
|
||
|
bt_disable_cnt = 2;
|
||
|
}
|
||
|
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE,
|
||
|
&bt_disabled);
|
||
|
}
|
||
|
|
||
|
|
||
|
if (coex_sta->bt_disabled != bt_disabled) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is from %s to %s!!\n",
|
||
|
(coex_sta->bt_disabled ? "disabled" : "enabled"),
|
||
|
(bt_disabled ? "disabled" : "enabled"));
|
||
|
BTC_TRACE(trace_buf);
|
||
|
coex_sta->bt_disabled = bt_disabled;
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist,
|
||
|
boolean isenable)
|
||
|
{
|
||
|
|
||
|
if (isenable) {
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1);
|
||
|
|
||
|
/* enable GNT_BT to GPIO debug */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0);
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0);
|
||
|
|
||
|
/* 0x48[20] = 0 for GPIO14 = GNT_WL*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0);
|
||
|
/* 0x40[17] = 0 for GPIO14 = GNT_WL*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0);
|
||
|
|
||
|
/* 0x66[9] = 0 for GPIO15 = GNT_BT*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0);
|
||
|
/* 0x66[7] = 0
|
||
|
for GPIO15 = GNT_BT*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0);
|
||
|
/* 0x8[8] = 0 for GPIO15 = GNT_BT*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0);
|
||
|
|
||
|
/* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/
|
||
|
} else {
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0);
|
||
|
|
||
|
/* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1);
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1);
|
||
|
|
||
|
/* 0x48[20] = 0 for GPIO14 = GNT_WL*/
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1);
|
||
|
}
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist,
|
||
|
IN u16 reg_addr)
|
||
|
{
|
||
|
u32 j = 0;
|
||
|
|
||
|
|
||
|
/* wait for ready bit before access 0x7c0 */
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr);
|
||
|
|
||
|
do {
|
||
|
j++;
|
||
|
} while (((btcoexist->btc_read_1byte(btcoexist,
|
||
|
0x7c3)&BIT(5)) == 0) &&
|
||
|
(j < BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT));
|
||
|
|
||
|
|
||
|
return btcoexist->btc_read_4byte(btcoexist,
|
||
|
0x7c8); /* get read data */
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist,
|
||
|
IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value)
|
||
|
{
|
||
|
u32 val, i = 0, j = 0, bitpos = 0;
|
||
|
|
||
|
|
||
|
if (bit_mask == 0x0)
|
||
|
return;
|
||
|
if (bit_mask == 0xffffffff) {
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x7c4,
|
||
|
reg_value); /* put write data */
|
||
|
|
||
|
/* wait for ready bit before access 0x7c0 */
|
||
|
do {
|
||
|
j++;
|
||
|
} while (((btcoexist->btc_read_1byte(btcoexist,
|
||
|
0x7c3)&BIT(5)) == 0) &&
|
||
|
(j < BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT));
|
||
|
|
||
|
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x7c0,
|
||
|
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 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
reg_addr);
|
||
|
val = (val & (~bit_mask)) | (reg_value << bitpos);
|
||
|
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x7c4,
|
||
|
val); /* put write data */
|
||
|
|
||
|
/* wait for ready bit before access 0x7c0 */
|
||
|
do {
|
||
|
j++;
|
||
|
} while (((btcoexist->btc_read_1byte(btcoexist,
|
||
|
0x7c3)&BIT(5)) == 0) &&
|
||
|
(j < BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT));
|
||
|
|
||
|
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x7c0,
|
||
|
0xc00F0000 | reg_addr);
|
||
|
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_enable(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean enable)
|
||
|
{
|
||
|
u8 val;
|
||
|
|
||
|
val = (enable) ? 1 : 0;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80,
|
||
|
val); /* 0x38[7] */
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean wifi_control)
|
||
|
{
|
||
|
u8 val;
|
||
|
|
||
|
val = (wifi_control) ? 1 : 0;
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4,
|
||
|
val); /* 0x70[26] */
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 control_block, IN boolean sw_control, IN u8 state)
|
||
|
{
|
||
|
u32 val = 0, bit_mask;
|
||
|
|
||
|
state = state & 0x1;
|
||
|
val = (sw_control) ? ((state << 1) | 0x1) : 0;
|
||
|
|
||
|
switch (control_block) {
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_RFC_BB:
|
||
|
default:
|
||
|
bit_mask = 0xc000;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[15:14] */
|
||
|
bit_mask = 0x0c00;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[11:10] */
|
||
|
break;
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_RFC:
|
||
|
bit_mask = 0xc000;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[15:14] */
|
||
|
break;
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_BB:
|
||
|
bit_mask = 0x0c00;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[11:10] */
|
||
|
break;
|
||
|
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 control_block, IN boolean sw_control, IN u8 state)
|
||
|
{
|
||
|
u32 val = 0, bit_mask;
|
||
|
|
||
|
state = state & 0x1;
|
||
|
val = (sw_control) ? ((state << 1) | 0x1) : 0;
|
||
|
|
||
|
switch (control_block) {
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_RFC_BB:
|
||
|
default:
|
||
|
bit_mask = 0x3000;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[13:12] */
|
||
|
bit_mask = 0x0300;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[9:8] */
|
||
|
break;
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_RFC:
|
||
|
bit_mask = 0x3000;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[13:12] */
|
||
|
break;
|
||
|
case BT_8723D_2ANT_GNT_BLOCK_BB:
|
||
|
bit_mask = 0x0300;
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist,
|
||
|
0x38, bit_mask, val); /* 0x38[9:8] */
|
||
|
break;
|
||
|
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 table_type, IN u16 table_content)
|
||
|
{
|
||
|
u16 reg_addr = 0x0000;
|
||
|
|
||
|
switch (table_type) {
|
||
|
case BT_8723D_2ANT_CTT_WL_VS_LTE:
|
||
|
reg_addr = 0xa0;
|
||
|
break;
|
||
|
case BT_8723D_2ANT_CTT_BT_VS_LTE:
|
||
|
reg_addr = 0xa4;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (reg_addr != 0x0000)
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr,
|
||
|
0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 table_type, IN u8 table_content)
|
||
|
{
|
||
|
u16 reg_addr = 0x0000;
|
||
|
|
||
|
switch (table_type) {
|
||
|
case BT_8723D_2ANT_LBTT_WL_BREAK_LTE:
|
||
|
reg_addr = 0xa8;
|
||
|
break;
|
||
|
case BT_8723D_2ANT_LBTT_BT_BREAK_LTE:
|
||
|
reg_addr = 0xac;
|
||
|
break;
|
||
|
case BT_8723D_2ANT_LBTT_LTE_BREAK_WL:
|
||
|
reg_addr = 0xb0;
|
||
|
break;
|
||
|
case BT_8723D_2ANT_LBTT_LTE_BREAK_BT:
|
||
|
reg_addr = 0xb4;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (reg_addr != 0x0000)
|
||
|
halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr,
|
||
|
0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_set_coex_table(IN struct btc_coexist *btcoexist,
|
||
|
IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN 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);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_coex_table(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4,
|
||
|
IN u32 val0x6c8, IN 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;
|
||
|
}
|
||
|
halbtc8723d2ant_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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN u8 type)
|
||
|
{
|
||
|
u32 break_table;
|
||
|
u8 select_table;
|
||
|
|
||
|
coex_sta->coex_table_type = type;
|
||
|
|
||
|
if (coex_sta->concurrent_rx_mode_on == true) {
|
||
|
break_table = 0xf0ffffff; /* set WL hi-pri can break BT */
|
||
|
select_table =
|
||
|
0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */
|
||
|
} else {
|
||
|
break_table = 0xffffff;
|
||
|
select_table = 0x3;
|
||
|
}
|
||
|
|
||
|
switch (type) {
|
||
|
case 0:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0xffffffff, 0xffffffff, break_table, select_table);
|
||
|
break;
|
||
|
case 1:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table);
|
||
|
break;
|
||
|
case 2:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table);
|
||
|
break;
|
||
|
case 3:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0xdafadafa, 0xdafadafa, break_table, select_table);
|
||
|
break;
|
||
|
case 4:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0xddffddff, 0xffbbffbb, break_table, select_table);
|
||
|
break;
|
||
|
case 5:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0x5fff5fff, 0x5fff5fff, break_table, select_table);
|
||
|
break;
|
||
|
case 6:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0x55ff55ff, 0x5a5a5a5a, break_table, select_table);
|
||
|
break;
|
||
|
case 7:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0x5aff55ff, 0x5a7a5a7a, break_table, select_table);
|
||
|
break;
|
||
|
case 8:
|
||
|
halbtc8723d2ant_coex_table(btcoexist, force_exec,
|
||
|
0x55555555, 0xaaaaaaaa, break_table, select_table);
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean enable)
|
||
|
{
|
||
|
u8 h2c_parameter[1] = {0};
|
||
|
|
||
|
if (enable)
|
||
|
h2c_parameter[0] |= BIT(0); /* function enable */
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN boolean 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;
|
||
|
}
|
||
|
halbtc8723d2ant_set_fw_ignore_wlan_act(btcoexist, enable);
|
||
|
|
||
|
coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 lps_val, IN 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);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_lps_rpwm(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN u8 lps_val, IN 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;
|
||
|
}
|
||
|
halbtc8723d2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val);
|
||
|
|
||
|
coex_dm->pre_lps = coex_dm->cur_lps;
|
||
|
coex_dm->pre_rpwm = coex_dm->cur_rpwm;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ps_tdma_check_for_power_save_state(
|
||
|
IN struct btc_coexist *btcoexist, IN boolean new_ps_state)
|
||
|
{
|
||
|
u8 lps_mode = 0x0;
|
||
|
u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0};
|
||
|
|
||
|
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 */
|
||
|
/*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false,
|
||
|
8); */
|
||
|
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 */
|
||
|
/*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false,
|
||
|
8);*/
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter);
|
||
|
} else {
|
||
|
/* keep state under NO PS state, do nothing. */
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_power_save_state(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val)
|
||
|
{
|
||
|
boolean low_pwr_disable = false;
|
||
|
|
||
|
switch (ps_type) {
|
||
|
case BTC_PS_WIFI_NATIVE:
|
||
|
/* recover to original 32k low power setting */
|
||
|
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);
|
||
|
coex_sta->force_lps_on = false;
|
||
|
break;
|
||
|
case BTC_PS_LPS_ON:
|
||
|
halbtc8723d2ant_ps_tdma_check_for_power_save_state(
|
||
|
btcoexist, true);
|
||
|
halbtc8723d2ant_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);
|
||
|
coex_sta->force_lps_on = true;
|
||
|
break;
|
||
|
case BTC_PS_LPS_OFF:
|
||
|
halbtc8723d2ant_ps_tdma_check_for_power_save_state(
|
||
|
btcoexist, false);
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS,
|
||
|
NULL);
|
||
|
coex_sta->force_lps_on = false;
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5)
|
||
|
{
|
||
|
u8 h2c_parameter[5] = {0};
|
||
|
u8 real_byte1 = byte1, real_byte5 = byte5;
|
||
|
boolean ap_enable = false;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE,
|
||
|
&ap_enable);
|
||
|
|
||
|
if (ap_enable) {
|
||
|
if (byte1 & BIT(4) && !(byte1 & BIT(5))) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], FW for 1Ant AP mode\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
real_byte1 &= ~BIT(4);
|
||
|
real_byte1 |= BIT(5);
|
||
|
|
||
|
real_byte5 |= BIT(5);
|
||
|
real_byte5 &= ~BIT(6);
|
||
|
|
||
|
halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,
|
||
|
0x0);
|
||
|
}
|
||
|
} else if (byte1 & BIT(4) && !(byte1 & BIT(5))) {
|
||
|
|
||
|
halbtc8723d2ant_power_save_state(
|
||
|
btcoexist, BTC_PS_LPS_ON, 0x50,
|
||
|
0x4);
|
||
|
} else {
|
||
|
halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0,
|
||
|
0x0);
|
||
|
}
|
||
|
|
||
|
|
||
|
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);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean force_exec, IN boolean turn_on, IN u8 type)
|
||
|
{
|
||
|
|
||
|
static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0;
|
||
|
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) && (bt_link_info->a2dp_exist))
|
||
|
psTdmaByte4Modify = 0x1;
|
||
|
else
|
||
|
psTdmaByte4Modify = 0x0;
|
||
|
|
||
|
if (pre_psTdmaByte4Modify != psTdmaByte4Modify) {
|
||
|
|
||
|
force_exec = true;
|
||
|
pre_psTdmaByte4Modify = psTdmaByte4Modify;
|
||
|
}
|
||
|
|
||
|
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))
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], %s turn %s PS TDMA, type=%d\n",
|
||
|
(force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
|
||
|
if (turn_on) {
|
||
|
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8,
|
||
|
0x1); /* enable TBTT nterrupt */
|
||
|
}
|
||
|
|
||
|
|
||
|
if (turn_on) {
|
||
|
switch (type) {
|
||
|
case 1:
|
||
|
default:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x10, 0x03, 0xf1,
|
||
|
0x14 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 2:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x35, 0x03, 0x71,
|
||
|
0x11 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 3:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x3a, 0x3, 0xf1,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 4:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x21, 0x3, 0xf1,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 5:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x30, 0x3, 0xf1,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 6:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x1c, 0x3, 0xf1,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 7:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x25, 0x3, 0xf1,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 11:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x30, 0x03, 0x71,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 12:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x21, 0x03, 0x71,
|
||
|
0x11 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 13:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x1c, 0x03, 0x71,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 101:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x10, 0x03, 0x70,
|
||
|
0x14 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 102:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xe3,
|
||
|
0x35, 0x03, 0x71,
|
||
|
0x11 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 103:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x3a, 0x3, 0x70,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 104:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x21, 0x3, 0x70,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 105:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x30, 0x3, 0x70,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 106:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x1c, 0x3, 0x70,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
case 107:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0xd3,
|
||
|
0x25, 0x3, 0x70,
|
||
|
0x10 | psTdmaByte4Modify);
|
||
|
break;
|
||
|
|
||
|
|
||
|
}
|
||
|
} else {
|
||
|
/* disable PS tdma */
|
||
|
switch (type) {
|
||
|
case 0:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
|
||
|
0x0, 0x0, 0x40, 0x0);
|
||
|
break;
|
||
|
case 1:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
|
||
|
0x0, 0x0, 0x48, 0x0);
|
||
|
break;
|
||
|
default:
|
||
|
halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0,
|
||
|
0x0, 0x0, 0x40, 0x0);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* 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;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off)
|
||
|
{
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
u32 u32tmp = 0;
|
||
|
boolean pg_ext_switch = false;
|
||
|
u8 h2c_parameter[2] = {0}, u8tmp0 = 0;
|
||
|
boolean is_in_mp_mode = false;
|
||
|
u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0;
|
||
|
u16 u16tmp0 = 0;
|
||
|
|
||
|
|
||
|
if (init_hwcfg) {
|
||
|
|
||
|
/* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */
|
||
|
halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
|
||
|
|
||
|
/* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */
|
||
|
halbtc8723d2ant_ltecoex_set_coex_table(btcoexist,
|
||
|
BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff);
|
||
|
|
||
|
/* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */
|
||
|
halbtc8723d2ant_ltecoex_set_coex_table(btcoexist,
|
||
|
BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff);
|
||
|
|
||
|
/* Set Path control to WL */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);
|
||
|
|
||
|
/* set Path control owner to WL at initial step */
|
||
|
halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist,
|
||
|
BT_8723D_1ANT_PCO_WLSIDE);
|
||
|
|
||
|
/* set GNT_BT to high */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
|
||
|
/* Set GNT_WL to high */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
|
||
|
|
||
|
/* Send antenna info (inverse, non-inverse, Int/Ext) to Firmware */
|
||
|
if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) {
|
||
|
/* tell firmware "no antenna inverse" */
|
||
|
h2c_parameter[0] = 0;
|
||
|
} else {
|
||
|
/* tell firmware "antenna inverse" */
|
||
|
h2c_parameter[0] = 1;
|
||
|
}
|
||
|
|
||
|
/* int switch type */
|
||
|
h2c_parameter[1] = 0;
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter);
|
||
|
|
||
|
coex_sta->gnt_control_by_PTA = false;
|
||
|
} else if (wifi_off) {
|
||
|
/* Disable LTE Coex Function in WiFi side */
|
||
|
halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0);
|
||
|
|
||
|
/* Set Path control to BT */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x0);
|
||
|
|
||
|
halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist,
|
||
|
BT_8723D_1ANT_PCO_BTSIDE);/* set Path control owner to BT */
|
||
|
|
||
|
coex_sta->gnt_control_by_PTA = false;
|
||
|
} else {
|
||
|
|
||
|
/* set GNT_BT to PTA */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_BY_HW);
|
||
|
/* Set GNT_WL to PTA */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_BY_HW);
|
||
|
|
||
|
coex_sta->gnt_control_by_PTA = true;
|
||
|
}
|
||
|
|
||
|
switch (ant_pos_type) {
|
||
|
case BTC_ANT_WIFI_AT_MAIN:
|
||
|
u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0x948);
|
||
|
if ((u16tmp0 == 0x140) || (u16tmp0 == 0x40))
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x948, u16tmp0);
|
||
|
else
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0);
|
||
|
break;
|
||
|
case BTC_ANT_WIFI_AT_AUX:
|
||
|
u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0x948);
|
||
|
if ((u16tmp0 == 0x140) || (u16tmp0 == 0x40))
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x948, u16tmp0);
|
||
|
else
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x948, 0x280);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
|
||
|
u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67);
|
||
|
u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0x948);
|
||
|
u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70);
|
||
|
u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
|
||
|
u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (After Set Ant Path) **********\n",
|
||
|
u8tmp0, u16tmp0, u32tmp0, u32tmp1, u32tmp2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
}
|
||
|
|
||
|
u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
boolean bt_hs_on = false;
|
||
|
u8 algorithm = BT_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], No BT link exists!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], No-Profile busy\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY;
|
||
|
}
|
||
|
} else if (num_of_diff_profile == 1) {
|
||
|
if (bt_link_info->sco_exist) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO only\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
|
||
|
} else {
|
||
|
if (bt_link_info->hid_exist) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID only\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_HID;
|
||
|
} else if (bt_link_info->a2dp_exist) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], A2DP only\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP;
|
||
|
} else if (bt_link_info->pan_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], PAN(HS) only\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANHS;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], PAN(EDR) only\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANEDR;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
} else if (num_of_diff_profile == 2) {
|
||
|
if (bt_link_info->sco_exist) {
|
||
|
if (bt_link_info->hid_exist) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + HID\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
|
||
|
} else if (bt_link_info->a2dp_exist) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + A2DP ==> A2DP\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_A2DP;
|
||
|
} else if (bt_link_info->pan_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_SCO;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + PAN(EDR)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_PANEDR;
|
||
|
}
|
||
|
}
|
||
|
} else {
|
||
|
if (bt_link_info->hid_exist &&
|
||
|
bt_link_info->a2dp_exist) {
|
||
|
{
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID + A2DP\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_HID_A2DP;
|
||
|
}
|
||
|
} else if (bt_link_info->hid_exist &&
|
||
|
bt_link_info->pan_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_HID;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID + PAN(EDR)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
|
||
|
}
|
||
|
} else if (bt_link_info->pan_exist &&
|
||
|
bt_link_info->a2dp_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], A2DP + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], A2DP + PAN(EDR)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm = BT_8723D_2ANT_COEX_ALGO_HID_A2DP;
|
||
|
} else if (bt_link_info->hid_exist &&
|
||
|
bt_link_info->pan_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + HID + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + HID + PAN(EDR)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANEDR_HID;
|
||
|
}
|
||
|
} else if (bt_link_info->pan_exist &&
|
||
|
bt_link_info->a2dp_exist) {
|
||
|
if (bt_hs_on) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + A2DP + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID + A2DP + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], HID + A2DP + PAN(EDR)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_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) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
algorithm =
|
||
|
BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return algorithm;
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* fw all off */
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* sw all off */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_init_coex_dm(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* fw all off */
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* sw all off */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
coex_sta->pop_event_cnt = 0;
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
|
||
|
boolean wifi_connected = false;
|
||
|
boolean scan = false, link = false, roam = false;
|
||
|
boolean 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, &scan);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
|
||
|
|
||
|
if (link || roam || coex_sta->wifi_is_high_pri_task) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi link/roam/hi-pri-task process + BT Inq/Page!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
8);
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11);
|
||
|
|
||
|
} else if (scan) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi scan process + BT Inq/Page!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
8);
|
||
|
|
||
|
if (coex_sta->bt_create_connection)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 12);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11);
|
||
|
|
||
|
} else if (wifi_connected) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi connected + BT Inq/Page!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
7);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11);
|
||
|
|
||
|
} else
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13);
|
||
|
} else {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi no-link + BT Inq/Page!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
u32 u32tmp, u32tmpb;
|
||
|
u8 u8tmpa;
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11);
|
||
|
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* fw all off */
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* sw all off */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_bt_idle(IN 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;
|
||
|
|
||
|
boolean wifi_connected = false;
|
||
|
boolean scan = false, link = false, roam = false;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
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, &scan);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
|
||
|
|
||
|
if (scan || link || roam) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi link process + BT Idle!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
7);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11);
|
||
|
} else if (wifi_connected) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi connected + BT Idle!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
if (!BTC_RSSI_HIGH(bt_rssi_state2))
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
2);
|
||
|
else
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
0);
|
||
|
} else {
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
0);
|
||
|
}
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Wifi no-link + BT Idle!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC,
|
||
|
0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* SCO only or SCO+PAN(HS) */
|
||
|
void halbtc8723d2ant_action_sco(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_hid(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */
|
||
|
void halbtc8723d2ant_action_a2dp(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1);
|
||
|
else
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102);
|
||
|
|
||
|
}
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_pan_edr(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
#if 0
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
#endif
|
||
|
|
||
|
|
||
|
#if 1
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104);
|
||
|
|
||
|
}
|
||
|
|
||
|
#endif
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* PAN(HS) only */
|
||
|
void halbtc8723d2ant_action_pan_hs(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
|
||
|
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_hid_a2dp(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2);
|
||
|
|
||
|
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_a2dp_pan_hs(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6);
|
||
|
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
/* PAN(EDR)+A2DP */
|
||
|
void halbtc8723d2ant_action_pan_edr_a2dp(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_pan_edr_hid(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3);
|
||
|
else
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4);
|
||
|
|
||
|
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy)
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103);
|
||
|
else
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
/* HID+A2DP+PAN(EDR) */
|
||
|
void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN 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;
|
||
|
boolean wifi_busy = false;
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy);
|
||
|
|
||
|
wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state, 2,
|
||
|
coex_sta->wifi_coex_thres , 0);
|
||
|
|
||
|
wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist,
|
||
|
&prewifi_rssi_state2, 2,
|
||
|
coex_sta->wifi_coex_thres2 , 0);
|
||
|
|
||
|
bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2,
|
||
|
coex_sta->bt_coex_thres , 0);
|
||
|
|
||
|
bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2,
|
||
|
coex_sta->bt_coex_thres2 , 0);
|
||
|
|
||
|
|
||
|
if (BTC_RSSI_HIGH(wifi_rssi_state) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
} else if (BTC_RSSI_HIGH(wifi_rssi_state2) &&
|
||
|
BTC_RSSI_HIGH(bt_rssi_state2)) {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = false;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6);
|
||
|
} else {
|
||
|
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
coex_dm->is_switch_to_1dot5_ant = true;
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7);
|
||
|
|
||
|
if (wifi_busy) {
|
||
|
|
||
|
if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255))
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107);
|
||
|
else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105);
|
||
|
} else
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106);
|
||
|
}
|
||
|
|
||
|
/* sw mechanism */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, true,
|
||
|
false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false,
|
||
|
false, 0x18);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
void halbtc8723d2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* sw mechanism all off */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18);
|
||
|
halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
/* sw mechanism all off */
|
||
|
halbtc8723d2ant_sw_mechanism1(btcoexist, false, false, false, false);
|
||
|
halbtc8723d2ant_sw_mechanism2(btcoexist, false, false, false, 0x18);
|
||
|
|
||
|
/* hw all off */
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
u8 algorithm = 0;
|
||
|
u32 num_of_wifi_link = 0;
|
||
|
u32 wifi_link_status = 0;
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
boolean miracast_plus_bt = false;
|
||
|
boolean scan = false, link = false, roam = false, wifi_connected = false;
|
||
|
|
||
|
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], RunCoexistMechanism()===>\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (btcoexist->manual_control) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (btcoexist->stop_coex_dm) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (coex_sta->under_ips) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], wifi is under IPS !!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (coex_sta->bt_whck_test) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is under WHCK TEST!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_bt_whck_test(btcoexist);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (coex_sta->bt_disabled) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is disabled!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_coex_all_off(btcoexist);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (coex_sta->c2h_bt_inquiry_page) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT is under inquiry/page scan !!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_bt_inquiry(btcoexist);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
|
||
|
|
||
|
if (scan || link || roam) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], WiFi is under Link Process !!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_wifi_link_process(btcoexist);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
/* for P2P */
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS,
|
||
|
&wifi_link_status);
|
||
|
num_of_wifi_link = wifi_link_status >> 16;
|
||
|
|
||
|
if ((num_of_wifi_link >= 2) ||
|
||
|
(wifi_link_status & WIFI_P2P_GO_CONNECTED)) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n",
|
||
|
num_of_wifi_link, wifi_link_status);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (bt_link_info->bt_link_exist)
|
||
|
miracast_plus_bt = true;
|
||
|
else
|
||
|
miracast_plus_bt = false;
|
||
|
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,
|
||
|
&miracast_plus_bt);
|
||
|
halbtc8723d2ant_action_wifi_multi_port(btcoexist);
|
||
|
|
||
|
return;
|
||
|
} else {
|
||
|
miracast_plus_bt = false;
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT,
|
||
|
&miracast_plus_bt);
|
||
|
}
|
||
|
|
||
|
|
||
|
algorithm = halbtc8723d2ant_action_algorithm(btcoexist);
|
||
|
coex_dm->cur_algorithm = algorithm;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n",
|
||
|
coex_dm->cur_algorithm);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
|
||
|
&wifi_connected);
|
||
|
|
||
|
if (!wifi_connected) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, wifi non-connected!!.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_wifi_nonconnected(btcoexist);
|
||
|
|
||
|
} else if ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE ==
|
||
|
coex_dm->bt_status) || (BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE ==
|
||
|
coex_dm->bt_status)) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, bt idle!!.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_action_bt_idle(btcoexist);
|
||
|
|
||
|
} else {
|
||
|
|
||
|
if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n",
|
||
|
coex_dm->pre_algorithm, coex_dm->cur_algorithm);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
switch (coex_dm->cur_algorithm) {
|
||
|
|
||
|
case BT_8723D_2ANT_COEX_ALGO_SCO:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = SCO.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_sco(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_HID:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = HID.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_hid(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_A2DP:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = A2DP.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_a2dp(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_a2dp_pan_hs(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_PANEDR:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_pan_edr(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_PANHS:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = HS mode.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_pan_hs(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_pan_edr_a2dp(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_PANEDR_HID:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_pan_edr_hid(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_hid_a2dp_pan_edr(
|
||
|
btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_HID_A2DP:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_hid_a2dp(btcoexist);
|
||
|
break;
|
||
|
case BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_bt_idle(btcoexist);
|
||
|
break;
|
||
|
default:
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_action_coex_all_off(btcoexist);
|
||
|
break;
|
||
|
}
|
||
|
coex_dm->pre_algorithm = coex_dm->cur_algorithm;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean wifi_only)
|
||
|
{
|
||
|
u8 u8tmp = 0;
|
||
|
u32 vendor;
|
||
|
u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0;
|
||
|
|
||
|
|
||
|
u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x67);
|
||
|
u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70);
|
||
|
u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
|
||
|
u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** 0x67 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Init HW config) **********\n",
|
||
|
u8tmp, u32tmp0, u32tmp1, u32tmp2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], 2Ant Init HW Config!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
#if 0
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor);
|
||
|
if (vendor == BTC_VENDOR_LENOVO)
|
||
|
coex_dm->switch_thres_offset = 0;
|
||
|
else
|
||
|
coex_dm->switch_thres_offset = 20;
|
||
|
#endif
|
||
|
/* 0xf0[15:12] --> Chip Cut information */
|
||
|
coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist,
|
||
|
0xf1) & 0xf0) >> 4;
|
||
|
|
||
|
coex_sta->dis_ver_info_cnt = 0;
|
||
|
|
||
|
/* default isolation = 15dB */
|
||
|
coex_sta->isolation_btween_wb = BT_8723D_2ANT_DEFAULT_ISOLATION;
|
||
|
halbtc8723d2ant_coex_switch_threshold(btcoexist, coex_sta->isolation_btween_wb);
|
||
|
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8,
|
||
|
0x1); /* enable TBTT nterrupt */
|
||
|
|
||
|
/* BT report packet sample rate */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5);
|
||
|
|
||
|
/* Init 0x778 = 0x1 for 2-Ant */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1);
|
||
|
|
||
|
/* Enable PTA (3-wire function form BT side) */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1);
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1);
|
||
|
|
||
|
/* Enable PTA (tx/rx signal form WiFi side) */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1);
|
||
|
|
||
|
halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, FALSE);
|
||
|
|
||
|
/* check if WL firmware download ok */
|
||
|
if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, true);
|
||
|
|
||
|
/* Enable counter statistics */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x76e,
|
||
|
0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */
|
||
|
|
||
|
if (wifi_only) {
|
||
|
coex_sta->concurrent_rx_mode_on = false;
|
||
|
/* Path config */
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true,
|
||
|
false);
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
false);
|
||
|
} else {
|
||
|
/* coex_sta->concurrent_rx_mode_on = true; */
|
||
|
/* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */
|
||
|
|
||
|
/* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0);
|
||
|
|
||
|
/* Path config */
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true,
|
||
|
false);
|
||
|
}
|
||
|
|
||
|
/* WLAN_Tx by GNT_WL 0x950[29] = 0 */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0);
|
||
|
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0);
|
||
|
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0);
|
||
|
|
||
|
u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x67);
|
||
|
u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70);
|
||
|
u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
|
||
|
u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** 0x67 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (After Init HW config) **********\n",
|
||
|
u8tmp, u32tmp0, u32tmp1, u32tmp2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
psd_scan->ant_det_is_ant_det_available = TRUE;
|
||
|
|
||
|
}
|
||
|
|
||
|
u32 halbtc8723d2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val)
|
||
|
{
|
||
|
u8 j;
|
||
|
u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0;
|
||
|
u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200,
|
||
|
174, 151, 132, 115, 100, 86, 74, 62, 51, 42,
|
||
|
32, 23, 15, 7, 0
|
||
|
};
|
||
|
|
||
|
if (val == 0)
|
||
|
return 0;
|
||
|
|
||
|
tmp = val;
|
||
|
|
||
|
while (1) {
|
||
|
if (tmp == 1)
|
||
|
break;
|
||
|
else {
|
||
|
tmp = (tmp >> 1);
|
||
|
shiftcount++;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
val_integerd_b = shiftcount + 1;
|
||
|
|
||
|
tmp2 = 1;
|
||
|
for (j = 1; j <= val_integerd_b; j++)
|
||
|
tmp2 = tmp2 * 2;
|
||
|
|
||
|
tmp = (val * 100) / tmp2;
|
||
|
tindex = tmp / 5;
|
||
|
|
||
|
if (tindex > 20)
|
||
|
tindex = 20;
|
||
|
|
||
|
val_fractiond_b = table_fraction[tindex];
|
||
|
|
||
|
result = val_integerd_b * 100 - val_fractiond_b;
|
||
|
|
||
|
return result;
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_psd_show_antenna_detect_result(IN struct btc_coexist
|
||
|
*btcoexist)
|
||
|
{
|
||
|
u8 *cli_buf = btcoexist->cli_buf;
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n============[Antenna Detection info] ============\n");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (psd_scan->ant_det_result == 1)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)",
|
||
|
"Ant Det Result", "2-Antenna (Bad-Isolation)",
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
|
||
|
else if (psd_scan->ant_det_result == 2)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",
|
||
|
"Ant Det Result", "2-Antenna (Good-Isolation)",
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
|
||
|
+ psd_scan->ant_det_thres_offset,
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)",
|
||
|
"Ant Det Result", "1-Antenna",
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT,
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
|
||
|
+ psd_scan->ant_det_thres_offset);
|
||
|
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ",
|
||
|
"Antenna Detection Finish",
|
||
|
(board_info->btdm_ant_det_finish
|
||
|
? "Yes" : "No"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
switch (psd_scan->ant_det_result) {
|
||
|
case 0:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is not available)");
|
||
|
break;
|
||
|
case 1: /* 2-Ant bad-isolation */
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is available)");
|
||
|
break;
|
||
|
case 2: /* 2-Ant good-isolation */
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is available)");
|
||
|
break;
|
||
|
case 3: /* 1-Ant */
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is available)");
|
||
|
break;
|
||
|
case 4:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(Uncertainty result)");
|
||
|
break;
|
||
|
case 5:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)");
|
||
|
break;
|
||
|
case 6:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(WiFi is Scanning)");
|
||
|
break;
|
||
|
case 7:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is not idle)");
|
||
|
break;
|
||
|
case 8:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(Abort by WiFi Scanning)");
|
||
|
break;
|
||
|
case 9:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(Antenna Init is not ready)");
|
||
|
break;
|
||
|
case 10:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is Inquiry or page)");
|
||
|
break;
|
||
|
case 11:
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"(BT is Disabled)");
|
||
|
break;
|
||
|
}
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
|
||
|
"Ant Detect Total Count", psd_scan->ant_det_try_count);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
|
||
|
"Ant Detect Fail Count", psd_scan->ant_det_fail_count);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if ((!board_info->btdm_ant_det_finish) &&
|
||
|
(psd_scan->ant_det_result != 5))
|
||
|
return;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response",
|
||
|
(psd_scan->ant_det_result ? "ok" : "fail"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time",
|
||
|
psd_scan->ant_det_bt_tx_time);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch",
|
||
|
psd_scan->ant_det_bt_le_channel);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d",
|
||
|
"WiFi PSD Cent-Ch/Offset/Span",
|
||
|
psd_scan->real_cent_freq, psd_scan->real_offset,
|
||
|
psd_scan->real_span);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB",
|
||
|
"PSD Pre-Scan Peak Value",
|
||
|
psd_scan->ant_det_pre_psdscan_peak_val / 100);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)",
|
||
|
"PSD Pre-Scan result",
|
||
|
(psd_scan->ant_det_result != 5 ? "ok" : "fail"),
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
|
||
|
+ psd_scan->ant_det_thres_offset);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (psd_scan->ant_det_result == 5)
|
||
|
return;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB",
|
||
|
"PSD Scan Peak Value", psd_scan->ant_det_peak_val);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz",
|
||
|
"PSD Scan Peak Freq", psd_scan->ant_det_peak_freq);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package",
|
||
|
(board_info->tfbga_package) ? "Yes" : "No");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
|
||
|
"PSD Threshold Offset", psd_scan->ant_det_thres_offset);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_psd_showdata(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
u8 *cli_buf = btcoexist->cli_buf;
|
||
|
u32 delta_freq_per_point;
|
||
|
u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n\n============[PSD info] (%d)============\n",
|
||
|
psd_scan->psd_gen_count);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (psd_scan->psd_gen_count == 0) {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (psd_scan->psd_point == 0)
|
||
|
delta_freq_per_point = 0;
|
||
|
else
|
||
|
delta_freq_per_point = psd_scan->psd_band_width /
|
||
|
psd_scan->psd_point;
|
||
|
|
||
|
/* if (psd_scan->is_psd_show_max_only) */
|
||
|
if (0) {
|
||
|
psd_rep1 = psd_scan->psd_max_value / 100;
|
||
|
psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100;
|
||
|
|
||
|
freq = ((psd_scan->real_cent_freq - 20) * 1000000 +
|
||
|
psd_scan->psd_max_value_point * delta_freq_per_point);
|
||
|
freq1 = freq / 1000000;
|
||
|
freq2 = freq / 1000 - freq1 * 1000;
|
||
|
|
||
|
if (freq2 < 100)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Freq = %d.0%d MHz",
|
||
|
freq1, freq2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Freq = %d.%d MHz",
|
||
|
freq1, freq2);
|
||
|
|
||
|
if (psd_rep2 < 10)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
", Value = %d.0%d dB, (%d)\n",
|
||
|
psd_rep1, psd_rep2, psd_scan->psd_max_value);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
", Value = %d.%d dB, (%d)\n",
|
||
|
psd_rep1, psd_rep2, psd_scan->psd_max_value);
|
||
|
|
||
|
CL_PRINTF(cli_buf);
|
||
|
} else {
|
||
|
m = psd_scan->psd_start_point;
|
||
|
n = psd_scan->psd_start_point;
|
||
|
i = 1;
|
||
|
j = 1;
|
||
|
|
||
|
while (1) {
|
||
|
do {
|
||
|
freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m *
|
||
|
delta_freq_per_point);
|
||
|
freq1 = freq / 1000000;
|
||
|
freq2 = freq / 1000 - freq1 * 1000;
|
||
|
|
||
|
if (i == 1) {
|
||
|
if (freq2 == 0)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Freq%6d.000", freq1);
|
||
|
else if (freq2 < 100)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Freq%6d.0%2d", freq1,
|
||
|
freq2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Freq%6d.%3d", freq1,
|
||
|
freq2);
|
||
|
} else if ((i % 8 == 0) ||
|
||
|
(m == psd_scan->psd_stop_point)) {
|
||
|
if (freq2 == 0)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.000\n", freq1);
|
||
|
else if (freq2 < 100)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.0%2d\n", freq1, freq2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.%3d\n", freq1, freq2);
|
||
|
} else {
|
||
|
if (freq2 == 0)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.000", freq1);
|
||
|
else if (freq2 < 100)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.0%2d", freq1, freq2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%6d.%3d", freq1, freq2);
|
||
|
}
|
||
|
|
||
|
i++;
|
||
|
m++;
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
} while ((i <= 8) && (m <= psd_scan->psd_stop_point));
|
||
|
|
||
|
|
||
|
do {
|
||
|
psd_rep1 = psd_scan->psd_report_max_hold[n] / 100;
|
||
|
psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 *
|
||
|
100;
|
||
|
|
||
|
if (j == 1) {
|
||
|
if (psd_rep2 < 10)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Val %7d.0%d", psd_rep1,
|
||
|
psd_rep2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n Val %7d.%d", psd_rep1,
|
||
|
psd_rep2);
|
||
|
} else if ((j % 8 == 0) ||
|
||
|
(n == psd_scan->psd_stop_point)) {
|
||
|
if (psd_rep2 < 10)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%7d.0%d\n", psd_rep1,
|
||
|
psd_rep2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%7d.%d\n", psd_rep1, psd_rep2);
|
||
|
} else {
|
||
|
if (psd_rep2 < 10)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%7d.0%d", psd_rep1, psd_rep2);
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"%7d.%d", psd_rep1, psd_rep2);
|
||
|
}
|
||
|
|
||
|
j++;
|
||
|
n++;
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
} while ((j <= 8) && (n <= psd_scan->psd_stop_point));
|
||
|
|
||
|
if ((m > psd_scan->psd_stop_point) ||
|
||
|
(n > psd_scan->psd_stop_point))
|
||
|
break;
|
||
|
else {
|
||
|
i = 1;
|
||
|
j = 1;
|
||
|
}
|
||
|
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_psd_maxholddata(IN struct btc_coexist *btcoexist,
|
||
|
IN u32 gen_count)
|
||
|
{
|
||
|
u32 i = 0, i_max = 0, val_max = 0;
|
||
|
|
||
|
if (gen_count == 1) {
|
||
|
memcpy(psd_scan->psd_report_max_hold,
|
||
|
psd_scan->psd_report,
|
||
|
BT_8723D_2ANT_ANTDET_PSD_POINTS * sizeof(u32));
|
||
|
|
||
|
psd_scan->psd_max_value_point = 0;
|
||
|
psd_scan->psd_max_value = 0;
|
||
|
|
||
|
} else {
|
||
|
for (i = psd_scan->psd_start_point;
|
||
|
i <= psd_scan->psd_stop_point; i++) {
|
||
|
if (psd_scan->psd_report[i] >
|
||
|
psd_scan->psd_report_max_hold[i])
|
||
|
psd_scan->psd_report_max_hold[i] =
|
||
|
psd_scan->psd_report[i];
|
||
|
|
||
|
/* search Max Value */
|
||
|
if (i == psd_scan->psd_start_point) {
|
||
|
i_max = i;
|
||
|
val_max = psd_scan->psd_report_max_hold[i];
|
||
|
} else {
|
||
|
if (psd_scan->psd_report_max_hold[i] >
|
||
|
val_max) {
|
||
|
i_max = i;
|
||
|
val_max = psd_scan->psd_report_max_hold[i];
|
||
|
}
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
psd_scan->psd_max_value_point = i_max;
|
||
|
psd_scan->psd_max_value = val_max;
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
u32 halbtc8723d2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point)
|
||
|
{
|
||
|
/* reg 0x808[9:0]: FFT data x */
|
||
|
/* reg 0x808[22]: 0-->1 to get 1 FFT data y */
|
||
|
/* reg 0x8b4[15:0]: FFT data y report */
|
||
|
|
||
|
u32 val = 0, psd_report = 0;
|
||
|
int k = 0;
|
||
|
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x808);
|
||
|
|
||
|
val &= 0xffbffc00;
|
||
|
val |= point;
|
||
|
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x808, val);
|
||
|
|
||
|
val |= 0x00400000;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x808, val);
|
||
|
|
||
|
while (1) {
|
||
|
if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x8b4);
|
||
|
|
||
|
psd_report = val & 0x0000ffff;
|
||
|
|
||
|
return psd_report;
|
||
|
}
|
||
|
|
||
|
|
||
|
boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist,
|
||
|
IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points,
|
||
|
IN u32 avgnum, IN u32 loopcnt)
|
||
|
{
|
||
|
u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0;
|
||
|
u32 points1 = 0, psd_report = 0;
|
||
|
u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250;
|
||
|
u32 psd_center_freq = 20 * 10 ^ 6;
|
||
|
boolean outloop = false, scan , roam, is_sweep_ok = true;
|
||
|
u8 flag = 0;
|
||
|
u32 tmp = 0, u32tmp1 = 0;
|
||
|
u32 wifi_original_channel = 1;
|
||
|
|
||
|
psd_scan->is_psd_running = true;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx PSD Sweep Start!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
do {
|
||
|
switch (flag) {
|
||
|
case 0: /* Get PSD parameters */
|
||
|
default:
|
||
|
|
||
|
psd_scan->psd_band_width = 40 * 1000000;
|
||
|
psd_scan->psd_point = points;
|
||
|
psd_scan->psd_start_base = points / 2;
|
||
|
psd_scan->psd_avg_num = avgnum;
|
||
|
psd_scan->real_cent_freq = cent_freq;
|
||
|
psd_scan->real_offset = offset;
|
||
|
psd_scan->real_span = span;
|
||
|
|
||
|
|
||
|
points1 = psd_scan->psd_point;
|
||
|
delta_freq_per_point = psd_scan->psd_band_width /
|
||
|
psd_scan->psd_point;
|
||
|
|
||
|
/* PSD point setup */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x808);
|
||
|
val &= 0xffff0fff;
|
||
|
|
||
|
switch (psd_scan->psd_point) {
|
||
|
case 128:
|
||
|
val |= 0x0;
|
||
|
break;
|
||
|
case 256:
|
||
|
default:
|
||
|
val |= 0x00004000;
|
||
|
break;
|
||
|
case 512:
|
||
|
val |= 0x00008000;
|
||
|
break;
|
||
|
case 1024:
|
||
|
val |= 0x0000c000;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
switch (psd_scan->psd_avg_num) {
|
||
|
case 1:
|
||
|
val |= 0x0;
|
||
|
break;
|
||
|
case 8:
|
||
|
val |= 0x00001000;
|
||
|
break;
|
||
|
case 16:
|
||
|
val |= 0x00002000;
|
||
|
break;
|
||
|
case 32:
|
||
|
default:
|
||
|
val |= 0x00003000;
|
||
|
break;
|
||
|
}
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x808, val);
|
||
|
|
||
|
flag = 1;
|
||
|
break;
|
||
|
case 1: /* calculate the PSD point index from freq/offset/span */
|
||
|
psd_center_freq = psd_scan->psd_band_width / 2 +
|
||
|
offset * (1000000);
|
||
|
|
||
|
start_p = psd_scan->psd_start_base + (psd_center_freq -
|
||
|
span * (1000000) / 2) / delta_freq_per_point;
|
||
|
psd_scan->psd_start_point = start_p -
|
||
|
psd_scan->psd_start_base;
|
||
|
|
||
|
stop_p = psd_scan->psd_start_base + (psd_center_freq +
|
||
|
span * (1000000) / 2) / delta_freq_per_point;
|
||
|
psd_scan->psd_stop_point = stop_p -
|
||
|
psd_scan->psd_start_base - 1;
|
||
|
|
||
|
flag = 2;
|
||
|
break;
|
||
|
case 2: /* set RF channel/BW/Mode */
|
||
|
|
||
|
/* set 3-wire off */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x88c);
|
||
|
val |= 0x00300000;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x88c, val);
|
||
|
|
||
|
/* CCK off */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x800);
|
||
|
val &= 0xfeffffff;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x800, val);
|
||
|
|
||
|
/* Tx-pause on */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f);
|
||
|
|
||
|
/* store WiFi original channel */
|
||
|
wifi_original_channel = btcoexist->btc_get_rf_reg(
|
||
|
btcoexist, BTC_RF_A, 0x18, 0x3ff);
|
||
|
|
||
|
/* Set RF channel */
|
||
|
if (cent_freq == 2484)
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,
|
||
|
0x18, 0x3ff, 0xe);
|
||
|
else
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A,
|
||
|
0x18, 0x3ff, (cent_freq - 2412) / 5 +
|
||
|
1); /* WiFi TRx Mask on */
|
||
|
|
||
|
/* save original RCK value */
|
||
|
u32tmp1 = btcoexist->btc_get_rf_reg(
|
||
|
btcoexist, BTC_RF_A, 0x1d, 0xfffff);
|
||
|
|
||
|
/* Enter debug mode */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde,
|
||
|
0x2, 0x1);
|
||
|
|
||
|
/* Set RF Rx filter corner */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d,
|
||
|
0xfffff, 0x2e);
|
||
|
|
||
|
|
||
|
/* Set RF mode = Rx, RF Gain = 0x320a0 */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0,
|
||
|
0xfffff, 0x320a0);
|
||
|
|
||
|
while (1) {
|
||
|
if (k++ > BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY)
|
||
|
break;
|
||
|
}
|
||
|
flag = 3;
|
||
|
break;
|
||
|
case 3:
|
||
|
psd_scan->psd_gen_count = 0;
|
||
|
|
||
|
for (j = 1; j <= loopcnt; j++) {
|
||
|
|
||
|
/* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, 0xfffff, 0x320a0); */
|
||
|
|
||
|
btcoexist->btc_get(btcoexist,
|
||
|
BTC_GET_BL_WIFI_SCAN, &scan);
|
||
|
btcoexist->btc_get(btcoexist,
|
||
|
BTC_GET_BL_WIFI_ROAM, &roam);
|
||
|
|
||
|
if (scan || roam) {
|
||
|
is_sweep_ok = false;
|
||
|
break;
|
||
|
}
|
||
|
memset(psd_scan->psd_report, 0,
|
||
|
psd_scan->psd_point * sizeof(u32));
|
||
|
start_p = psd_scan->psd_start_point +
|
||
|
psd_scan->psd_start_base;
|
||
|
stop_p = psd_scan->psd_stop_point +
|
||
|
psd_scan->psd_start_base + 1;
|
||
|
|
||
|
i = start_p;
|
||
|
point_index = 0;
|
||
|
|
||
|
while (i < stop_p) {
|
||
|
if (i >= points1)
|
||
|
psd_report =
|
||
|
halbtc8723d2ant_psd_getdata(
|
||
|
btcoexist, i - points1);
|
||
|
else
|
||
|
psd_report =
|
||
|
halbtc8723d2ant_psd_getdata(
|
||
|
btcoexist, i);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"Point=%d, psd_raw_data = 0x%08x\n",
|
||
|
i, psd_report);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
if (psd_report == 0)
|
||
|
tmp = 0;
|
||
|
else
|
||
|
/* tmp = 20*log10((double)psd_report); */
|
||
|
/* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */
|
||
|
tmp = 6 * halbtc8723d2ant_psd_log2base(
|
||
|
btcoexist, psd_report);
|
||
|
|
||
|
n = i - psd_scan->psd_start_base;
|
||
|
psd_scan->psd_report[n] = tmp;
|
||
|
|
||
|
|
||
|
halbtc8723d2ant_psd_maxholddata(
|
||
|
btcoexist, j);
|
||
|
|
||
|
i++;
|
||
|
|
||
|
}
|
||
|
|
||
|
psd_scan->psd_gen_count = j;
|
||
|
|
||
|
|
||
|
/*
|
||
|
val = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
tmp = btcoexist->btc_read_4byte(btcoexist, 0x64);
|
||
|
u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0x6c4);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"0x54 = 0x%08x, 0x67 = 0x%08x, 0x6c4 = 0x%08x\n", val, (tmp & 0xff000000) >> 24 ,u32tmp1);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
*/
|
||
|
|
||
|
}
|
||
|
|
||
|
flag = 100;
|
||
|
break;
|
||
|
case 99: /* error */
|
||
|
|
||
|
outloop = true;
|
||
|
break;
|
||
|
case 100: /* recovery */
|
||
|
|
||
|
/* set 3-wire on */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x88c);
|
||
|
val &= 0xffcfffff;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x88c, val);
|
||
|
|
||
|
/* CCK on */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x800);
|
||
|
val |= 0x01000000;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x800, val);
|
||
|
|
||
|
/* Tx-pause off */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0);
|
||
|
|
||
|
/* PSD off */
|
||
|
val = btcoexist->btc_read_4byte(btcoexist, 0x808);
|
||
|
val &= 0xffbfffff;
|
||
|
btcoexist->btc_write_4byte(btcoexist, 0x808, val);
|
||
|
|
||
|
/* restore RF Rx filter corner */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d,
|
||
|
0xfffff, u32tmp1);
|
||
|
|
||
|
/* Exit debug mode */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde,
|
||
|
0x2, 0x0);
|
||
|
|
||
|
/* restore WiFi original channel */
|
||
|
btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18,
|
||
|
0x3ff, wifi_original_channel);
|
||
|
|
||
|
outloop = true;
|
||
|
break;
|
||
|
|
||
|
}
|
||
|
|
||
|
} while (!outloop);
|
||
|
|
||
|
|
||
|
|
||
|
psd_scan->is_psd_running = false;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return is_sweep_ok;
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist *btcoexist,
|
||
|
IN u32 bt_tx_time, IN u32 bt_le_channel)
|
||
|
{
|
||
|
u32 i = 0;
|
||
|
u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50;
|
||
|
s32 wlpsd_offset = -4;
|
||
|
u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33};
|
||
|
|
||
|
u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb;
|
||
|
|
||
|
u8 state = 0;
|
||
|
boolean outloop = false, bt_resp = false;
|
||
|
u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point,
|
||
|
u32tmp, u32tmp0, u32tmp1, u32tmp2;
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8));
|
||
|
memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8));
|
||
|
|
||
|
if (board_info->tfbga_package) /* for TFBGA */
|
||
|
psd_scan->ant_det_thres_offset = 5;
|
||
|
else
|
||
|
psd_scan->ant_det_thres_offset = 0;
|
||
|
|
||
|
do {
|
||
|
switch (state) {
|
||
|
case 0:
|
||
|
if (bt_le_channel == 39)
|
||
|
wlpsd_cent_freq = 2484;
|
||
|
else {
|
||
|
for (i = 1; i <= 13; i++) {
|
||
|
if (bt_le_ch[i - 1] ==
|
||
|
bt_le_channel) {
|
||
|
wlpsd_cent_freq = 2412
|
||
|
+ (i - 1) * 5;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (i == 14) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf,
|
||
|
BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ",
|
||
|
bt_le_channel);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
outloop = true;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
wlpsd_sweep_count = bt_tx_time * 238 /
|
||
|
100; /* bt_tx_time/0.42 */
|
||
|
wlpsd_sweep_count = wlpsd_sweep_count / 5;
|
||
|
|
||
|
if (wlpsd_sweep_count % 5 != 0)
|
||
|
wlpsd_sweep_count = (wlpsd_sweep_count /
|
||
|
5 + 1) * 5;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n",
|
||
|
bt_tx_time, bt_le_channel);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n",
|
||
|
wlpsd_cent_freq,
|
||
|
wlpsd_offset,
|
||
|
wlpsd_span,
|
||
|
wlpsd_sweep_count);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
state = 1;
|
||
|
break;
|
||
|
case 1: /* stop coex DM & set antenna path */
|
||
|
/* Stop Coex DM */
|
||
|
/*
|
||
|
btcoexist->stop_coex_dm = true;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n");
|
||
|
BTC_TRACE(trace_buf); */
|
||
|
|
||
|
/* Set TDMA off, */
|
||
|
halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC,
|
||
|
false, 0);
|
||
|
|
||
|
/* Set coex table */
|
||
|
halbtc8723d2ant_coex_table_with_type(btcoexist,
|
||
|
FORCE_EXEC, 0);
|
||
|
|
||
|
if (board_info->btdm_ant_pos ==
|
||
|
BTC_ANTENNA_AT_MAIN_PORT) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
|
||
|
/* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */
|
||
|
/* Set Antenna path, switch WiFi to un-certain antenna port */
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist,
|
||
|
BTC_ANT_WIFI_AT_AUX, true,
|
||
|
false);
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
|
||
|
/* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */
|
||
|
/* Set Antenna path, switch WiFi to un-certain antenna port */
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist,
|
||
|
BTC_ANT_WIFI_AT_MAIN, true,
|
||
|
false);
|
||
|
}
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
/* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */
|
||
|
h2c_parameter[0] = 0x1;
|
||
|
h2c_parameter[1] = 0xd;
|
||
|
h2c_parameter[2] = 0x14;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n",
|
||
|
h2c_parameter[1],
|
||
|
h2c_parameter[2]);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,
|
||
|
h2c_parameter);
|
||
|
|
||
|
u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948);
|
||
|
u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70);
|
||
|
u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
|
||
|
u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n",
|
||
|
u32tmp, u32tmp0, u32tmp1, u32tmp2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
state = 2;
|
||
|
break;
|
||
|
case 2: /* Pre-sweep background psd */
|
||
|
if (!halbtc8723d2ant_psd_sweep_point(btcoexist,
|
||
|
wlpsd_cent_freq, wlpsd_offset, wlpsd_span,
|
||
|
BT_8723D_2ANT_ANTDET_PSD_POINTS,
|
||
|
BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
psd_scan->ant_det_result = 8;
|
||
|
state = 99;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
psd_scan->ant_det_pre_psdscan_peak_val =
|
||
|
psd_scan->psd_max_value;
|
||
|
|
||
|
if (psd_scan->psd_max_value >
|
||
|
(BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
|
||
|
+ psd_scan->ant_det_thres_offset) * 100) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n",
|
||
|
psd_scan->psd_max_value / 100,
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
|
||
|
+ psd_scan->ant_det_thres_offset);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
psd_scan->ant_det_result = 5;
|
||
|
state = 99;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n",
|
||
|
psd_scan->psd_max_value / 100,
|
||
|
BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND
|
||
|
+ psd_scan->ant_det_thres_offset);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
state = 3;
|
||
|
}
|
||
|
break;
|
||
|
case 3:
|
||
|
bt_resp = btcoexist->btc_set_bt_ant_detection(
|
||
|
btcoexist, (u8)(bt_tx_time & 0xff),
|
||
|
(u8)(bt_le_channel & 0xff));
|
||
|
|
||
|
if (!halbtc8723d2ant_psd_sweep_point(btcoexist,
|
||
|
wlpsd_cent_freq, wlpsd_offset,
|
||
|
wlpsd_span,
|
||
|
BT_8723D_2ANT_ANTDET_PSD_POINTS,
|
||
|
BT_8723D_2ANT_ANTDET_PSD_AVGNUM,
|
||
|
wlpsd_sweep_count)) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
psd_scan->ant_det_result = 8;
|
||
|
state = 99;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
psd_scan->ant_det_psd_scan_peak_val =
|
||
|
psd_scan->psd_max_value;
|
||
|
psd_scan->ant_det_psd_scan_peak_freq =
|
||
|
psd_scan->psd_max_value_point;
|
||
|
state = 4;
|
||
|
break;
|
||
|
case 4:
|
||
|
|
||
|
if (psd_scan->psd_point == 0)
|
||
|
delta_freq_per_point = 0;
|
||
|
else
|
||
|
delta_freq_per_point =
|
||
|
psd_scan->psd_band_width /
|
||
|
psd_scan->psd_point;
|
||
|
|
||
|
psd_rep1 = psd_scan->psd_max_value / 100;
|
||
|
psd_rep2 = psd_scan->psd_max_value - psd_rep1 *
|
||
|
100;
|
||
|
|
||
|
freq = ((psd_scan->real_cent_freq - 20) *
|
||
|
1000000 + psd_scan->psd_max_value_point
|
||
|
* delta_freq_per_point);
|
||
|
freq1 = freq / 1000000;
|
||
|
freq2 = freq / 1000 - freq1 * 1000;
|
||
|
|
||
|
if (freq2 < 100) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz",
|
||
|
freq1, freq2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
CL_SPRINTF(psd_scan->ant_det_peak_freq,
|
||
|
BT_8723D_2ANT_ANTDET_BUF_LEN,
|
||
|
"%d.0%d", freq1, freq2);
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz",
|
||
|
freq1, freq2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
CL_SPRINTF(psd_scan->ant_det_peak_freq,
|
||
|
BT_8723D_2ANT_ANTDET_BUF_LEN,
|
||
|
"%d.%d", freq1, freq2);
|
||
|
}
|
||
|
|
||
|
if (psd_rep2 < 10) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
", Value = %d.0%d dB\n",
|
||
|
psd_rep1, psd_rep2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
CL_SPRINTF(psd_scan->ant_det_peak_val,
|
||
|
BT_8723D_2ANT_ANTDET_BUF_LEN,
|
||
|
"%d.0%d", psd_rep1, psd_rep2);
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
", Value = %d.%d dB\n",
|
||
|
psd_rep1, psd_rep2);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
CL_SPRINTF(psd_scan->ant_det_peak_val,
|
||
|
BT_8723D_2ANT_ANTDET_BUF_LEN,
|
||
|
"%d.%d", psd_rep1, psd_rep2);
|
||
|
}
|
||
|
|
||
|
psd_scan->ant_det_is_btreply_available = true;
|
||
|
|
||
|
if (bt_resp == false) {
|
||
|
psd_scan->ant_det_is_btreply_available =
|
||
|
false;
|
||
|
psd_scan->ant_det_result = 0;
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n ");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if (psd_scan->psd_max_value >
|
||
|
(BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION)
|
||
|
* 100) {
|
||
|
psd_scan->ant_det_result = 1;
|
||
|
board_info->btdm_ant_det_finish = true;
|
||
|
board_info->btdm_ant_num_by_ant_det = 2;
|
||
|
coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if (psd_scan->psd_max_value >
|
||
|
(BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION
|
||
|
+ psd_scan->ant_det_thres_offset) * 100) {
|
||
|
psd_scan->ant_det_result = 2;
|
||
|
board_info->btdm_ant_det_finish = true;
|
||
|
board_info->btdm_ant_num_by_ant_det = 2;
|
||
|
coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if (psd_scan->psd_max_value >
|
||
|
(BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) *
|
||
|
100) {
|
||
|
psd_scan->ant_det_result = 3;
|
||
|
board_info->btdm_ant_det_finish = true;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else {
|
||
|
psd_scan->ant_det_result = 4;
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
state = 99;
|
||
|
break;
|
||
|
case 99: /* restore setup */
|
||
|
|
||
|
/* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */
|
||
|
h2c_parameter[0] = 0x0;
|
||
|
h2c_parameter[1] = 0x0;
|
||
|
h2c_parameter[2] = 0x0;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n",
|
||
|
h2c_parameter[1], h2c_parameter[2]);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
btcoexist->btc_fill_h2c(btcoexist, 0x66, 3,
|
||
|
h2c_parameter);
|
||
|
|
||
|
/* Set Antenna Path, GNT_WL/GNT_BT control by PTA */
|
||
|
/* Set Antenna path, switch WiFi to certain antenna port */
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist,
|
||
|
BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
false);
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
/* Resume Coex DM */
|
||
|
/*
|
||
|
btcoexist->stop_coex_dm = false;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!");
|
||
|
BTC_TRACE(trace_buf); */
|
||
|
|
||
|
/* stimulate coex running */
|
||
|
/*
|
||
|
halbtc8723d2ant_run_coexist_mechanism(
|
||
|
btcoexist);
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!");
|
||
|
BTC_TRACE(trace_buf); */
|
||
|
|
||
|
outloop = true;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
} while (!outloop);
|
||
|
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
void halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist
|
||
|
*btcoexist)
|
||
|
{
|
||
|
static u32 ant_det_count = 0, ant_det_fail_count = 0;
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
|
||
|
boolean scan, roam;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam);
|
||
|
|
||
|
|
||
|
/* psd_scan->ant_det_bt_tx_time = 20; */
|
||
|
psd_scan->ant_det_bt_tx_time =
|
||
|
BT_8723D_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */
|
||
|
psd_scan->ant_det_bt_le_channel = BT_8723D_2ANT_ANTDET_BTTXCHANNEL;
|
||
|
|
||
|
ant_det_count++;
|
||
|
|
||
|
psd_scan->ant_det_try_count = ant_det_count;
|
||
|
|
||
|
if (scan || roam) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
psd_scan->ant_det_result = 6;
|
||
|
} else if (coex_sta->bt_disabled) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
psd_scan->ant_det_result = 11;
|
||
|
} else if (coex_sta->num_of_profile >= 1) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
psd_scan->ant_det_result = 7;
|
||
|
} else if (
|
||
|
!psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
psd_scan->ant_det_result = 9;
|
||
|
} else if (coex_sta->c2h_bt_inquiry_page) {
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
psd_scan->ant_det_result = 10;
|
||
|
} else {
|
||
|
|
||
|
btcoexist->stop_coex_dm = true;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_psd_antenna_detection(btcoexist,
|
||
|
psd_scan->ant_det_bt_tx_time,
|
||
|
psd_scan->ant_det_bt_le_channel);
|
||
|
|
||
|
delay_ms(psd_scan->ant_det_bt_tx_time);
|
||
|
|
||
|
btcoexist->stop_coex_dm = false;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
/* stimulate coex running */
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(
|
||
|
btcoexist);
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
|
||
|
if (!board_info->btdm_ant_det_finish)
|
||
|
ant_det_fail_count++;
|
||
|
|
||
|
psd_scan->ant_det_fail_count = ant_det_fail_count;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n",
|
||
|
psd_scan->ant_det_result,
|
||
|
psd_scan->ant_det_fail_count,
|
||
|
board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
/* ************************************************************
|
||
|
* work around function start with wa_halbtc8723d2ant_
|
||
|
* ************************************************************
|
||
|
* ************************************************************
|
||
|
* extern function start with ex_halbtc8723d2ant_
|
||
|
* ************************************************************ */
|
||
|
void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
u8 u8tmp = 0x0;
|
||
|
u16 u16tmp = 0x0;
|
||
|
u32 value = 0;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx Execute 8723d 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"Ant Det Finish = %s, Ant Det Number = %d\n",
|
||
|
(board_info->btdm_ant_det_finish ? "Yes" : "No"),
|
||
|
board_info->btdm_ant_num_by_ant_det);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
|
||
|
btcoexist->stop_coex_dm = true;
|
||
|
psd_scan->ant_det_is_ant_det_available = FALSE;
|
||
|
|
||
|
/* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */
|
||
|
u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2);
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1));
|
||
|
|
||
|
/* set Path control owner to WiFi */
|
||
|
halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist,
|
||
|
BT_8723D_2ANT_PCO_WLSIDE);
|
||
|
|
||
|
/* set GNT_BT to high */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
|
||
|
/* Set GNT_WL to high */
|
||
|
halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist,
|
||
|
BT_8723D_2ANT_GNT_BLOCK_RFC_BB,
|
||
|
BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW,
|
||
|
BT_8723D_2ANT_SIG_STA_SET_TO_HIGH);
|
||
|
|
||
|
/* Local setting bit define */
|
||
|
/* BIT0: "0" for no antenna inverse; "1" for antenna inverse */
|
||
|
/* BIT1: "0" for internal switch; "1" for external switch */
|
||
|
/* BIT2: "0" for one antenna; "1" for two antenna */
|
||
|
/* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */
|
||
|
|
||
|
/* Set path control to WL */
|
||
|
btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);
|
||
|
btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0);
|
||
|
|
||
|
/* Check efuse 0xc3[6] for Single Antenna Path */
|
||
|
if (board_info->single_ant_path == 0) {
|
||
|
/* set to S1 */
|
||
|
board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT;
|
||
|
u8tmp = 4;
|
||
|
} else if (board_info->single_ant_path == 1) {
|
||
|
/* set to S0 */
|
||
|
board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT;
|
||
|
u8tmp = 5;
|
||
|
}
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n",
|
||
|
board_info->single_ant_path , board_info->btdm_ant_pos);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
/* Write Single Antenna Position to Registry to tell BT for 872db. This line can be removed
|
||
|
since BT EFuse also add "single antenna position" in EFuse for 8723d*/
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL,
|
||
|
&value);
|
||
|
|
||
|
/* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */
|
||
|
if (btcoexist->chip_interface == BTC_INTF_PCI)
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp);
|
||
|
else if (btcoexist->chip_interface == BTC_INTF_USB)
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp);
|
||
|
else if (btcoexist->chip_interface == BTC_INTF_SDIO)
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp);
|
||
|
|
||
|
/* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */
|
||
|
halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, FALSE);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n",
|
||
|
halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38));
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n",
|
||
|
btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_2byte(btcoexist, 0x948));
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */
|
||
|
|
||
|
/* */
|
||
|
/* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */
|
||
|
/* Local setting bit define */
|
||
|
/* BIT0: "0" for no antenna inverse; "1" for antenna inverse */
|
||
|
/* BIT1: "0" for internal switch; "1" for external switch */
|
||
|
/* BIT2: "0" for one antenna; "1" for two antenna */
|
||
|
/* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */
|
||
|
if (btcoexist->chip_interface == BTC_INTF_USB) {
|
||
|
/* fixed at S0 for USB interface */
|
||
|
u8tmp |= 0x1; /* antenna inverse */
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp);
|
||
|
} else {
|
||
|
/* for PCIE and SDIO interface, we check efuse 0xc3[6] */
|
||
|
if (board_info->single_ant_path == 0) {
|
||
|
} else if (board_info->single_ant_path == 1) {
|
||
|
/* set to S0 */
|
||
|
u8tmp |= 0x1; /* antenna inverse */
|
||
|
}
|
||
|
|
||
|
if (btcoexist->chip_interface == BTC_INTF_PCI)
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0,
|
||
|
u8tmp);
|
||
|
else if (btcoexist->chip_interface == BTC_INTF_SDIO)
|
||
|
btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60,
|
||
|
u8tmp);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist,
|
||
|
IN boolean wifi_only)
|
||
|
{
|
||
|
btcoexist->stop_coex_dm = false;
|
||
|
halbtc8723d2ant_init_hw_config(btcoexist, wifi_only);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Coex Mechanism Init!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
btcoexist->stop_coex_dm = false;
|
||
|
|
||
|
halbtc8723d2ant_action_init_coex_dm(btcoexist);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
u8 *cli_buf = btcoexist->cli_buf;
|
||
|
u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0;
|
||
|
u32 u32tmp[4];
|
||
|
u16 u16tmp[4];
|
||
|
u32 fa_of_dm, fa_cck;
|
||
|
u32 fw_ver = 0, bt_patch_ver = 0;
|
||
|
static u8 pop_report_in_10s = 0;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n ============[BT Coexist info]============");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (btcoexist->manual_control) {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n ============[Under Manual Control]============");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n ==========================================");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
}
|
||
|
|
||
|
if (psd_scan->ant_det_try_count == 0) {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s",
|
||
|
"Ant PG Num/ Mech/ Pos",
|
||
|
board_info->pg_ant_num, board_info->btdm_ant_num,
|
||
|
(board_info->btdm_ant_pos == 1 ? "S1" : "S0"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
} else {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = %d/ %d/ %s (retry=%d/fail=%d/result=%d)",
|
||
|
"Ant PG Num/ Mech(Ant_Det)/ Pos",
|
||
|
board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det,
|
||
|
(board_info->btdm_ant_pos == 1 ? "S1" : "S0"),
|
||
|
psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count,
|
||
|
psd_scan->ant_det_result);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (board_info->btdm_ant_det_finish) {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s",
|
||
|
"Ant Det PSD Value",
|
||
|
psd_scan->ant_det_peak_val);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver);
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c",
|
||
|
"Version Coex/ Fw/ Patch/ Cut",
|
||
|
glcoex_ver_date_8723d_2ant, glcoex_ver_8723d_2ant, fw_ver,
|
||
|
bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ",
|
||
|
"Wifi channel informed to BT",
|
||
|
coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1],
|
||
|
coex_dm->wifi_chnl_info[2]);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ",
|
||
|
"Isolation/WL_Thres/BT_Thres",
|
||
|
coex_sta->isolation_btween_wb,
|
||
|
coex_sta->wifi_coex_thres,
|
||
|
coex_sta->bt_coex_thres);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
/* wifi status */
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
|
||
|
"============[Wifi Status]============");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
|
||
|
"============[BT Status]============");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
pop_report_in_10s++;
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ",
|
||
|
"BT [status/ rssi/ retryCnt/ popCnt]",
|
||
|
((coex_sta->bt_disabled) ? ("disabled") : ((
|
||
|
coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page")
|
||
|
: ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE ==
|
||
|
coex_dm->bt_status) ? "non-connected idle" :
|
||
|
((BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)
|
||
|
? "connected-idle" : "busy")))),
|
||
|
coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt,
|
||
|
coex_sta->pop_event_cnt);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
if (pop_report_in_10s >= 5) {
|
||
|
coex_sta->pop_event_cnt = 0;
|
||
|
pop_report_in_10s = 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = %d / %d / %d / %d / %d / %d",
|
||
|
"SCO/HID/PAN/A2DP/NameReq/WHQL",
|
||
|
bt_link_info->sco_exist, bt_link_info->hid_exist,
|
||
|
bt_link_info->pan_exist, bt_link_info->a2dp_exist,
|
||
|
coex_sta->c2h_bt_remote_name_req,
|
||
|
coex_sta->bt_whck_test);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
bt_info_ext = coex_sta->bt_info_ext;
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d",
|
||
|
"Role/A2DP Rate/Bitpool",
|
||
|
((bt_link_info->slave_role) ? "Slave" : "Master"),
|
||
|
(bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
for (i = 0; i < BT_INFO_SRC_8723D_2ANT_MAX; i++) {
|
||
|
if (coex_sta->bt_info_c2h_cnt[i]) {
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)",
|
||
|
glbt_info_src_8723d_2ant[i],
|
||
|
coex_sta->bt_info_c2h[i][0],
|
||
|
coex_sta->bt_info_c2h[i][1],
|
||
|
coex_sta->bt_info_c2h[i][2],
|
||
|
coex_sta->bt_info_c2h[i][3],
|
||
|
coex_sta->bt_info_c2h[i][4],
|
||
|
coex_sta->bt_info_c2h[i][5],
|
||
|
coex_sta->bt_info_c2h[i][6],
|
||
|
coex_sta->bt_info_c2h_cnt[i]);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Sw mechanism */
|
||
|
if (btcoexist->manual_control)
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
|
||
|
"============[mechanism] (before Manual)============");
|
||
|
else
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
|
||
|
"============[mechanism]============");
|
||
|
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ 0x%x/ 0x%x ",
|
||
|
"LowP-RA/ DecWLPwr/ DecBTPwr",
|
||
|
(coex_dm->cur_low_penalty_ra ? "On" : "Off"),
|
||
|
coex_dm->cur_fw_dac_swing_lvl,
|
||
|
coex_dm->cur_bt_dec_pwr_lvl);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
ps_tdma_case = coex_dm->cur_ps_tdma;
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s, %s)",
|
||
|
"PS TDMA",
|
||
|
coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1],
|
||
|
coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3],
|
||
|
coex_dm->ps_tdma_para[4], ps_tdma_case,
|
||
|
(coex_dm->cur_ps_tdma_on ? "On" : "Off"),
|
||
|
(coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d",
|
||
|
"WL/BT Coex Table Type",
|
||
|
coex_sta->coex_table_type);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0);
|
||
|
u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4);
|
||
|
u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = 0x%x/ 0x%x/ 0x%x",
|
||
|
"0x6c0/0x6c4/0x6c8(coexTable)",
|
||
|
u32tmp[0], u32tmp[1], u32tmp[2]);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778);
|
||
|
u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = 0x%x/ 0x%x/ 0x%x",
|
||
|
"0x778/0x6cc/IgnWlanAct",
|
||
|
u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xa0);
|
||
|
u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xa4);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",
|
||
|
"LTE Coex Table W_L/B_L",
|
||
|
u32tmp[0] & 0xffff, u32tmp[1] & 0xffff);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xa8);
|
||
|
u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xac);
|
||
|
u32tmp[2] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xb0);
|
||
|
u32tmp[3] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist,
|
||
|
0xb4);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE,
|
||
|
"\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x",
|
||
|
"LTE Break Table W_L/B_L/L_W/L_B",
|
||
|
u32tmp[0] & 0xffff, u32tmp[1] & 0xffff,
|
||
|
u32tmp[2] & 0xffff, u32tmp[3] & 0xffff);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
/* Hw setting */
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s",
|
||
|
"============[Hw setting]============");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430);
|
||
|
u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434);
|
||
|
u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a);
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x",
|
||
|
"0x430/0x434/0x42a/0x456",
|
||
|
u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38);
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s",
|
||
|
"LTE CoexOn/Path Ctrl Owner",
|
||
|
(int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
|
||
|
"LTE 3Wire/OPMode/UART/UARTMode",
|
||
|
(int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4),
|
||
|
(int)((u32tmp[0] & BIT(3)) >> 3),
|
||
|
(int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0))));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s",
|
||
|
"GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg",
|
||
|
(int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14),
|
||
|
((u8tmp[0] & BIT(3)) ? "On" : "Off"));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
|
||
|
"GNT_WL/GNT_BT/LTE_Busy/UART_Busy",
|
||
|
(int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3),
|
||
|
(int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0)));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6);
|
||
|
u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x",
|
||
|
"0x4c6[4]/0x40[5] (WL/BT PTA)",
|
||
|
(int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5));
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550);
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522);
|
||
|
u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s",
|
||
|
"0x550(bcn ctrl)/0x522/4-RxAGC",
|
||
|
u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off");
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
u32tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948);
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67);
|
||
|
u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",
|
||
|
"0x948/ 0x67[7]/ 0xc50[7:0]",
|
||
|
u32tmp[0],
|
||
|
((u8tmp[0] & 0x80) >> 7), u32tmp[1] & 0xff);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
|
||
|
u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0);
|
||
|
u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4);
|
||
|
u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8);
|
||
|
u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0);
|
||
|
|
||
|
u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b);
|
||
|
u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c);
|
||
|
|
||
|
fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000)
|
||
|
>> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) +
|
||
|
((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & 0xffff);
|
||
|
fa_cck = (u8tmp[0] << 8) + u8tmp[1];
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x",
|
||
|
"OFDM-CCA/OFDM-FA/CCK-FA",
|
||
|
u32tmp[0] & 0xffff, fa_of_dm, fa_cck);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
|
||
|
"CRC_OK CCK/11g/11n/11n-Agg",
|
||
|
coex_sta->crc_ok_cck, coex_sta->crc_ok_11g,
|
||
|
coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d",
|
||
|
"CRC_Err CCK/11g/11n/11n-Agg",
|
||
|
coex_sta->crc_err_cck, coex_sta->crc_err_11g,
|
||
|
coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",
|
||
|
"0x770(high-pri rx/tx)",
|
||
|
coex_sta->high_priority_rx, coex_sta->high_priority_tx);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d",
|
||
|
"0x774(low-pri rx/tx)",
|
||
|
coex_sta->low_priority_rx, coex_sta->low_priority_tx);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
halbtc8723d2ant_read_score_board(btcoexist, &u16tmp[0]);
|
||
|
|
||
|
CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x",
|
||
|
"ScoreBoard[14:0] (from BT)", u16tmp[0]);
|
||
|
CL_PRINTF(cli_buf);
|
||
|
|
||
|
btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS);
|
||
|
}
|
||
|
|
||
|
|
||
|
void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type)
|
||
|
{
|
||
|
if (btcoexist->manual_control || btcoexist->stop_coex_dm)
|
||
|
return;
|
||
|
|
||
|
if (BTC_IPS_ENTER == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], IPS ENTER notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
coex_sta->under_ips = true;
|
||
|
coex_sta->under_lps = false;
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
true);
|
||
|
halbtc8723d2ant_action_coex_all_off(btcoexist);
|
||
|
} else if (BTC_IPS_LEAVE == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], IPS LEAVE notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
coex_sta->under_ips = false;
|
||
|
halbtc8723d2ant_init_hw_config(btcoexist, false);
|
||
|
halbtc8723d2ant_action_init_coex_dm(btcoexist);
|
||
|
halbtc8723d2ant_query_bt_info(btcoexist);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type)
|
||
|
{
|
||
|
if (btcoexist->manual_control || btcoexist->stop_coex_dm)
|
||
|
return;
|
||
|
|
||
|
if (BTC_LPS_ENABLE == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], LPS ENABLE notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
coex_sta->under_lps = true;
|
||
|
coex_sta->under_ips = false;
|
||
|
} else if (BTC_LPS_DISABLE == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], LPS DISABLE notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
coex_sta->under_lps = false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
u32 u32tmp;
|
||
|
u8 u8tmpa, u8tmpb;
|
||
|
boolean wifi_connected = false;
|
||
|
|
||
|
|
||
|
if (btcoexist->manual_control ||
|
||
|
btcoexist->stop_coex_dm)
|
||
|
return;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
|
||
|
&wifi_connected);
|
||
|
|
||
|
halbtc8723d2ant_query_bt_info(btcoexist); /* this can't be removed for RF off_on event, or BT would dis-connect */
|
||
|
|
||
|
if (BTC_SCAN_START == type) {
|
||
|
|
||
|
if (!wifi_connected)
|
||
|
coex_sta->wifi_is_high_pri_task = true;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCAN START notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
false);
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
|
||
|
} else if (BTC_SCAN_FINISH == type) {
|
||
|
|
||
|
coex_sta->wifi_is_high_pri_task = false;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM,
|
||
|
&coex_sta->scan_ap_num);
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
if (btcoexist->manual_control ||
|
||
|
btcoexist->stop_coex_dm ||
|
||
|
coex_sta->bt_disabled)
|
||
|
return;
|
||
|
|
||
|
if (BTC_ASSOCIATE_START == type) {
|
||
|
|
||
|
coex_sta->wifi_is_high_pri_task = true;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], CONNECT START notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
false);
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
|
||
|
coex_dm->arp_cnt = 0;
|
||
|
|
||
|
} else if (BTC_ASSOCIATE_FINISH == type) {
|
||
|
|
||
|
coex_sta->wifi_is_high_pri_task = false;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], CONNECT FINISH notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
u8 h2c_parameter[3] = {0};
|
||
|
u32 wifi_bw;
|
||
|
u8 wifi_central_chnl;
|
||
|
u8 ap_num = 0;
|
||
|
boolean wifi_under_b_mode = false;
|
||
|
|
||
|
if (btcoexist->manual_control ||
|
||
|
btcoexist->stop_coex_dm ||
|
||
|
coex_sta->bt_disabled)
|
||
|
return;
|
||
|
|
||
|
if (BTC_MEDIA_CONNECT == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], MEDIA connect notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
false);
|
||
|
|
||
|
/* psd_scan->ant_det_is_ant_det_available = TRUE; */
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,
|
||
|
&wifi_under_b_mode);
|
||
|
|
||
|
/* Set CCK Tx/Rx high Pri except 11b mode */
|
||
|
if (wifi_under_b_mode) {
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cd,
|
||
|
0x00); /* CCK Tx */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cf,
|
||
|
0x00); /* CCK Rx */
|
||
|
} else {
|
||
|
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cd,
|
||
|
0x00); /* CCK Tx */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cf,
|
||
|
0x10); /* CCK Rx */
|
||
|
}
|
||
|
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], MEDIA disconnect notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */
|
||
|
btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */
|
||
|
}
|
||
|
|
||
|
|
||
|
halbtc8723d2ant_update_wifi_channel_info(btcoexist, type);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
boolean under_4way = false;
|
||
|
|
||
|
if (btcoexist->manual_control ||
|
||
|
btcoexist->stop_coex_dm ||
|
||
|
coex_sta->bt_disabled)
|
||
|
return;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS,
|
||
|
&under_4way);
|
||
|
|
||
|
if (under_4way) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], specific Packet ---- under_4way!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
coex_sta->wifi_is_high_pri_task = true;
|
||
|
coex_sta->specific_pkt_period_cnt = 2;
|
||
|
|
||
|
} else if (BTC_PACKET_ARP == type) {
|
||
|
|
||
|
coex_dm->arp_cnt++;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
} else {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
coex_sta->wifi_is_high_pri_task = true;
|
||
|
coex_sta->specific_pkt_period_cnt = 2;
|
||
|
}
|
||
|
|
||
|
if (coex_sta->wifi_is_high_pri_task)
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 *tmp_buf, IN u8 length)
|
||
|
{
|
||
|
u8 bt_info = 0;
|
||
|
u8 i, rsp_source = 0;
|
||
|
boolean bt_busy = false, limited_dig = false;
|
||
|
boolean wifi_connected = false;
|
||
|
|
||
|
coex_sta->c2h_bt_info_req_sent = false;
|
||
|
|
||
|
btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED,
|
||
|
&wifi_connected);
|
||
|
|
||
|
rsp_source = tmp_buf[0] & 0xf;
|
||
|
if (rsp_source >= BT_INFO_SRC_8723D_2ANT_MAX)
|
||
|
rsp_source = BT_INFO_SRC_8723D_2ANT_WIFI_FW;
|
||
|
coex_sta->bt_info_c2h_cnt[rsp_source]++;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source,
|
||
|
length);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
for (i = 0; i < length; i++) {
|
||
|
coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i];
|
||
|
if (i == 1)
|
||
|
bt_info = tmp_buf[i];
|
||
|
|
||
|
if (i == length - 1) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n",
|
||
|
tmp_buf[i]);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ",
|
||
|
tmp_buf[i]);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (BT_INFO_SRC_8723D_2ANT_WIFI_FW != rsp_source) {
|
||
|
|
||
|
/* if 0xff, it means BT is under WHCK test */
|
||
|
if (bt_info == 0xff)
|
||
|
coex_sta->bt_whck_test = true;
|
||
|
else
|
||
|
coex_sta->bt_whck_test = false;
|
||
|
|
||
|
coex_sta->bt_retry_cnt = /* [3:0] */
|
||
|
coex_sta->bt_info_c2h[rsp_source][2] & 0xf;
|
||
|
|
||
|
if (coex_sta->bt_retry_cnt >= 1)
|
||
|
coex_sta->pop_event_cnt++;
|
||
|
|
||
|
if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80)
|
||
|
coex_sta->bt_create_connection = true;
|
||
|
else
|
||
|
coex_sta->bt_create_connection = false;
|
||
|
|
||
|
/* unit: %, value-100 to translate to unit: dBm */
|
||
|
coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10;
|
||
|
|
||
|
if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20)
|
||
|
coex_sta->c2h_bt_remote_name_req = true;
|
||
|
else
|
||
|
coex_sta->c2h_bt_remote_name_req = false;
|
||
|
|
||
|
if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) {
|
||
|
coex_sta->a2dp_bit_pool =
|
||
|
coex_sta->bt_info_c2h[rsp_source][6];
|
||
|
} else
|
||
|
coex_sta->a2dp_bit_pool = 0;
|
||
|
|
||
|
if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9)
|
||
|
coex_sta->acl_busy = true;
|
||
|
else
|
||
|
coex_sta->acl_busy = false;
|
||
|
|
||
|
coex_sta->bt_info_ext =
|
||
|
coex_sta->bt_info_c2h[rsp_source][4];
|
||
|
|
||
|
/* Here we need to resend some wifi info to BT */
|
||
|
/* because bt is reset and loss of the info. */
|
||
|
|
||
|
if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) {
|
||
|
|
||
|
/* Re-Init */
|
||
|
if ((coex_sta->bt_info_ext & BIT(1))) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
if (wifi_connected)
|
||
|
ex_halbtc8723d2ant_media_status_notify(
|
||
|
btcoexist, BTC_MEDIA_CONNECT);
|
||
|
else
|
||
|
ex_halbtc8723d2ant_media_status_notify(
|
||
|
btcoexist, BTC_MEDIA_DISCONNECT);
|
||
|
}
|
||
|
|
||
|
|
||
|
/* If Ignore_WLanAct && not SetUp_Link */
|
||
|
if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) {
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_ignore_wlan_act(btcoexist,
|
||
|
FORCE_EXEC, false);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* check BIT2 first ==> check if bt is under inquiry or page scan */
|
||
|
if (bt_info & BT_INFO_8723D_2ANT_B_INQ_PAGE)
|
||
|
coex_sta->c2h_bt_inquiry_page = true;
|
||
|
else
|
||
|
coex_sta->c2h_bt_inquiry_page = false;
|
||
|
}
|
||
|
|
||
|
coex_sta->num_of_profile = 0;
|
||
|
|
||
|
/* set link exist status */
|
||
|
if (!(bt_info & BT_INFO_8723D_2ANT_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 (bt_info & BT_INFO_8723D_2ANT_B_FTP) {
|
||
|
coex_sta->pan_exist = true;
|
||
|
coex_sta->num_of_profile++;
|
||
|
} else
|
||
|
coex_sta->pan_exist = false;
|
||
|
|
||
|
if (bt_info & BT_INFO_8723D_2ANT_B_A2DP) {
|
||
|
coex_sta->a2dp_exist = true;
|
||
|
coex_sta->num_of_profile++;
|
||
|
} else
|
||
|
coex_sta->a2dp_exist = false;
|
||
|
|
||
|
if (bt_info & BT_INFO_8723D_2ANT_B_HID) {
|
||
|
coex_sta->hid_exist = true;
|
||
|
coex_sta->num_of_profile++;
|
||
|
} else
|
||
|
coex_sta->hid_exist = false;
|
||
|
|
||
|
if (bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) {
|
||
|
coex_sta->sco_exist = true;
|
||
|
coex_sta->num_of_profile++;
|
||
|
} else
|
||
|
coex_sta->sco_exist = false;
|
||
|
|
||
|
}
|
||
|
|
||
|
halbtc8723d2ant_update_bt_link_info(btcoexist);
|
||
|
|
||
|
if (!(bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) {
|
||
|
coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if (bt_info ==
|
||
|
BT_INFO_8723D_2ANT_B_CONNECTION) { /* connection exists but no busy */
|
||
|
coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if ((bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) ||
|
||
|
(bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) {
|
||
|
coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_SCO_BUSY;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), BT SCO busy!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else if (bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY) {
|
||
|
coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_ACL_BUSY;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), BT ACL busy!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
} else {
|
||
|
coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_MAX;
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
if ((BT_8723D_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) ||
|
||
|
(BT_8723D_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) ||
|
||
|
(BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) {
|
||
|
bt_busy = true;
|
||
|
limited_dig = true;
|
||
|
} else {
|
||
|
bt_busy = false;
|
||
|
limited_dig = false;
|
||
|
}
|
||
|
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy);
|
||
|
|
||
|
coex_dm->limited_dig = limited_dig;
|
||
|
btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig);
|
||
|
|
||
|
if (btcoexist->manual_control) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (btcoexist->stop_coex_dm) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
/* don't run coex mechanism while receve BTInfo if GNT_WL/GNT_BT control by SW */
|
||
|
if (!coex_sta->gnt_control_by_PTA)
|
||
|
return;
|
||
|
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 type)
|
||
|
{
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (BTC_RF_ON == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], RF is turned ON!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
coex_sta->wl_rf_off_on_event = true;
|
||
|
btcoexist->stop_coex_dm = false;
|
||
|
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, TRUE);
|
||
|
} else if (BTC_RF_OFF == type) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], RF is turned OFF!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
true);
|
||
|
halbtc8723d2ant_action_coex_all_off(btcoexist);
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, FALSE);
|
||
|
btcoexist->stop_coex_dm = true;
|
||
|
coex_sta->wl_rf_off_on_event = false;
|
||
|
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, false,
|
||
|
true);
|
||
|
|
||
|
ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT);
|
||
|
|
||
|
halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, FALSE);
|
||
|
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, FALSE);
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist,
|
||
|
IN u8 pnp_state)
|
||
|
{
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (BTC_WIFI_PNP_SLEEP == pnp_state) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Pnp notify to SLEEP\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
/* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */
|
||
|
/* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */
|
||
|
/* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */
|
||
|
coex_sta->under_ips = false;
|
||
|
coex_sta->under_lps = false;
|
||
|
|
||
|
halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, FALSE);
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, FALSE);
|
||
|
} else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], Pnp notify to WAKE UP\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
halbtc8723d2ant_post_onoffstate_to_bt(btcoexist, TRUE);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info;
|
||
|
|
||
|
#if (BT_AUTO_REPORT_ONLY_8723D_2ANT == 0)
|
||
|
halbtc8723d2ant_query_bt_info(btcoexist);
|
||
|
#endif
|
||
|
|
||
|
halbtc8723d2ant_monitor_bt_ctr(btcoexist);
|
||
|
halbtc8723d2ant_monitor_wifi_ctr(btcoexist);
|
||
|
halbtc8723d2ant_monitor_bt_enable_disable(btcoexist);
|
||
|
|
||
|
/* for 4-way, DHCP, EAPOL packet */
|
||
|
if (coex_sta->specific_pkt_period_cnt > 0) {
|
||
|
|
||
|
coex_sta->specific_pkt_period_cnt--;
|
||
|
|
||
|
if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task))
|
||
|
coex_sta->wifi_is_high_pri_task = false;
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"));
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
}
|
||
|
|
||
|
if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist))
|
||
|
halbtc8723d2ant_run_coexist_mechanism(btcoexist);
|
||
|
}
|
||
|
|
||
|
|
||
|
void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist,
|
||
|
IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds)
|
||
|
{
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
#if BT_8723D_2ANT_ANTDET_ENABLE
|
||
|
static u32 ant_det_count = 0, ant_det_fail_count = 0;
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
/*boolean scan, roam;*/
|
||
|
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
if (seconds == 0) {
|
||
|
psd_scan->ant_det_try_count = 0;
|
||
|
psd_scan->ant_det_fail_count = 0;
|
||
|
ant_det_count = 0;
|
||
|
ant_det_fail_count = 0;
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
board_info->btdm_ant_num_by_ant_det = 1;
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (!board_info->btdm_ant_det_finish) {
|
||
|
psd_scan->ant_det_inteval_count =
|
||
|
psd_scan->ant_det_inteval_count + 2;
|
||
|
|
||
|
if (psd_scan->ant_det_inteval_count >=
|
||
|
BT_8723D_2ANT_ANTDET_RETRY_INTERVAL) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
halbtc8723d2ant_psd_antenna_detection_check(btcoexist);
|
||
|
|
||
|
if (board_info->btdm_ant_det_finish) {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
|
||
|
#if 0
|
||
|
board_info->btdm_ant_det_finish = false;
|
||
|
#endif
|
||
|
|
||
|
#if 0
|
||
|
if (board_info->btdm_ant_num_by_ant_det == 2)
|
||
|
halbtc8723d2ant_mechanism_switch(
|
||
|
btcoexist, true);
|
||
|
else
|
||
|
halbtc8723d2ant_mechanism_switch(
|
||
|
btcoexist, false);
|
||
|
#endif
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n");
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
psd_scan->ant_det_inteval_count = 0;
|
||
|
} else {
|
||
|
BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE,
|
||
|
"xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n",
|
||
|
psd_scan->ant_det_inteval_count);
|
||
|
BTC_TRACE(trace_buf);
|
||
|
}
|
||
|
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist)
|
||
|
{
|
||
|
|
||
|
#if BT_8723D_2ANT_ANTDET_ENABLE
|
||
|
struct btc_board_info *board_info = &btcoexist->board_info;
|
||
|
|
||
|
if (psd_scan->ant_det_try_count != 0) {
|
||
|
halbtc8723d2ant_psd_show_antenna_detect_result(btcoexist);
|
||
|
|
||
|
if (board_info->btdm_ant_det_finish)
|
||
|
halbtc8723d2ant_psd_showdata(btcoexist);
|
||
|
return;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
#endif
|
||
|
|
||
|
#endif /* #if (RTL8723D_SUPPORT == 1) */
|