// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause /* Copyright(c) 2018-2019 Realtek Corporation */ #include "main.h" #include "coex.h" #include "fw.h" #include "ps.h" #include "debug.h" #include "reg.h" static u8 rtw_coex_next_rssi_state(struct rtw_dev *rtwdev, u8 pre_state, u8 rssi, u8 rssi_thresh) { struct rtw_chip_info *chip = rtwdev->chip; u8 tol = chip->rssi_tolerance; u8 next_state; if (pre_state == COEX_RSSI_STATE_LOW || pre_state == COEX_RSSI_STATE_STAY_LOW) { if (rssi >= (rssi_thresh + tol)) next_state = COEX_RSSI_STATE_HIGH; else next_state = COEX_RSSI_STATE_STAY_LOW; } else { if (rssi < rssi_thresh) next_state = COEX_RSSI_STATE_LOW; else next_state = COEX_RSSI_STATE_STAY_HIGH; } return next_state; } static void rtw_coex_limited_tx(struct rtw_dev *rtwdev, bool tx_limit_en, bool ampdu_limit_en) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; bool wifi_under_b_mode = false; if (!chip->scbd_support) return; /* force max tx retry limit = 8 */ if (coex_stat->wl_tx_limit_en == tx_limit_en && coex_stat->wl_ampdu_limit_en == ampdu_limit_en) return; if (!coex_stat->wl_tx_limit_en) { coex_stat->darfrc = rtw_read32(rtwdev, REG_DARFRC); coex_stat->darfrch = rtw_read32(rtwdev, REG_DARFRCH); coex_stat->retry_limit = rtw_read16(rtwdev, REG_RETRY_LIMIT); } if (!coex_stat->wl_ampdu_limit_en) coex_stat->ampdu_max_time = rtw_read8(rtwdev, REG_AMPDU_MAX_TIME_V1); coex_stat->wl_tx_limit_en = tx_limit_en; coex_stat->wl_ampdu_limit_en = ampdu_limit_en; if (tx_limit_en) { /* set BT polluted packet on for tx rate adaptive, * not including tx retry broken by PTA */ rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_GNT_BT_AWAKE); /* set queue life time to avoid can't reach tx retry limit * if tx is always broken by GNT_BT */ rtw_write8_set(rtwdev, REG_LIFETIME_EN, 0xf); rtw_write16(rtwdev, REG_RETRY_LIMIT, 0x0808); /* auto rate fallback step within 8 retries */ if (wifi_under_b_mode) { rtw_write32(rtwdev, REG_DARFRC, 0x1000000); rtw_write32(rtwdev, REG_DARFRCH, 0x1010101); } else { rtw_write32(rtwdev, REG_DARFRC, 0x1000000); rtw_write32(rtwdev, REG_DARFRCH, 0x4030201); } } else { rtw_write8_clr(rtwdev, REG_TX_HANG_CTRL, BIT_EN_GNT_BT_AWAKE); rtw_write8_clr(rtwdev, REG_LIFETIME_EN, 0xf); rtw_write16(rtwdev, REG_RETRY_LIMIT, coex_stat->retry_limit); rtw_write32(rtwdev, REG_DARFRC, coex_stat->darfrc); rtw_write32(rtwdev, REG_DARFRCH, coex_stat->darfrch); } if (ampdu_limit_en) rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, 0x20); else rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, coex_stat->ampdu_max_time); } static void rtw_coex_limited_wl(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_coex_stat *coex_stat = &coex->stat; bool tx_limit = false; bool tx_agg_ctrl = false; if (coex->under_5g || coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { /* no need to limit tx */ } else { tx_limit = true; if (coex_stat->bt_hid_exist || coex_stat->bt_hfp_exist || coex_stat->bt_hid_pair_num > 0) tx_agg_ctrl = true; } rtw_coex_limited_tx(rtwdev, tx_limit, tx_agg_ctrl); } static void rtw_coex_wl_ccklock_action(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 para[6] = {0}; if (coex->stop_dm) return; para[0] = COEX_H2C69_WL_LEAKAP; if (coex_stat->tdma_timer_base == 3 && coex_stat->wl_slot_extend) { para[1] = PARA1_H2C69_DIS_5MS; /* disable 5ms extend */ rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); coex_stat->wl_slot_extend = false; coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; return; } if (coex_stat->wl_slot_extend && coex_stat->wl_force_lps_ctrl && !coex_stat->wl_cck_lock_ever) { if (coex_stat->wl_fw_dbg_info[7] <= 5) coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND]++; else coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; if (coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] == 7) { para[1] = 0x1; /* disable 5ms extend */ rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); coex_stat->wl_slot_extend = false; coex_stat->cnt_wl[COEX_CNT_WL_5MS_NOEXTEND] = 0; } } else if (!coex_stat->wl_slot_extend && coex_stat->wl_cck_lock) { para[1] = 0x0; /* enable 5ms extend */ rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); coex_stat->wl_slot_extend = true; } } static void rtw_coex_wl_ccklock_detect(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; /* TODO: wait for rx_rate_change_notify implement */ coex_stat->wl_cck_lock = false; coex_stat->wl_cck_lock_pre = false; coex_stat->wl_cck_lock_ever = false; } static void rtw_coex_wl_noisy_detect(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_dm_info *dm_info = &rtwdev->dm_info; u32 cnt_cck; /* wifi noisy environment identification */ cnt_cck = dm_info->cck_ok_cnt + dm_info->cck_err_cnt; if (!coex_stat->wl_gl_busy) { if (cnt_cck > 250) { if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] < 5) coex_stat->cnt_wl[COEX_CNT_WL_NOISY2]++; if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] == 5) { coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] = 0; coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] = 0; } } else if (cnt_cck < 100) { if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] < 5) coex_stat->cnt_wl[COEX_CNT_WL_NOISY0]++; if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] == 5) { coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] = 0; coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] = 0; } } else { if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] < 5) coex_stat->cnt_wl[COEX_CNT_WL_NOISY1]++; if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] == 5) { coex_stat->cnt_wl[COEX_CNT_WL_NOISY0] = 0; coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] = 0; } } if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY2] == 5) coex_stat->wl_noisy_level = 2; else if (coex_stat->cnt_wl[COEX_CNT_WL_NOISY1] == 5) coex_stat->wl_noisy_level = 1; else coex_stat->wl_noisy_level = 0; } } static void rtw_coex_tdma_timer_base(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 para[2] = {0}; if (coex_stat->tdma_timer_base == type) return; coex_stat->tdma_timer_base = type; para[0] = COEX_H2C69_TDMA_SLOT; if (type == 3) /* 4-slot */ para[1] = PARA1_H2C69_TDMA_4SLOT; /* 4-slot */ else /* 2-slot */ para[1] = PARA1_H2C69_TDMA_2SLOT; rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); /* no 5ms_wl_slot_extend for 4-slot mode */ if (coex_stat->tdma_timer_base == 3) rtw_coex_wl_ccklock_action(rtwdev); } static void rtw_coex_set_wl_pri_mask(struct rtw_dev *rtwdev, u8 bitmap, u8 data) { u32 addr; addr = REG_BT_COEX_TABLE_H + (bitmap / 8); bitmap = bitmap % 8; rtw_write8_mask(rtwdev, addr, BIT(bitmap), data); } void rtw_coex_write_scbd(struct rtw_dev *rtwdev, u16 bitpos, bool set) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u16 val = 0x2; if (!chip->scbd_support) return; val |= coex_stat->score_board; /* for 8822b, scbd[10] is CQDDR on * for 8822c, scbd[10] is no fix 2M */ if (!chip->new_scbd10_def && (bitpos & COEX_SCBD_FIX2M)) { if (set) val &= ~COEX_SCBD_FIX2M; else val |= COEX_SCBD_FIX2M; } else { if (set) val |= bitpos; else val &= ~bitpos; } if (val != coex_stat->score_board) { coex_stat->score_board = val; val |= BIT_BT_INT_EN; rtw_write16(rtwdev, REG_WIFI_BT_INFO, val); } } static u16 rtw_coex_read_scbd(struct rtw_dev *rtwdev) { struct rtw_chip_info *chip = rtwdev->chip; if (!chip->scbd_support) return 0; return (rtw_read16(rtwdev, REG_WIFI_BT_INFO)) & ~(BIT_BT_INT_EN); } static void rtw_coex_check_rfk(struct rtw_dev *rtwdev) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_rfe *coex_rfe = &coex->rfe; u8 cnt = 0; u32 wait_cnt; bool btk, wlk; if (coex_rfe->wlg_at_btg && chip->scbd_support && coex_stat->bt_iqk_state != 0xff) { wait_cnt = COEX_RFK_TIMEOUT / COEX_MIN_DELAY; do { /* BT RFK */ btk = !!(rtw_coex_read_scbd(rtwdev) & COEX_SCBD_BT_RFK); /* WL RFK */ wlk = !!(rtw_read8(rtwdev, REG_ARFR4) & BIT_WL_RFK); if (!btk && !wlk) break; mdelay(COEX_MIN_DELAY); } while (++cnt < wait_cnt); if (cnt >= wait_cnt) coex_stat->bt_iqk_state = 0xff; } } static void rtw_coex_query_bt_info(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; if (coex_stat->bt_disabled) return; rtw_fw_query_bt_info(rtwdev); } static void rtw_coex_monitor_bt_enable(struct rtw_dev *rtwdev) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; bool bt_disabled = false; u16 score_board; if (chip->scbd_support) { score_board = rtw_coex_read_scbd(rtwdev); bt_disabled = !(score_board & COEX_SCBD_ONOFF); } if (coex_stat->bt_disabled != bt_disabled) { rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: BT state changed (%d) -> (%d)\n", coex_stat->bt_disabled, bt_disabled); coex_stat->bt_disabled = bt_disabled; coex_stat->bt_ble_scan_type = 0; coex_dm->cur_bt_lna_lvl = 0; } if (!coex_stat->bt_disabled) { coex_stat->bt_reenable = true; ieee80211_queue_delayed_work(rtwdev->hw, &coex->bt_reenable_work, 15 * HZ); } else { coex_stat->bt_mailbox_reply = false; coex_stat->bt_reenable = false; } } static void rtw_coex_update_wl_link_info(struct rtw_dev *rtwdev, u8 reason) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_chip_info *chip = rtwdev->chip; struct rtw_traffic_stats *stats = &rtwdev->stats; bool is_5G = false; bool scan = false, link = false; int i; u8 rssi_state; u8 rssi_step; u8 rssi; scan = test_bit(RTW_FLAG_SCANNING, rtwdev->flags); coex_stat->wl_connected = !!rtwdev->sta_cnt; coex_stat->wl_gl_busy = test_bit(RTW_FLAG_BUSY_TRAFFIC, rtwdev->flags); if (stats->tx_throughput > stats->rx_throughput) coex_stat->wl_tput_dir = COEX_WL_TPUT_TX; else coex_stat->wl_tput_dir = COEX_WL_TPUT_RX; if (scan || link || reason == COEX_RSN_2GCONSTART || reason == COEX_RSN_2GSCANSTART || reason == COEX_RSN_2GSWITCHBAND) coex_stat->wl_linkscan_proc = true; else coex_stat->wl_linkscan_proc = false; rtw_coex_wl_noisy_detect(rtwdev); for (i = 0; i < 4; i++) { rssi_state = coex_dm->wl_rssi_state[i]; rssi_step = chip->wl_rssi_step[i]; rssi = rtwdev->dm_info.min_rssi; rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, rssi, rssi_step); coex_dm->wl_rssi_state[i] = rssi_state; } switch (reason) { case COEX_RSN_5GSCANSTART: case COEX_RSN_5GSWITCHBAND: case COEX_RSN_5GCONSTART: is_5G = true; break; case COEX_RSN_2GSCANSTART: case COEX_RSN_2GSWITCHBAND: case COEX_RSN_2GCONSTART: is_5G = false; break; default: if (rtwdev->hal.current_band_type == RTW_BAND_5G) is_5G = true; else is_5G = false; break; } coex->under_5g = is_5G; } static inline u8 *get_payload_from_coex_resp(struct sk_buff *resp) { struct rtw_c2h_cmd *c2h; u32 pkt_offset; pkt_offset = *((u32 *)resp->cb); c2h = (struct rtw_c2h_cmd *)(resp->data + pkt_offset); return c2h->payload; } void rtw_coex_info_response(struct rtw_dev *rtwdev, struct sk_buff *skb) { struct rtw_coex *coex = &rtwdev->coex; u8 *payload = get_payload_from_coex_resp(skb); if (payload[0] != COEX_RESP_ACK_BY_WL_FW) return; skb_queue_tail(&coex->queue, skb); wake_up(&coex->wait); } static struct sk_buff *rtw_coex_info_request(struct rtw_dev *rtwdev, struct rtw_coex_info_req *req) { struct rtw_coex *coex = &rtwdev->coex; struct sk_buff *skb_resp = NULL; mutex_lock(&coex->mutex); rtw_fw_query_bt_mp_info(rtwdev, req); if (!wait_event_timeout(coex->wait, !skb_queue_empty(&coex->queue), COEX_REQUEST_TIMEOUT)) { rtw_err(rtwdev, "coex request time out\n"); goto out; } skb_resp = skb_dequeue(&coex->queue); if (!skb_resp) { rtw_err(rtwdev, "failed to get coex info response\n"); goto out; } out: mutex_unlock(&coex->mutex); return skb_resp; } static bool rtw_coex_get_bt_scan_type(struct rtw_dev *rtwdev, u8 *scan_type) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; u8 *payload; bool ret = false; req.op_code = BT_MP_INFO_OP_SCAN_TYPE; skb = rtw_coex_info_request(rtwdev, &req); if (!skb) goto out; payload = get_payload_from_coex_resp(skb); *scan_type = GET_COEX_RESP_BT_SCAN_TYPE(payload); dev_kfree_skb_any(skb); ret = true; out: return ret; } static bool rtw_coex_set_lna_constrain_level(struct rtw_dev *rtwdev, u8 lna_constrain_level) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; bool ret = false; req.op_code = BT_MP_INFO_OP_LNA_CONSTRAINT; req.para1 = lna_constrain_level; skb = rtw_coex_info_request(rtwdev, &req); if (!skb) goto out; dev_kfree_skb_any(skb); ret = true; out: return ret; } static void rtw_coex_update_bt_link_info(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_chip_info *chip = rtwdev->chip; u8 i; u8 rssi_state; u8 rssi_step; u8 rssi; /* update wl/bt rssi by btinfo */ for (i = 0; i < COEX_RSSI_STEP; i++) { rssi_state = coex_dm->bt_rssi_state[i]; rssi_step = chip->bt_rssi_step[i]; rssi = coex_stat->bt_rssi; rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, rssi, rssi_step); coex_dm->bt_rssi_state[i] = rssi_state; } for (i = 0; i < COEX_RSSI_STEP; i++) { rssi_state = coex_dm->wl_rssi_state[i]; rssi_step = chip->wl_rssi_step[i]; rssi = rtwdev->dm_info.min_rssi; rssi_state = rtw_coex_next_rssi_state(rtwdev, rssi_state, rssi, rssi_step); coex_dm->wl_rssi_state[i] = rssi_state; } if (coex_stat->bt_ble_scan_en && coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE] % 3 == 0) { u8 scan_type; if (rtw_coex_get_bt_scan_type(rtwdev, &scan_type)) { coex_stat->bt_ble_scan_type = scan_type; if ((coex_stat->bt_ble_scan_type & 0x1) == 0x1) coex_stat->bt_init_scan = true; else coex_stat->bt_init_scan = false; } } coex_stat->bt_profile_num = 0; /* set link exist status */ if (!(coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION)) { coex_stat->bt_link_exist = false; coex_stat->bt_pan_exist = false; coex_stat->bt_a2dp_exist = false; coex_stat->bt_hid_exist = false; coex_stat->bt_hfp_exist = false; } else { /* connection exists */ coex_stat->bt_link_exist = true; if (coex_stat->bt_info_lb2 & COEX_INFO_FTP) { coex_stat->bt_pan_exist = true; coex_stat->bt_profile_num++; } else { coex_stat->bt_pan_exist = false; } if (coex_stat->bt_info_lb2 & COEX_INFO_A2DP) { coex_stat->bt_a2dp_exist = true; coex_stat->bt_profile_num++; } else { coex_stat->bt_a2dp_exist = false; } if (coex_stat->bt_info_lb2 & COEX_INFO_HID) { coex_stat->bt_hid_exist = true; coex_stat->bt_profile_num++; } else { coex_stat->bt_hid_exist = false; } if (coex_stat->bt_info_lb2 & COEX_INFO_SCO_ESCO) { coex_stat->bt_hfp_exist = true; coex_stat->bt_profile_num++; } else { coex_stat->bt_hfp_exist = false; } } if (coex_stat->bt_info_lb2 & COEX_INFO_INQ_PAGE) { coex_dm->bt_status = COEX_BTSTATUS_INQ_PAGE; } else if (!(coex_stat->bt_info_lb2 & COEX_INFO_CONNECTION)) { coex_dm->bt_status = COEX_BTSTATUS_NCON_IDLE; } else if (coex_stat->bt_info_lb2 == COEX_INFO_CONNECTION) { coex_dm->bt_status = COEX_BTSTATUS_CON_IDLE; } else if ((coex_stat->bt_info_lb2 & COEX_INFO_SCO_ESCO) || (coex_stat->bt_info_lb2 & COEX_INFO_SCO_BUSY)) { if (coex_stat->bt_info_lb2 & COEX_INFO_ACL_BUSY) coex_dm->bt_status = COEX_BTSTATUS_ACL_SCO_BUSY; else coex_dm->bt_status = COEX_BTSTATUS_SCO_BUSY; } else if (coex_stat->bt_info_lb2 & COEX_INFO_ACL_BUSY) { coex_dm->bt_status = COEX_BTSTATUS_ACL_BUSY; } else { coex_dm->bt_status = COEX_BTSTATUS_MAX; } coex_stat->cnt_bt[COEX_CNT_BT_INFOUPDATE]++; rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: bt status(%d)\n", coex_dm->bt_status); } static void rtw_coex_update_wl_ch_info(struct rtw_dev *rtwdev, u8 type) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex_dm *coex_dm = &rtwdev->coex.dm; struct rtw_efuse *efuse = &rtwdev->efuse; u8 link = 0; u8 center_chan = 0; u8 bw; int i; bw = rtwdev->hal.current_band_width; if (type != COEX_MEDIA_DISCONNECT) center_chan = rtwdev->hal.current_channel; if (center_chan == 0 || (efuse->share_ant && center_chan <= 14)) { link = 0; } else if (center_chan <= 14) { link = 0x1; if (bw == RTW_CHANNEL_WIDTH_40) bw = chip->bt_afh_span_bw40; else bw = chip->bt_afh_span_bw20; } else if (chip->afh_5g_num > 1) { for (i = 0; i < chip->afh_5g_num; i++) { if (center_chan == chip->afh_5g[i].wl_5g_ch) { link = 0x3; center_chan = chip->afh_5g[i].bt_skip_ch; bw = chip->afh_5g[i].bt_skip_span; break; } } } coex_dm->wl_ch_info[0] = link; coex_dm->wl_ch_info[1] = center_chan; coex_dm->wl_ch_info[2] = bw; rtw_fw_wl_ch_info(rtwdev, link, center_chan, bw); } static void rtw_coex_set_bt_tx_power(struct rtw_dev *rtwdev, u8 bt_pwr_dec_lvl) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; if (bt_pwr_dec_lvl == coex_dm->cur_bt_pwr_lvl) return; coex_dm->cur_bt_pwr_lvl = bt_pwr_dec_lvl; rtw_fw_force_bt_tx_power(rtwdev, bt_pwr_dec_lvl); } static void rtw_coex_set_bt_rx_gain(struct rtw_dev *rtwdev, u8 bt_lna_lvl) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; if (bt_lna_lvl == coex_dm->cur_bt_lna_lvl) return; coex_dm->cur_bt_lna_lvl = bt_lna_lvl; /* notify BT rx gain table changed */ if (bt_lna_lvl < 7) { rtw_coex_set_lna_constrain_level(rtwdev, bt_lna_lvl); rtw_coex_write_scbd(rtwdev, COEX_SCBD_RXGAIN, true); } else { rtw_coex_write_scbd(rtwdev, COEX_SCBD_RXGAIN, false); } } static void rtw_coex_set_rf_para(struct rtw_dev *rtwdev, struct coex_rf_para para) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 offset = 0; if (coex->freerun && coex_stat->wl_noisy_level <= 1) offset = 3; rtw_coex_set_wl_tx_power(rtwdev, para.wl_pwr_dec_lvl); rtw_coex_set_bt_tx_power(rtwdev, para.bt_pwr_dec_lvl + offset); rtw_coex_set_wl_rx_gain(rtwdev, para.wl_low_gain_en); rtw_coex_set_bt_rx_gain(rtwdev, para.bt_lna_lvl); } u32 rtw_coex_read_indirect_reg(struct rtw_dev *rtwdev, u16 addr) { u32 val; if (!ltecoex_read_reg(rtwdev, addr, &val)) { rtw_err(rtwdev, "failed to read indirect register\n"); return 0; } return val; } void rtw_coex_write_indirect_reg(struct rtw_dev *rtwdev, u16 addr, u32 mask, u32 val) { u32 shift = __ffs(mask); u32 tmp; tmp = rtw_coex_read_indirect_reg(rtwdev, addr); tmp = (tmp & (~mask)) | ((val << shift) & mask); if (!ltecoex_reg_write(rtwdev, addr, tmp)) rtw_err(rtwdev, "failed to write indirect register\n"); } static void rtw_coex_coex_ctrl_owner(struct rtw_dev *rtwdev, bool wifi_control) { if (wifi_control) rtw_write32_set(rtwdev, REG_SYS_SDIO_CTRL, BIT_LTE_MUX_CTRL_PATH); else rtw_write32_clr(rtwdev, REG_SYS_SDIO_CTRL, BIT_LTE_MUX_CTRL_PATH); } static void rtw_coex_set_gnt_bt(struct rtw_dev *rtwdev, u8 state) { rtw_coex_write_indirect_reg(rtwdev, 0x38, 0xc000, state); rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x0c00, state); } static void rtw_coex_set_gnt_wl(struct rtw_dev *rtwdev, u8 state) { rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x3000, state); rtw_coex_write_indirect_reg(rtwdev, 0x38, 0x0300, state); } static void rtw_coex_set_table(struct rtw_dev *rtwdev, u32 table0, u32 table1) { #define DEF_BRK_TABLE_VAL 0xf0ffffff rtw_write32(rtwdev, REG_BT_COEX_TABLE0, table0); rtw_write32(rtwdev, REG_BT_COEX_TABLE1, table1); rtw_write32(rtwdev, REG_BT_COEX_BRK_TABLE, DEF_BRK_TABLE_VAL); } static void rtw_coex_table(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_chip_info *chip = rtwdev->chip; struct rtw_efuse *efuse = &rtwdev->efuse; coex_dm->cur_table = type; if (efuse->share_ant) { if (type < chip->table_sant_num) rtw_coex_set_table(rtwdev, chip->table_sant[type].bt, chip->table_sant[type].wl); } else { type = type - 100; if (type < chip->table_nsant_num) rtw_coex_set_table(rtwdev, chip->table_nsant[type].bt, chip->table_nsant[type].wl); } } static void rtw_coex_ignore_wlan_act(struct rtw_dev *rtwdev, bool enable) { struct rtw_coex *coex = &rtwdev->coex; if (coex->stop_dm) return; rtw_fw_bt_ignore_wlan_action(rtwdev, enable); } static void rtw_coex_power_save_state(struct rtw_dev *rtwdev, u8 ps_type, u8 lps_val, u8 rpwm_val) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 lps_mode = 0x0; lps_mode = rtwdev->lps_conf.mode; switch (ps_type) { case COEX_PS_WIFI_NATIVE: /* recover to original 32k low power setting */ coex_stat->wl_force_lps_ctrl = false; rtw_leave_lps(rtwdev); break; case COEX_PS_LPS_OFF: coex_stat->wl_force_lps_ctrl = true; if (lps_mode) rtw_fw_coex_tdma_type(rtwdev, 0x8, 0, 0, 0, 0); rtw_leave_lps(rtwdev); break; default: break; } } static void rtw_coex_set_tdma(struct rtw_dev *rtwdev, u8 byte1, u8 byte2, u8 byte3, u8 byte4, u8 byte5) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_chip_info *chip = rtwdev->chip; u8 ps_type = COEX_PS_WIFI_NATIVE; bool ap_enable = false; if (ap_enable && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { byte1 &= ~BIT(4); byte1 |= BIT(5); byte5 |= BIT(5); byte5 &= ~BIT(6); ps_type = COEX_PS_WIFI_NATIVE; rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { if (chip->pstdma_type == COEX_PSTDMA_FORCE_LPSOFF) ps_type = COEX_PS_LPS_OFF; else ps_type = COEX_PS_LPS_ON; rtw_coex_power_save_state(rtwdev, ps_type, 0x50, 0x4); } else { ps_type = COEX_PS_WIFI_NATIVE; rtw_coex_power_save_state(rtwdev, ps_type, 0x0, 0x0); } coex_dm->ps_tdma_para[0] = 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] = byte5; rtw_fw_coex_tdma_type(rtwdev, byte1, byte2, byte3, byte4, byte5); } static void rtw_coex_tdma(struct rtw_dev *rtwdev, bool force, u32 tcase) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_chip_info *chip = rtwdev->chip; struct rtw_efuse *efuse = &rtwdev->efuse; u8 n, type; bool turn_on; if (tcase & TDMA_4SLOT)/* 4-slot (50ms) mode */ rtw_coex_tdma_timer_base(rtwdev, 3); else rtw_coex_tdma_timer_base(rtwdev, 0); type = (u8)(tcase & 0xff); turn_on = (type == 0 || type == 100) ? false : true; if (!force) { if (turn_on == coex_dm->cur_ps_tdma_on && type == coex_dm->cur_ps_tdma) { return; } } if (turn_on) { /* enable TBTT interrupt */ rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION); rtw_coex_write_scbd(rtwdev, COEX_SCBD_TDMA, true); } else { rtw_coex_write_scbd(rtwdev, COEX_SCBD_TDMA, false); } if (efuse->share_ant) { if (type < chip->tdma_sant_num) rtw_coex_set_tdma(rtwdev, chip->tdma_sant[type].para[0], chip->tdma_sant[type].para[1], chip->tdma_sant[type].para[2], chip->tdma_sant[type].para[3], chip->tdma_sant[type].para[4]); } else { n = type - 100; if (n < chip->tdma_nsant_num) rtw_coex_set_tdma(rtwdev, chip->tdma_nsant[n].para[0], chip->tdma_nsant[n].para[1], chip->tdma_nsant[n].para[2], chip->tdma_nsant[n].para[3], chip->tdma_nsant[n].para[4]); } /* update pre state */ coex_dm->cur_ps_tdma_on = turn_on; coex_dm->cur_ps_tdma = type; rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: coex tdma type (%d)\n", type); } static void rtw_coex_set_ant_path(struct rtw_dev *rtwdev, bool force, u8 phase) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; u8 ctrl_type = COEX_SWITCH_CTRL_MAX; u8 pos_type = COEX_SWITCH_TO_MAX; if (!force && coex_dm->cur_ant_pos_type == phase) return; coex_dm->cur_ant_pos_type = phase; /* avoid switch coex_ctrl_owner during BT IQK */ rtw_coex_check_rfk(rtwdev); switch (phase) { case COEX_SET_ANT_POWERON: /* set path control owner to BT at power-on */ if (coex_stat->bt_disabled) rtw_coex_coex_ctrl_owner(rtwdev, true); else rtw_coex_coex_ctrl_owner(rtwdev, false); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_BT; break; case COEX_SET_ANT_INIT: if (coex_stat->bt_disabled) { /* set GNT_BT to SW low */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); /* set GNT_WL to SW high */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); } else { /* set GNT_BT to SW high */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); /* set GNT_WL to SW low */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_LOW); } /* set path control owner to wl at initial step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_BT; break; case COEX_SET_ANT_WONLY: /* set GNT_BT to SW Low */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_LOW); /* Set GNT_WL to SW high */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); /* set path control owner to wl at initial step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_WLG; break; case COEX_SET_ANT_WOFF: /* set path control owner to BT */ rtw_coex_coex_ctrl_owner(rtwdev, false); ctrl_type = COEX_SWITCH_CTRL_BY_BT; pos_type = COEX_SWITCH_TO_NOCARE; break; case COEX_SET_ANT_2G: /* set GNT_BT to PTA */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); /* set GNT_WL to PTA */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_HW_PTA); /* set path control owner to wl at runtime step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_PTA; pos_type = COEX_SWITCH_TO_NOCARE; break; case COEX_SET_ANT_5G: /* set GNT_BT to PTA */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); /* set GNT_WL to SW high */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); /* set path control owner to wl at runtime step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_WLA; break; case COEX_SET_ANT_2G_FREERUN: /* set GNT_BT to SW high */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_SW_HIGH); /* Set GNT_WL to SW high */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_SW_HIGH); /* set path control owner to wl at runtime step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_WLG_BT; break; case COEX_SET_ANT_2G_WLBT: /* set GNT_BT to SW high */ rtw_coex_set_gnt_bt(rtwdev, COEX_GNT_SET_HW_PTA); /* Set GNT_WL to SW high */ rtw_coex_set_gnt_wl(rtwdev, COEX_GNT_SET_HW_PTA); /* set path control owner to wl at runtime step */ rtw_coex_coex_ctrl_owner(rtwdev, true); ctrl_type = COEX_SWITCH_CTRL_BY_BBSW; pos_type = COEX_SWITCH_TO_WLG_BT; break; default: WARN(1, "unknown phase when setting antenna path\n"); return; } if (ctrl_type < COEX_SWITCH_CTRL_MAX && pos_type < COEX_SWITCH_TO_MAX) rtw_coex_set_ant_switch(rtwdev, ctrl_type, pos_type); } static u8 rtw_coex_algorithm(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 algorithm = COEX_ALGO_NOPROFILE; u8 profile_map = 0; if (coex_stat->bt_hfp_exist) profile_map |= BPM_HFP; if (coex_stat->bt_hid_exist) profile_map |= BPM_HID; if (coex_stat->bt_a2dp_exist) profile_map |= BPM_A2DP; if (coex_stat->bt_pan_exist) profile_map |= BPM_PAN; switch (profile_map) { case BPM_HFP: algorithm = COEX_ALGO_HFP; break; case BPM_HID: case BPM_HFP + BPM_HID: algorithm = COEX_ALGO_HID; break; case BPM_HFP + BPM_A2DP: case BPM_HID + BPM_A2DP: case BPM_HFP + BPM_HID + BPM_A2DP: algorithm = COEX_ALGO_A2DP_HID; break; case BPM_HFP + BPM_PAN: case BPM_HID + BPM_PAN: case BPM_HFP + BPM_HID + BPM_PAN: algorithm = COEX_ALGO_PAN_HID; break; case BPM_HFP + BPM_A2DP + BPM_PAN: case BPM_HID + BPM_A2DP + BPM_PAN: case BPM_HFP + BPM_HID + BPM_A2DP + BPM_PAN: algorithm = COEX_ALGO_A2DP_PAN_HID; break; case BPM_PAN: algorithm = COEX_ALGO_PAN; break; case BPM_A2DP + BPM_PAN: algorithm = COEX_ALGO_A2DP_PAN; break; case BPM_A2DP: if (coex_stat->bt_multi_link) { if (coex_stat->bt_hid_pair_num > 0) algorithm = COEX_ALGO_A2DP_HID; else algorithm = COEX_ALGO_A2DP_PAN; } else { algorithm = COEX_ALGO_A2DP; } break; default: algorithm = COEX_ALGO_NOPROFILE; break; } return algorithm; } static void rtw_coex_action_coex_all_off(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 2; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_freerun(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 level = 0; if (efuse->share_ant) return; coex->freerun = true; if (coex_stat->wl_connected) rtw_coex_update_wl_ch_info(rtwdev, COEX_MEDIA_CONNECT); rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[0])) level = 2; else if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) level = 3; else if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[2])) level = 4; else level = 5; if (level > chip->wl_rf_para_num - 1) level = chip->wl_rf_para_num - 1; if (coex_stat->wl_tput_dir == COEX_WL_TPUT_TX) rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_tx[level]); else rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[level]); rtw_coex_table(rtwdev, 100); rtw_coex_tdma(rtwdev, false, 100); } static void rtw_coex_action_bt_whql_test(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 2; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_relink(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 1; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_idle(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; struct rtw_coex_rfe *coex_rfe = &coex->rfe; u8 table_case = 0xff, tdma_case = 0xff; if (coex_rfe->ant_switch_with_bt && coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { if (efuse->share_ant && COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) { table_case = 0; tdma_case = 0; } else if (!efuse->share_ant) { table_case = 100; tdma_case = 100; } } if (table_case != 0xff && tdma_case != 0xff) { rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G_FREERUN); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); return; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); if (efuse->share_ant) { /* Shared-Ant */ if (!coex_stat->wl_gl_busy) { table_case = 10; tdma_case = 3; } else if (coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { table_case = 6; tdma_case = 7; } else { table_case = 12; tdma_case = 7; } } else { /* Non-Shared-Ant */ if (!coex_stat->wl_gl_busy) { table_case = 112; tdma_case = 104; } else if ((coex_stat->bt_ble_scan_type & 0x2) && coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE) { table_case = 114; tdma_case = 103; } else { table_case = 112; tdma_case = 103; } } rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_inquiry(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; bool wl_hi_pri = false; u8 table_case, tdma_case; u32 slot_type = 0; if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || coex_stat->wl_hi_pri_task2) wl_hi_pri = true; if (efuse->share_ant) { /* Shared-Ant */ if (wl_hi_pri) { table_case = 15; if (coex_stat->bt_a2dp_exist && !coex_stat->bt_pan_exist) { slot_type = TDMA_4SLOT; tdma_case = 11; } else if (coex_stat->wl_hi_pri_task1) { tdma_case = 6; } else if (!coex_stat->bt_page) { tdma_case = 8; } else { tdma_case = 9; } } else if (coex_stat->wl_connected) { table_case = 10; tdma_case = 10; } else { table_case = 1; tdma_case = 0; } } else { /* Non_Shared-Ant */ if (wl_hi_pri) { table_case = 113; if (coex_stat->bt_a2dp_exist && !coex_stat->bt_pan_exist) tdma_case = 111; else if (coex_stat->wl_hi_pri_task1) tdma_case = 106; else if (!coex_stat->bt_page) tdma_case = 108; else tdma_case = 109; } else if (coex_stat->wl_connected) { table_case = 101; tdma_case = 110; } else { table_case = 100; tdma_case = 100; } } rtw_dbg(rtwdev, RTW_DBG_COEX, "coex: wifi hi(%d), bt page(%d)\n", wl_hi_pri, coex_stat->bt_page); rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); } static void rtw_coex_action_bt_hfp(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ if (coex_stat->bt_multi_link) { table_case = 10; tdma_case = 17; } else { table_case = 10; tdma_case = 5; } } else { /* Non-Shared-Ant */ if (coex_stat->bt_multi_link) { table_case = 112; tdma_case = 117; } else { table_case = 105; tdma_case = 100; } } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_hid(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; u32 wl_bw; wl_bw = rtwdev->hal.current_band_width; if (efuse->share_ant) { /* Shared-Ant */ if (coex_stat->bt_ble_exist) { /* RCU */ if (!coex_stat->wl_gl_busy) table_case = 14; else table_case = 15; if (coex_stat->bt_a2dp_active || wl_bw == 0) tdma_case = 18; else if (coex_stat->wl_gl_busy) tdma_case = 8; else tdma_case = 4; } else { if (coex_stat->bt_a2dp_active || wl_bw == 0) { table_case = 8; tdma_case = 4; } else { /* for 4/18 HID */ if (coex_stat->bt_418_hid_exist && coex_stat->wl_gl_busy) table_case = 12; else table_case = 10; tdma_case = 4; } } } else { /* Non-Shared-Ant */ if (coex_stat->bt_a2dp_active) { table_case = 113; tdma_case = 118; } else if (coex_stat->bt_ble_exist) { /* BLE */ table_case = 113; if (coex_stat->wl_gl_busy) tdma_case = 106; else tdma_case = 104; } else { table_case = 113; tdma_case = 104; } } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_a2dp(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; u32 slot_type = 0; if (efuse->share_ant) { /* Shared-Ant */ slot_type = TDMA_4SLOT; if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) table_case = 10; else table_case = 9; if (coex_stat->wl_gl_busy) tdma_case = 13; else tdma_case = 14; } else { /* Non-Shared-Ant */ table_case = 112; if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) tdma_case = 112; else tdma_case = 113; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); } static void rtw_coex_action_bt_a2dpsink(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; bool ap_enable = false; if (efuse->share_ant) { /* Shared-Ant */ if (ap_enable) { table_case = 2; tdma_case = 0; } else if (coex_stat->wl_gl_busy) { table_case = 28; tdma_case = 20; } else { table_case = 28; tdma_case = 26; } } else { /* Non-Shared-Ant */ if (ap_enable) { table_case = 100; tdma_case = 100; } else { table_case = 119; tdma_case = 120; } } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_pan(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) table_case = 14; else table_case = 10; if (coex_stat->wl_gl_busy) tdma_case = 17; else tdma_case = 19; } else { /* Non-Shared-Ant */ table_case = 112; if (coex_stat->wl_gl_busy) tdma_case = 117; else tdma_case = 119; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_a2dp_hid(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; u32 slot_type = 0; if (efuse->share_ant) { /* Shared-Ant */ slot_type = TDMA_4SLOT; if (coex_stat->bt_ble_exist) table_case = 26; else table_case = 9; if (coex_stat->wl_gl_busy) { tdma_case = 13; } else { tdma_case = 14; } } else { /* Non-Shared-Ant */ if (coex_stat->bt_ble_exist) table_case = 121; else table_case = 113; if (COEX_RSSI_HIGH(coex_dm->wl_rssi_state[1])) tdma_case = 112; else tdma_case = 113; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); } static void rtw_coex_action_bt_a2dp_pan(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ if (coex_stat->wl_gl_busy && coex_stat->wl_noisy_level == 0) table_case = 14; else table_case = 10; if (coex_stat->wl_gl_busy) tdma_case = 15; else tdma_case = 20; } else { /* Non-Shared-Ant */ table_case = 112; if (coex_stat->wl_gl_busy) tdma_case = 115; else tdma_case = 120; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_pan_hid(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 9; if (coex_stat->wl_gl_busy) tdma_case = 18; else tdma_case = 19; } else { /* Non-Shared-Ant */ table_case = 113; if (coex_stat->wl_gl_busy) tdma_case = 117; else tdma_case = 119; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_bt_a2dp_pan_hid(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 10; if (coex_stat->wl_gl_busy) tdma_case = 15; else tdma_case = 20; } else { /* Non-Shared-Ant */ table_case = 113; if (coex_stat->wl_gl_busy) tdma_case = 115; else tdma_case = 120; } rtw_coex_set_ant_path(rtwdev, false, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_wl_under5g(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); if (efuse->share_ant) { /* Shared-Ant */ table_case = 0; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_wl_only(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 2; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_wl_native_lps(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (coex->under_5g) return; if (efuse->share_ant) { /* Shared-Ant */ table_case = 28; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_wl_linkscan(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; u32 slot_type = 0; if (efuse->share_ant) { /* Shared-Ant */ if (coex_stat->bt_a2dp_exist) { slot_type = TDMA_4SLOT; table_case = 9; tdma_case = 11; } else { table_case = 9; tdma_case = 7; } } else { /* Non-Shared-Ant */ if (coex_stat->bt_a2dp_exist) { table_case = 112; tdma_case = 111; } else { table_case = 112; tdma_case = 107; } } rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case | slot_type); } static void rtw_coex_action_wl_not_connected(struct rtw_dev *rtwdev) { struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_chip_info *chip = rtwdev->chip; u8 table_case, tdma_case; if (efuse->share_ant) { /* Shared-Ant */ table_case = 1; tdma_case = 0; } else { /* Non-Shared-Ant */ table_case = 100; tdma_case = 100; } rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_set_rf_para(rtwdev, chip->wl_rf_para_rx[0]); rtw_coex_table(rtwdev, table_case); rtw_coex_tdma(rtwdev, false, tdma_case); } static void rtw_coex_action_wl_connected(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_efuse *efuse = &rtwdev->efuse; u8 algorithm; /* Non-Shared-Ant */ if (!efuse->share_ant && coex_stat->wl_gl_busy && COEX_RSSI_HIGH(coex_dm->wl_rssi_state[3]) && COEX_RSSI_HIGH(coex_dm->bt_rssi_state[0])) { rtw_coex_action_freerun(rtwdev); return; } algorithm = rtw_coex_algorithm(rtwdev); switch (algorithm) { case COEX_ALGO_HFP: rtw_coex_action_bt_hfp(rtwdev); break; case COEX_ALGO_HID: rtw_coex_action_bt_hid(rtwdev); break; case COEX_ALGO_A2DP: if (coex_stat->bt_a2dp_sink) rtw_coex_action_bt_a2dpsink(rtwdev); else rtw_coex_action_bt_a2dp(rtwdev); break; case COEX_ALGO_PAN: rtw_coex_action_bt_pan(rtwdev); break; case COEX_ALGO_A2DP_HID: rtw_coex_action_bt_a2dp_hid(rtwdev); break; case COEX_ALGO_A2DP_PAN: rtw_coex_action_bt_a2dp_pan(rtwdev); break; case COEX_ALGO_PAN_HID: rtw_coex_action_bt_pan_hid(rtwdev); break; case COEX_ALGO_A2DP_PAN_HID: rtw_coex_action_bt_a2dp_pan_hid(rtwdev); break; default: case COEX_ALGO_NOPROFILE: rtw_coex_action_bt_idle(rtwdev); break; } } static void rtw_coex_run_coex(struct rtw_dev *rtwdev, u8 reason) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_coex_stat *coex_stat = &coex->stat; lockdep_assert_held(&rtwdev->mutex); if (!test_bit(RTW_FLAG_RUNNING, rtwdev->flags)) return; coex_dm->reason = reason; /* update wifi_link_info_ext variable */ rtw_coex_update_wl_link_info(rtwdev, reason); rtw_coex_monitor_bt_enable(rtwdev); if (coex->stop_dm) return; if (coex_stat->wl_under_ips) return; if (coex->freeze && !coex_stat->bt_setup_link) return; coex_stat->cnt_wl[COEX_CNT_WL_COEXRUN]++; coex->freerun = false; /* Pure-5G Coex Process */ if (coex->under_5g) { coex_stat->wl_coex_mode = COEX_WLINK_5G; rtw_coex_action_wl_under5g(rtwdev); goto exit; } coex_stat->wl_coex_mode = COEX_WLINK_2G1PORT; rtw_coex_write_scbd(rtwdev, COEX_SCBD_FIX2M, false); if (coex_stat->bt_disabled) { rtw_coex_action_wl_only(rtwdev); goto exit; } if (coex_stat->wl_under_lps && !coex_stat->wl_force_lps_ctrl) { rtw_coex_action_wl_native_lps(rtwdev); goto exit; } if (coex_stat->bt_whck_test) { rtw_coex_action_bt_whql_test(rtwdev); goto exit; } if (coex_stat->bt_setup_link) { rtw_coex_action_bt_relink(rtwdev); goto exit; } if (coex_stat->bt_inq_page) { rtw_coex_action_bt_inquiry(rtwdev); goto exit; } if ((coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE || coex_dm->bt_status == COEX_BTSTATUS_CON_IDLE) && coex_stat->wl_connected) { rtw_coex_action_bt_idle(rtwdev); goto exit; } if (coex_stat->wl_linkscan_proc) { rtw_coex_action_wl_linkscan(rtwdev); goto exit; } if (coex_stat->wl_connected) rtw_coex_action_wl_connected(rtwdev); else rtw_coex_action_wl_not_connected(rtwdev); exit: rtw_coex_set_gnt_fix(rtwdev); rtw_coex_limited_wl(rtwdev); } static void rtw_coex_init_coex_var(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; u8 i; memset(coex_dm, 0, sizeof(*coex_dm)); memset(coex_stat, 0, sizeof(*coex_stat)); for (i = 0; i < COEX_CNT_WL_MAX; i++) coex_stat->cnt_wl[i] = 0; for (i = 0; i < COEX_CNT_BT_MAX; i++) coex_stat->cnt_bt[i] = 0; for (i = 0; i < ARRAY_SIZE(coex_dm->bt_rssi_state); i++) coex_dm->bt_rssi_state[i] = COEX_RSSI_STATE_LOW; for (i = 0; i < ARRAY_SIZE(coex_dm->wl_rssi_state); i++) coex_dm->wl_rssi_state[i] = COEX_RSSI_STATE_LOW; coex_stat->wl_coex_mode = COEX_WLINK_MAX; } static void __rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) { struct rtw_coex *coex = &rtwdev->coex; rtw_coex_init_coex_var(rtwdev); rtw_coex_monitor_bt_enable(rtwdev); rtw_coex_set_rfe_type(rtwdev); rtw_coex_set_init(rtwdev); /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_RSP, 1); /* set Tx beacon = Hi-Pri */ rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_BEACON, 1); /* set Tx beacon queue = Hi-Pri */ rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_TX_BEACONQ, 1); /* antenna config */ if (coex->wl_rf_off) { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); rtw_coex_write_scbd(rtwdev, COEX_SCBD_ALL, false); coex->stop_dm = true; } else if (wifi_only) { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WONLY); rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN, true); coex->stop_dm = true; } else { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_INIT); rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN, true); coex->stop_dm = false; coex->freeze = true; } /* PTA parameter */ rtw_coex_table(rtwdev, 0); rtw_coex_tdma(rtwdev, true, 0); rtw_coex_query_bt_info(rtwdev); } void rtw_coex_power_on_setting(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; coex->stop_dm = true; coex->wl_rf_off = false; /* enable BB, we can write 0x948 */ rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, BIT(0) | BIT(1)); rtw_coex_monitor_bt_enable(rtwdev); rtw_coex_set_rfe_type(rtwdev); /* set antenna path to BT */ rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_POWERON); /* red x issue */ rtw_write8(rtwdev, 0xff1a, 0x0); } void rtw_coex_init_hw_config(struct rtw_dev *rtwdev, bool wifi_only) { __rtw_coex_init_hw_config(rtwdev, wifi_only); } void rtw_coex_ips_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; if (coex->stop_dm) return; if (type == COEX_IPS_ENTER) { coex_stat->wl_under_ips = true; /* for lps off */ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ALL, false); rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_WOFF); rtw_coex_action_coex_all_off(rtwdev); } else if (type == COEX_IPS_LEAVE) { rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_ONOFF, true); /* run init hw config (exclude wifi only) */ __rtw_coex_init_hw_config(rtwdev, false); /* sw all off */ coex_stat->wl_under_ips = false; } } void rtw_coex_lps_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; if (coex->stop_dm) return; if (type == COEX_LPS_ENABLE) { coex_stat->wl_under_lps = true; if (coex_stat->wl_force_lps_ctrl) { /* for ps-tdma */ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); } else { /* for native ps */ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, false); rtw_coex_run_coex(rtwdev, COEX_RSN_LPS); } } else if (type == COEX_LPS_DISABLE) { coex_stat->wl_under_lps = false; /* for lps off */ rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); if (!coex_stat->wl_force_lps_ctrl) rtw_coex_query_bt_info(rtwdev); } } void rtw_coex_scan_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; if (coex->stop_dm) return; coex->freeze = false; if (type != COEX_SCAN_FINISH) rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN | COEX_SCBD_ONOFF, true); if (type == COEX_SCAN_START_5G) { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); rtw_coex_run_coex(rtwdev, COEX_RSN_5GSCANSTART); } else if ((type == COEX_SCAN_START_2G) || (type == COEX_SCAN_START)) { coex_stat->wl_hi_pri_task2 = true; /* Force antenna setup for no scan result issue */ rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_run_coex(rtwdev, COEX_RSN_2GSCANSTART); } else { coex_stat->wl_hi_pri_task2 = false; rtw_coex_run_coex(rtwdev, COEX_RSN_SCANFINISH); } } void rtw_coex_switchband_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; if (coex->stop_dm) return; if (type == COEX_SWITCH_TO_5G) rtw_coex_run_coex(rtwdev, COEX_RSN_5GSWITCHBAND); else if (type == COEX_SWITCH_TO_24G_NOFORSCAN) rtw_coex_run_coex(rtwdev, COEX_RSN_2GSWITCHBAND); else rtw_coex_scan_notify(rtwdev, COEX_SCAN_START_2G); } void rtw_coex_connect_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; if (coex->stop_dm) return; rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE | COEX_SCBD_SCAN | COEX_SCBD_ONOFF, true); if (type == COEX_ASSOCIATE_5G_START) { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONSTART); } else if (type == COEX_ASSOCIATE_5G_FINISH) { rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); rtw_coex_run_coex(rtwdev, COEX_RSN_5GCONFINISH); } else if (type == COEX_ASSOCIATE_START) { coex_stat->wl_hi_pri_task1 = true; coex_stat->cnt_wl[COEX_CNT_WL_CONNPKT] = 2; /* Force antenna setup for no scan result issue */ rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); rtw_coex_run_coex(rtwdev, COEX_RSN_2GCONSTART); /* To keep TDMA case during connect process, * to avoid changed by Btinfo and runcoexmechanism */ coex->freeze = true; ieee80211_queue_delayed_work(rtwdev->hw, &coex->defreeze_work, 5 * HZ); } else { coex_stat->wl_hi_pri_task1 = false; coex->freeze = false; rtw_coex_run_coex(rtwdev, COEX_RSN_2GCONFINISH); } } void rtw_coex_media_status_notify(struct rtw_dev *rtwdev, u8 type) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 para[6] = {0}; if (coex->stop_dm) return; if (type == COEX_MEDIA_CONNECT_5G) { rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_5G); rtw_coex_run_coex(rtwdev, COEX_RSN_5GMEDIA); } else if (type == COEX_MEDIA_CONNECT) { rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, true); /* Force antenna setup for no scan result issue */ rtw_coex_set_ant_path(rtwdev, true, COEX_SET_ANT_2G); /* Set CCK Rx high Pri */ rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 1); /* always enable 5ms extend if connect */ para[0] = COEX_H2C69_WL_LEAKAP; para[1] = PARA1_H2C69_EN_5MS; /* enable 5ms extend */ rtw_fw_bt_wifi_control(rtwdev, para[0], ¶[1]); coex_stat->wl_slot_extend = true; rtw_coex_run_coex(rtwdev, COEX_RSN_2GMEDIA); } else { rtw_coex_write_scbd(rtwdev, COEX_SCBD_ACTIVE, false); rtw_coex_set_wl_pri_mask(rtwdev, COEX_WLPRI_RX_CCK, 0); rtw_coex_run_coex(rtwdev, COEX_RSN_MEDIADISCON); } rtw_coex_update_wl_ch_info(rtwdev, type); } void rtw_coex_bt_info_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_chip_info *chip = rtwdev->chip; unsigned long bt_relink_time; u8 i, rsp_source = 0, type; rsp_source = buf[0] & 0xf; if (rsp_source >= COEX_BTINFO_SRC_MAX) rsp_source = COEX_BTINFO_SRC_WL_FW; if (rsp_source == COEX_BTINFO_SRC_BT_IQK) { coex_stat->bt_iqk_state = buf[1]; if (coex_stat->bt_iqk_state == 1) coex_stat->cnt_bt[COEX_CNT_BT_IQK]++; else if (coex_stat->bt_iqk_state == 2) coex_stat->cnt_bt[COEX_CNT_BT_IQKFAIL]++; return; } if (rsp_source == COEX_BTINFO_SRC_BT_SCBD) { rtw_coex_monitor_bt_enable(rtwdev); if (coex_stat->bt_disabled != coex_stat->bt_disabled_pre) { coex_stat->bt_disabled_pre = coex_stat->bt_disabled; rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); } return; } if (rsp_source == COEX_BTINFO_SRC_BT_RSP || rsp_source == COEX_BTINFO_SRC_BT_ACT) { if (coex_stat->bt_disabled) { coex_stat->bt_disabled = false; coex_stat->bt_reenable = true; ieee80211_queue_delayed_work(rtwdev->hw, &coex->bt_reenable_work, 15 * HZ); } } for (i = 0; i < length; i++) { if (i < COEX_BTINFO_LENGTH_MAX) coex_stat->bt_info_c2h[rsp_source][i] = buf[i]; else break; } if (rsp_source == COEX_BTINFO_SRC_WL_FW) { rtw_coex_update_bt_link_info(rtwdev); rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); return; } /* get the same info from bt, skip it */ if (coex_stat->bt_info_c2h[rsp_source][1] == coex_stat->bt_info_lb2 && coex_stat->bt_info_c2h[rsp_source][2] == coex_stat->bt_info_lb3 && coex_stat->bt_info_c2h[rsp_source][3] == coex_stat->bt_info_hb0 && coex_stat->bt_info_c2h[rsp_source][4] == coex_stat->bt_info_hb1 && coex_stat->bt_info_c2h[rsp_source][5] == coex_stat->bt_info_hb2 && coex_stat->bt_info_c2h[rsp_source][6] == coex_stat->bt_info_hb3) return; coex_stat->bt_info_lb2 = coex_stat->bt_info_c2h[rsp_source][1]; coex_stat->bt_info_lb3 = coex_stat->bt_info_c2h[rsp_source][2]; coex_stat->bt_info_hb0 = coex_stat->bt_info_c2h[rsp_source][3]; coex_stat->bt_info_hb1 = coex_stat->bt_info_c2h[rsp_source][4]; coex_stat->bt_info_hb2 = coex_stat->bt_info_c2h[rsp_source][5]; coex_stat->bt_info_hb3 = coex_stat->bt_info_c2h[rsp_source][6]; /* 0xff means BT is under WHCK test */ coex_stat->bt_whck_test = (coex_stat->bt_info_lb2 == 0xff); coex_stat->bt_inq_page = ((coex_stat->bt_info_lb2 & BIT(2)) == BIT(2)); coex_stat->bt_acl_busy = ((coex_stat->bt_info_lb2 & BIT(3)) == BIT(3)); coex_stat->cnt_bt[COEX_CNT_BT_RETRY] = coex_stat->bt_info_lb3 & 0xf; if (coex_stat->cnt_bt[COEX_CNT_BT_RETRY] >= 1) coex_stat->cnt_bt[COEX_CNT_BT_POPEVENT]++; coex_stat->bt_fix_2M = ((coex_stat->bt_info_lb3 & BIT(4)) == BIT(4)); coex_stat->bt_inq = ((coex_stat->bt_info_lb3 & BIT(5)) == BIT(5)); if (coex_stat->bt_inq) coex_stat->cnt_bt[COEX_CNT_BT_INQ]++; coex_stat->bt_page = ((coex_stat->bt_info_lb3 & BIT(7)) == BIT(7)); if (coex_stat->bt_page) { coex_stat->cnt_bt[COEX_CNT_BT_PAGE]++; if (coex_stat->wl_linkscan_proc || coex_stat->wl_hi_pri_task1 || coex_stat->wl_hi_pri_task2 || coex_stat->wl_gl_busy) rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, true); else rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); } else { rtw_coex_write_scbd(rtwdev, COEX_SCBD_SCAN, false); } /* unit: % (value-100 to translate to unit: dBm in coex info) */ if (chip->bt_rssi_type == COEX_BTRSSI_RATIO) { coex_stat->bt_rssi = coex_stat->bt_info_hb0 * 2 + 10; } else { /* original unit: dbm -> unit: % -> value-100 in coex info */ if (coex_stat->bt_info_hb0 <= 127) coex_stat->bt_rssi = 100; else if (256 - coex_stat->bt_info_hb0 <= 100) coex_stat->bt_rssi = 100 - (256 - coex_stat->bt_info_hb0); else coex_stat->bt_rssi = 0; } coex_stat->bt_ble_exist = ((coex_stat->bt_info_hb1 & BIT(0)) == BIT(0)); if (coex_stat->bt_info_hb1 & BIT(1)) coex_stat->cnt_bt[COEX_CNT_BT_REINIT]++; if (coex_stat->bt_info_hb1 & BIT(2)) { coex_stat->cnt_bt[COEX_CNT_BT_SETUPLINK]++; coex_stat->bt_setup_link = true; if (coex_stat->bt_reenable) bt_relink_time = 6 * HZ; else bt_relink_time = 2 * HZ; ieee80211_queue_delayed_work(rtwdev->hw, &coex->bt_relink_work, bt_relink_time); } if (coex_stat->bt_info_hb1 & BIT(3)) coex_stat->cnt_bt[COEX_CNT_BT_IGNWLANACT]++; coex_stat->bt_ble_voice = ((coex_stat->bt_info_hb1 & BIT(4)) == BIT(4)); coex_stat->bt_ble_scan_en = ((coex_stat->bt_info_hb1 & BIT(5)) == BIT(5)); if (coex_stat->bt_info_hb1 & BIT(6)) coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH]++; coex_stat->bt_multi_link = ((coex_stat->bt_info_hb1 & BIT(7)) == BIT(7)); /* resend wifi info to bt, it is reset and lost the info */ if ((coex_stat->bt_info_hb1 & BIT(1))) { if (coex_stat->wl_connected) type = COEX_MEDIA_CONNECT; else type = COEX_MEDIA_DISCONNECT; rtw_coex_update_wl_ch_info(rtwdev, type); } /* if ignore_wlan_act && not set_up_link */ if ((coex_stat->bt_info_hb1 & BIT(3)) && (!(coex_stat->bt_info_hb1 & BIT(2)))) rtw_coex_ignore_wlan_act(rtwdev, false); coex_stat->bt_opp_exist = ((coex_stat->bt_info_hb2 & BIT(0)) == BIT(0)); if (coex_stat->bt_info_hb2 & BIT(1)) coex_stat->cnt_bt[COEX_CNT_BT_AFHUPDATE]++; coex_stat->bt_a2dp_active = (coex_stat->bt_info_hb2 & BIT(2)) == BIT(2); coex_stat->bt_slave = ((coex_stat->bt_info_hb2 & BIT(3)) == BIT(3)); coex_stat->bt_hid_slot = (coex_stat->bt_info_hb2 & 0x30) >> 4; coex_stat->bt_hid_pair_num = (coex_stat->bt_info_hb2 & 0xc0) >> 6; if (coex_stat->bt_hid_pair_num > 0 && coex_stat->bt_hid_slot >= 2) coex_stat->bt_418_hid_exist = true; else if (coex_stat->bt_hid_pair_num == 0) coex_stat->bt_418_hid_exist = false; if ((coex_stat->bt_info_lb2 & 0x49) == 0x49) coex_stat->bt_a2dp_bitpool = (coex_stat->bt_info_hb3 & 0x7f); else coex_stat->bt_a2dp_bitpool = 0; coex_stat->bt_a2dp_sink = ((coex_stat->bt_info_hb3 & BIT(7)) == BIT(7)); rtw_coex_update_bt_link_info(rtwdev); rtw_coex_run_coex(rtwdev, COEX_RSN_BTINFO); } void rtw_coex_wl_fwdbginfo_notify(struct rtw_dev *rtwdev, u8 *buf, u8 length) { struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; u8 val; int i; if (WARN(length < 8, "invalid wl info c2h length\n")) return; if (buf[0] != 0x08) return; for (i = 1; i < 8; i++) { val = coex_stat->wl_fw_dbg_info_pre[i]; if (buf[i] >= val) coex_stat->wl_fw_dbg_info[i] = buf[i] - val; else coex_stat->wl_fw_dbg_info[i] = val - buf[i]; coex_stat->wl_fw_dbg_info_pre[i] = buf[i]; } coex_stat->cnt_wl[COEX_CNT_WL_FW_NOTIFY]++; rtw_coex_wl_ccklock_action(rtwdev); rtw_coex_wl_ccklock_detect(rtwdev); } void rtw_coex_wl_status_change_notify(struct rtw_dev *rtwdev) { struct rtw_coex *coex = &rtwdev->coex; if (coex->stop_dm) return; rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); } void rtw_coex_bt_relink_work(struct work_struct *work) { struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, coex.bt_relink_work.work); struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; mutex_lock(&rtwdev->mutex); coex_stat->bt_setup_link = false; rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); mutex_unlock(&rtwdev->mutex); } void rtw_coex_bt_reenable_work(struct work_struct *work) { struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, coex.bt_reenable_work.work); struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; mutex_lock(&rtwdev->mutex); coex_stat->bt_reenable = false; mutex_unlock(&rtwdev->mutex); } void rtw_coex_defreeze_work(struct work_struct *work) { struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, coex.defreeze_work.work); struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &rtwdev->coex.stat; mutex_lock(&rtwdev->mutex); coex->freeze = false; coex_stat->wl_hi_pri_task1 = false; rtw_coex_run_coex(rtwdev, COEX_RSN_WLSTATUS); mutex_unlock(&rtwdev->mutex); } #ifdef CONFIG_RTW88_DEBUGFS #define INFO_SIZE 80 #define case_BTINFO(src) \ case COEX_BTINFO_SRC_##src: return #src static const char *rtw_coex_get_bt_info_src_string(u8 bt_info_src) { switch (bt_info_src) { case_BTINFO(WL_FW); case_BTINFO(BT_RSP); case_BTINFO(BT_ACT); default: return "Unknown"; } } #define case_RSN(src) \ case COEX_RSN_##src: return #src static const char *rtw_coex_get_reason_string(u8 reason) { switch (reason) { case_RSN(2GSCANSTART); case_RSN(5GSCANSTART); case_RSN(SCANFINISH); case_RSN(2GSWITCHBAND); case_RSN(5GSWITCHBAND); case_RSN(2GCONSTART); case_RSN(5GCONSTART); case_RSN(2GCONFINISH); case_RSN(5GCONFINISH); case_RSN(2GMEDIA); case_RSN(5GMEDIA); case_RSN(MEDIADISCON); case_RSN(BTINFO); case_RSN(LPS); case_RSN(WLSTATUS); default: return "Unknown"; } } static int rtw_coex_addr_info(struct rtw_dev *rtwdev, const struct rtw_reg_domain *reg, char addr_info[], int n) { const char *rf_prefix = ""; const char *sep = n == 0 ? "" : "/ "; int ffs, fls; int max_fls; if (INFO_SIZE - n <= 0) return 0; switch (reg->domain) { case RTW_REG_DOMAIN_MAC32: max_fls = 31; break; case RTW_REG_DOMAIN_MAC16: max_fls = 15; break; case RTW_REG_DOMAIN_MAC8: max_fls = 7; break; case RTW_REG_DOMAIN_RF_A: case RTW_REG_DOMAIN_RF_B: rf_prefix = "RF_"; max_fls = 19; break; default: return 0; } ffs = __ffs(reg->mask); fls = __fls(reg->mask); if (ffs == 0 && fls == max_fls) return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x", sep, rf_prefix, reg->addr); else if (ffs == fls) return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x[%d]", sep, rf_prefix, reg->addr, ffs); else return scnprintf(addr_info + n, INFO_SIZE - n, "%s%s%x[%d:%d]", sep, rf_prefix, reg->addr, fls, ffs); } static int rtw_coex_val_info(struct rtw_dev *rtwdev, const struct rtw_reg_domain *reg, char val_info[], int n) { const char *sep = n == 0 ? "" : "/ "; u8 rf_path; if (INFO_SIZE - n <= 0) return 0; switch (reg->domain) { case RTW_REG_DOMAIN_MAC32: return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, rtw_read32_mask(rtwdev, reg->addr, reg->mask)); case RTW_REG_DOMAIN_MAC16: return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, rtw_read16_mask(rtwdev, reg->addr, reg->mask)); case RTW_REG_DOMAIN_MAC8: return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, rtw_read8_mask(rtwdev, reg->addr, reg->mask)); case RTW_REG_DOMAIN_RF_A: rf_path = RF_PATH_A; break; case RTW_REG_DOMAIN_RF_B: rf_path = RF_PATH_B; break; default: return 0; } /* only RF go through here */ return scnprintf(val_info + n, INFO_SIZE - n, "%s0x%x", sep, rtw_read_rf(rtwdev, rf_path, reg->addr, reg->mask)); } static void rtw_coex_set_coexinfo_hw(struct rtw_dev *rtwdev, struct seq_file *m) { struct rtw_chip_info *chip = rtwdev->chip; const struct rtw_reg_domain *reg; char addr_info[INFO_SIZE]; int n_addr = 0; char val_info[INFO_SIZE]; int n_val = 0; int i; for (i = 0; i < chip->coex_info_hw_regs_num; i++) { reg = &chip->coex_info_hw_regs[i]; n_addr += rtw_coex_addr_info(rtwdev, reg, addr_info, n_addr); n_val += rtw_coex_val_info(rtwdev, reg, val_info, n_val); if (reg->domain == RTW_REG_DOMAIN_NL) { seq_printf(m, "%-40s = %s\n", addr_info, val_info); n_addr = 0; n_val = 0; } } if (n_addr != 0 && n_val != 0) seq_printf(m, "%-40s = %s\n", addr_info, val_info); } static bool rtw_coex_get_bt_reg(struct rtw_dev *rtwdev, u8 type, u16 addr, u16 *val) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; __le16 le_addr; u8 *payload; le_addr = cpu_to_le16(addr); req.op_code = BT_MP_INFO_OP_READ_REG; req.para1 = type; req.para2 = le16_get_bits(le_addr, GENMASK(7, 0)); req.para3 = le16_get_bits(le_addr, GENMASK(15, 8)); skb = rtw_coex_info_request(rtwdev, &req); if (!skb) { *val = 0xeaea; return false; } payload = get_payload_from_coex_resp(skb); *val = GET_COEX_RESP_BT_REG_VAL(payload); return true; } static bool rtw_coex_get_bt_patch_version(struct rtw_dev *rtwdev, u32 *patch_version) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; u8 *payload; bool ret = false; req.op_code = BT_MP_INFO_OP_PATCH_VER; skb = rtw_coex_info_request(rtwdev, &req); if (!skb) goto out; payload = get_payload_from_coex_resp(skb); *patch_version = GET_COEX_RESP_BT_PATCH_VER(payload); ret = true; out: return ret; } static bool rtw_coex_get_bt_supported_version(struct rtw_dev *rtwdev, u32 *supported_version) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; u8 *payload; bool ret = false; req.op_code = BT_MP_INFO_OP_SUPP_VER; skb = rtw_coex_info_request(rtwdev, &req); if (!skb) goto out; payload = get_payload_from_coex_resp(skb); *supported_version = GET_COEX_RESP_BT_SUPP_VER(payload); ret = true; out: return ret; } static bool rtw_coex_get_bt_supported_feature(struct rtw_dev *rtwdev, u32 *supported_feature) { struct rtw_coex_info_req req = {0}; struct sk_buff *skb; u8 *payload; bool ret = false; req.op_code = BT_MP_INFO_OP_SUPP_FEAT; skb = rtw_coex_info_request(rtwdev, &req); if (!skb) goto out; payload = get_payload_from_coex_resp(skb); *supported_feature = GET_COEX_RESP_BT_SUPP_FEAT(payload); ret = true; out: return ret; } struct rtw_coex_sta_stat_iter_data { struct rtw_vif *rtwvif; struct seq_file *file; }; static void rtw_coex_sta_stat_iter(void *data, struct ieee80211_sta *sta) { struct rtw_coex_sta_stat_iter_data *sta_iter_data = data; struct rtw_vif *rtwvif = sta_iter_data->rtwvif; struct rtw_sta_info *si = (struct rtw_sta_info *)sta->drv_priv; struct seq_file *m = sta_iter_data->file; struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); u8 rssi; if (si->vif != vif) return; rssi = ewma_rssi_read(&si->avg_rssi); seq_printf(m, "\tPeer %3d\n", si->mac_id); seq_printf(m, "\t\t%-24s = %d\n", "RSSI", rssi); seq_printf(m, "\t\t%-24s = %d\n", "BW mode", si->bw_mode); } struct rtw_coex_vif_stat_iter_data { struct rtw_dev *rtwdev; struct seq_file *file; }; static void rtw_coex_vif_stat_iter(void *data, u8 *mac, struct ieee80211_vif *vif) { struct rtw_coex_vif_stat_iter_data *vif_iter_data = data; struct rtw_coex_sta_stat_iter_data sta_iter_data; struct rtw_dev *rtwdev = vif_iter_data->rtwdev; struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; struct seq_file *m = vif_iter_data->file; struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; seq_printf(m, "Iface on Port (%d)\n", rtwvif->port); seq_printf(m, "\t%-32s = %d\n", "Beacon interval", bss_conf->beacon_int); seq_printf(m, "\t%-32s = %d\n", "Network Type", rtwvif->net_type); sta_iter_data.rtwvif = rtwvif; sta_iter_data.file = m; rtw_iterate_stas_atomic(rtwdev, rtw_coex_sta_stat_iter, &sta_iter_data); } void rtw_coex_display_coex_info(struct rtw_dev *rtwdev, struct seq_file *m) { struct rtw_chip_info *chip = rtwdev->chip; struct rtw_dm_info *dm_info = &rtwdev->dm_info; struct rtw_coex *coex = &rtwdev->coex; struct rtw_coex_stat *coex_stat = &coex->stat; struct rtw_coex_dm *coex_dm = &coex->dm; struct rtw_hal *hal = &rtwdev->hal; struct rtw_efuse *efuse = &rtwdev->efuse; struct rtw_fw_state *fw = &rtwdev->fw; struct rtw_coex_vif_stat_iter_data vif_iter_data; u8 reason = coex_dm->reason; u8 sys_lte; u16 score_board_WB, score_board_BW; u32 wl_reg_6c0, wl_reg_6c4, wl_reg_6c8, wl_reg_778, wl_reg_6cc; u32 lte_coex, bt_coex; u32 bt_hi_pri, bt_lo_pri; int i; score_board_BW = rtw_coex_read_scbd(rtwdev); score_board_WB = coex_stat->score_board; wl_reg_6c0 = rtw_read32(rtwdev, 0x6c0); wl_reg_6c4 = rtw_read32(rtwdev, 0x6c4); wl_reg_6c8 = rtw_read32(rtwdev, 0x6c8); wl_reg_6cc = rtw_read32(rtwdev, 0x6cc); wl_reg_778 = rtw_read32(rtwdev, 0x778); bt_hi_pri = rtw_read32(rtwdev, 0x770); bt_lo_pri = rtw_read32(rtwdev, 0x774); rtw_write8(rtwdev, 0x76e, 0xc); sys_lte = rtw_read8(rtwdev, 0x73); lte_coex = rtw_coex_read_indirect_reg(rtwdev, 0x38); bt_coex = rtw_coex_read_indirect_reg(rtwdev, 0x54); if (!coex_stat->bt_disabled && !coex_stat->bt_mailbox_reply) { rtw_coex_get_bt_supported_version(rtwdev, &coex_stat->bt_supported_version); rtw_coex_get_bt_patch_version(rtwdev, &coex_stat->patch_ver); rtw_coex_get_bt_supported_feature(rtwdev, &coex_stat->bt_supported_feature); rtw_coex_get_bt_reg(rtwdev, 3, 0xae, &coex_stat->bt_reg_vendor_ae); rtw_coex_get_bt_reg(rtwdev, 3, 0xac, &coex_stat->bt_reg_vendor_ac); if (coex_stat->patch_ver != 0) coex_stat->bt_mailbox_reply = true; } seq_printf(m, "**********************************************\n"); seq_printf(m, "\t\tBT Coexist info %x\n", chip->id); seq_printf(m, "**********************************************\n"); seq_printf(m, "%-40s = %s/ %d\n", "Mech/ RFE", efuse->share_ant ? "Shared" : "Non-Shared", efuse->rfe_option); seq_printf(m, "%-40s = %08x/ 0x%02x/ 0x%08x %s\n", "Coex Ver/ BT Dez/ BT Rpt", chip->coex_para_ver, chip->bt_desired_ver, coex_stat->bt_supported_version, coex_stat->bt_disabled ? "(BT disabled)" : coex_stat->bt_supported_version >= chip->bt_desired_ver ? "(Match)" : "(Mismatch)"); seq_printf(m, "%-40s = %s/ %u/ %d\n", "Role/ RoleSwCnt/ IgnWL/ Feature", coex_stat->bt_slave ? "Slave" : "Master", coex_stat->cnt_bt[COEX_CNT_BT_ROLESWITCH], coex_dm->ignore_wl_act); seq_printf(m, "%-40s = %u.%u/ 0x%x/ %c\n", "WL FW/ BT FW/ KT", fw->version, fw->sub_version, coex_stat->patch_ver, coex_stat->kt_ver + 65); seq_printf(m, "%-40s = %u/ %u/ %u/ ch-(%u)\n", "AFH Map", coex_dm->wl_ch_info[0], coex_dm->wl_ch_info[1], coex_dm->wl_ch_info[2], hal->current_channel); seq_printf(m, "**********************************************\n"); seq_printf(m, "\t\tBT Status\n"); seq_printf(m, "**********************************************\n"); seq_printf(m, "%-40s = %s/ %ddBm/ %u/ %u\n", "BT status/ rssi/ retry/ pop", coex_dm->bt_status == COEX_BTSTATUS_NCON_IDLE ? "non-conn" : coex_dm->bt_status == COEX_BTSTATUS_CON_IDLE ? "conn-idle" : "busy", coex_stat->bt_rssi - 100, coex_stat->cnt_bt[COEX_CNT_BT_RETRY], coex_stat->cnt_bt[COEX_CNT_BT_POPEVENT]); seq_printf(m, "%-40s = %s%s%s%s%s (multi-link %d)\n", "Profiles", coex_stat->bt_a2dp_exist ? (coex_stat->bt_a2dp_sink ? "A2DP sink," : "A2DP,") : "", coex_stat->bt_hfp_exist ? "HFP," : "", coex_stat->bt_hid_exist ? (coex_stat->bt_ble_exist ? "HID(RCU)," : coex_stat->bt_hid_slot >= 2 ? "HID(4/18)" : "HID(2/18),") : "", coex_stat->bt_pan_exist ? coex_stat->bt_opp_exist ? "OPP," : "PAN," : "", coex_stat->bt_ble_voice ? "Voice," : "", coex_stat->bt_multi_link); seq_printf(m, "%-40s = %u/ %u/ %u/ 0x%08x\n", "Reinit/ Relink/ IgnWl/ Feature", coex_stat->cnt_bt[COEX_CNT_BT_REINIT], coex_stat->cnt_bt[COEX_CNT_BT_SETUPLINK], coex_stat->cnt_bt[COEX_CNT_BT_IGNWLANACT], coex_stat->bt_supported_feature); seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", "Page/ Inq/ iqk/ iqk fail", coex_stat->cnt_bt[COEX_CNT_BT_PAGE], coex_stat->cnt_bt[COEX_CNT_BT_INQ], coex_stat->cnt_bt[COEX_CNT_BT_IQK], coex_stat->cnt_bt[COEX_CNT_BT_IQKFAIL]); seq_printf(m, "%-40s = 0x%04x/ 0x%04x/ 0x%04x/ 0x%04x\n", "0xae/ 0xac/ score board (W->B)/ (B->W)", coex_stat->bt_reg_vendor_ae, coex_stat->bt_reg_vendor_ac, score_board_WB, score_board_BW); seq_printf(m, "%-40s = %u/%u, %u/%u\n", "Hi-Pri TX/RX, Lo-Pri TX/RX", bt_hi_pri & 0xffff, bt_hi_pri >> 16, bt_lo_pri & 0xffff, bt_lo_pri >> 16); for (i = 0; i < COEX_BTINFO_SRC_BT_IQK; i++) seq_printf(m, "%-40s = %7ph\n", rtw_coex_get_bt_info_src_string(i), coex_stat->bt_info_c2h[i]); seq_printf(m, "**********************************************\n"); seq_printf(m, "\t\tWiFi Status\n"); seq_printf(m, "**********************************************\n"); seq_printf(m, "%-40s = %d\n", "Scanning", test_bit(RTW_FLAG_SCANNING, rtwdev->flags)); seq_printf(m, "%-40s = %u/ TX %d Mbps/ RX %d Mbps\n", "G_busy/ TX/ RX", coex_stat->wl_gl_busy, rtwdev->stats.tx_throughput, rtwdev->stats.rx_throughput); seq_printf(m, "%-40s = %u/ %u/ %u\n", "IPS/ Low Power/ PS mode", test_bit(RTW_FLAG_INACTIVE_PS, rtwdev->flags), test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags), rtwdev->lps_conf.mode); vif_iter_data.rtwdev = rtwdev; vif_iter_data.file = m; rtw_iterate_vifs_atomic(rtwdev, rtw_coex_vif_stat_iter, &vif_iter_data); seq_printf(m, "**********************************************\n"); seq_printf(m, "\t\tMechanism\n"); seq_printf(m, "**********************************************\n"); seq_printf(m, "%-40s = %5ph (case-%d)\n", "TDMA", coex_dm->ps_tdma_para, coex_dm->cur_ps_tdma); seq_printf(m, "%-40s = %d\n", "Timer base", coex_stat->tdma_timer_base); seq_printf(m, "%-40s = %d/ 0x%08x/ 0x%08x/ 0x%08x\n", "Table/ 0x6c0/ 0x6c4/ 0x6c8", coex_dm->cur_table, wl_reg_6c0, wl_reg_6c4, wl_reg_6c8); seq_printf(m, "%-40s = 0x%08x/ 0x%08x/ reason (%s)\n", "0x778/ 0x6cc/ Reason", wl_reg_778, wl_reg_6cc, rtw_coex_get_reason_string(reason)); seq_printf(m, "%-40s = %u/ %u/ %u/ %u/ %u\n", "Null All/ Retry/ Ack/ BT Empty/ BT Late", coex_stat->wl_fw_dbg_info[1], coex_stat->wl_fw_dbg_info[2], coex_stat->wl_fw_dbg_info[3], coex_stat->wl_fw_dbg_info[4], coex_stat->wl_fw_dbg_info[5]); seq_printf(m, "%-40s = %u/ %u/ %s/ %u\n", "Cnt TDMA Toggle/ Lk 5ms/ Lk 5ms on/ FW", coex_stat->wl_fw_dbg_info[6], coex_stat->wl_fw_dbg_info[7], coex_stat->wl_slot_extend ? "Yes" : "No", coex_stat->cnt_wl[COEX_CNT_WL_FW_NOTIFY]); seq_printf(m, "**********************************************\n"); seq_printf(m, "\t\tHW setting\n"); seq_printf(m, "**********************************************\n"); seq_printf(m, "%-40s = %s/ %s\n", "LTE Coex/ Path Owner", lte_coex & BIT(7) ? "ON" : "OFF", sys_lte & BIT(2) ? "WL" : "BT"); seq_printf(m, "%-40s = RF:%s_BB:%s/ RF:%s_BB:%s/ %s\n", "GNT_WL_CTRL/ GNT_BT_CTRL/ Dbg", lte_coex & BIT(12) ? "SW" : "HW", lte_coex & BIT(8) ? "SW" : "HW", lte_coex & BIT(14) ? "SW" : "HW", lte_coex & BIT(10) ? "SW" : "HW", sys_lte & BIT(3) ? "On" : "Off"); seq_printf(m, "%-40s = %lu/ %lu\n", "GNT_WL/ GNT_BT", (bt_coex & BIT(2)) >> 2, (bt_coex & BIT(3)) >> 3); seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", "CRC OK CCK/ OFDM/ HT/ VHT", dm_info->cck_ok_cnt, dm_info->ofdm_ok_cnt, dm_info->ht_ok_cnt, dm_info->vht_ok_cnt); seq_printf(m, "%-40s = %u/ %u/ %u/ %u\n", "CRC ERR CCK/ OFDM/ HT/ VHT", dm_info->cck_err_cnt, dm_info->ofdm_err_cnt, dm_info->ht_err_cnt, dm_info->vht_err_cnt); seq_printf(m, "%-40s = %s/ %s/ %s/ %u\n", "HiPr/ Locking/ Locked/ Noisy", coex_stat->wl_hi_pri_task1 ? "Y" : "N", coex_stat->wl_cck_lock ? "Y" : "N", coex_stat->wl_cck_lock_ever ? "Y" : "N", coex_stat->wl_noisy_level); rtw_coex_set_coexinfo_hw(rtwdev, m); } #endif /* CONFIG_RTW88_DEBUGFS */