162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 262306a36Sopenharmony_ci/* Copyright(c) 2019-2022 Realtek Corporation 362306a36Sopenharmony_ci */ 462306a36Sopenharmony_ci 562306a36Sopenharmony_ci#include "coex.h" 662306a36Sopenharmony_ci#include "debug.h" 762306a36Sopenharmony_ci#include "fw.h" 862306a36Sopenharmony_ci#include "mac.h" 962306a36Sopenharmony_ci#include "phy.h" 1062306a36Sopenharmony_ci#include "reg.h" 1162306a36Sopenharmony_ci#include "rtw8852c.h" 1262306a36Sopenharmony_ci#include "rtw8852c_rfk.h" 1362306a36Sopenharmony_ci#include "rtw8852c_table.h" 1462306a36Sopenharmony_ci#include "util.h" 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#define RTW8852C_FW_FORMAT_MAX 0 1762306a36Sopenharmony_ci#define RTW8852C_FW_BASENAME "rtw89/rtw8852c_fw" 1862306a36Sopenharmony_ci#define RTW8852C_MODULE_FIRMWARE \ 1962306a36Sopenharmony_ci RTW8852C_FW_BASENAME ".bin" 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic const struct rtw89_hfc_ch_cfg rtw8852c_hfc_chcfg_pcie[] = { 2262306a36Sopenharmony_ci {13, 1614, grp_0}, /* ACH 0 */ 2362306a36Sopenharmony_ci {13, 1614, grp_0}, /* ACH 1 */ 2462306a36Sopenharmony_ci {13, 1614, grp_0}, /* ACH 2 */ 2562306a36Sopenharmony_ci {13, 1614, grp_0}, /* ACH 3 */ 2662306a36Sopenharmony_ci {13, 1614, grp_1}, /* ACH 4 */ 2762306a36Sopenharmony_ci {13, 1614, grp_1}, /* ACH 5 */ 2862306a36Sopenharmony_ci {13, 1614, grp_1}, /* ACH 6 */ 2962306a36Sopenharmony_ci {13, 1614, grp_1}, /* ACH 7 */ 3062306a36Sopenharmony_ci {13, 1614, grp_0}, /* B0MGQ */ 3162306a36Sopenharmony_ci {13, 1614, grp_0}, /* B0HIQ */ 3262306a36Sopenharmony_ci {13, 1614, grp_1}, /* B1MGQ */ 3362306a36Sopenharmony_ci {13, 1614, grp_1}, /* B1HIQ */ 3462306a36Sopenharmony_ci {40, 0, 0} /* FWCMDQ */ 3562306a36Sopenharmony_ci}; 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_cistatic const struct rtw89_hfc_pub_cfg rtw8852c_hfc_pubcfg_pcie = { 3862306a36Sopenharmony_ci 1614, /* Group 0 */ 3962306a36Sopenharmony_ci 1614, /* Group 1 */ 4062306a36Sopenharmony_ci 3228, /* Public Max */ 4162306a36Sopenharmony_ci 0 /* WP threshold */ 4262306a36Sopenharmony_ci}; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_cistatic const struct rtw89_hfc_param_ini rtw8852c_hfc_param_ini_pcie[] = { 4562306a36Sopenharmony_ci [RTW89_QTA_SCC] = {rtw8852c_hfc_chcfg_pcie, &rtw8852c_hfc_pubcfg_pcie, 4662306a36Sopenharmony_ci &rtw89_mac_size.hfc_preccfg_pcie, RTW89_HCIFC_POH}, 4762306a36Sopenharmony_ci [RTW89_QTA_DLFW] = {NULL, NULL, &rtw89_mac_size.hfc_preccfg_pcie, 4862306a36Sopenharmony_ci RTW89_HCIFC_POH}, 4962306a36Sopenharmony_ci [RTW89_QTA_INVALID] = {NULL}, 5062306a36Sopenharmony_ci}; 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_cistatic const struct rtw89_dle_mem rtw8852c_dle_mem_pcie[] = { 5362306a36Sopenharmony_ci [RTW89_QTA_SCC] = {RTW89_QTA_SCC, &rtw89_mac_size.wde_size19, 5462306a36Sopenharmony_ci &rtw89_mac_size.ple_size19, &rtw89_mac_size.wde_qt18, 5562306a36Sopenharmony_ci &rtw89_mac_size.wde_qt18, &rtw89_mac_size.ple_qt46, 5662306a36Sopenharmony_ci &rtw89_mac_size.ple_qt47}, 5762306a36Sopenharmony_ci [RTW89_QTA_DLFW] = {RTW89_QTA_DLFW, &rtw89_mac_size.wde_size18, 5862306a36Sopenharmony_ci &rtw89_mac_size.ple_size18, &rtw89_mac_size.wde_qt17, 5962306a36Sopenharmony_ci &rtw89_mac_size.wde_qt17, &rtw89_mac_size.ple_qt44, 6062306a36Sopenharmony_ci &rtw89_mac_size.ple_qt45}, 6162306a36Sopenharmony_ci [RTW89_QTA_INVALID] = {RTW89_QTA_INVALID, NULL, NULL, NULL, NULL, NULL, 6262306a36Sopenharmony_ci NULL}, 6362306a36Sopenharmony_ci}; 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_cistatic const u32 rtw8852c_h2c_regs[RTW89_H2CREG_MAX] = { 6662306a36Sopenharmony_ci R_AX_H2CREG_DATA0_V1, R_AX_H2CREG_DATA1_V1, R_AX_H2CREG_DATA2_V1, 6762306a36Sopenharmony_ci R_AX_H2CREG_DATA3_V1 6862306a36Sopenharmony_ci}; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_cistatic const u32 rtw8852c_c2h_regs[RTW89_H2CREG_MAX] = { 7162306a36Sopenharmony_ci R_AX_C2HREG_DATA0_V1, R_AX_C2HREG_DATA1_V1, R_AX_C2HREG_DATA2_V1, 7262306a36Sopenharmony_ci R_AX_C2HREG_DATA3_V1 7362306a36Sopenharmony_ci}; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_cistatic const struct rtw89_page_regs rtw8852c_page_regs = { 7662306a36Sopenharmony_ci .hci_fc_ctrl = R_AX_HCI_FC_CTRL_V1, 7762306a36Sopenharmony_ci .ch_page_ctrl = R_AX_CH_PAGE_CTRL_V1, 7862306a36Sopenharmony_ci .ach_page_ctrl = R_AX_ACH0_PAGE_CTRL_V1, 7962306a36Sopenharmony_ci .ach_page_info = R_AX_ACH0_PAGE_INFO_V1, 8062306a36Sopenharmony_ci .pub_page_info3 = R_AX_PUB_PAGE_INFO3_V1, 8162306a36Sopenharmony_ci .pub_page_ctrl1 = R_AX_PUB_PAGE_CTRL1_V1, 8262306a36Sopenharmony_ci .pub_page_ctrl2 = R_AX_PUB_PAGE_CTRL2_V1, 8362306a36Sopenharmony_ci .pub_page_info1 = R_AX_PUB_PAGE_INFO1_V1, 8462306a36Sopenharmony_ci .pub_page_info2 = R_AX_PUB_PAGE_INFO2_V1, 8562306a36Sopenharmony_ci .wp_page_ctrl1 = R_AX_WP_PAGE_CTRL1_V1, 8662306a36Sopenharmony_ci .wp_page_ctrl2 = R_AX_WP_PAGE_CTRL2_V1, 8762306a36Sopenharmony_ci .wp_page_info1 = R_AX_WP_PAGE_INFO1_V1, 8862306a36Sopenharmony_ci}; 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistatic const struct rtw89_reg_def rtw8852c_dcfo_comp = { 9162306a36Sopenharmony_ci R_DCFO_COMP_S0_V1, B_DCFO_COMP_S0_V1_MSK 9262306a36Sopenharmony_ci}; 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_cistatic const struct rtw89_imr_info rtw8852c_imr_info = { 9562306a36Sopenharmony_ci .wdrls_imr_set = B_AX_WDRLS_IMR_SET_V1, 9662306a36Sopenharmony_ci .wsec_imr_reg = R_AX_SEC_ERROR_FLAG_IMR, 9762306a36Sopenharmony_ci .wsec_imr_set = B_AX_TX_HANG_IMR | B_AX_RX_HANG_IMR, 9862306a36Sopenharmony_ci .mpdu_tx_imr_set = B_AX_MPDU_TX_IMR_SET_V1, 9962306a36Sopenharmony_ci .mpdu_rx_imr_set = B_AX_MPDU_RX_IMR_SET_V1, 10062306a36Sopenharmony_ci .sta_sch_imr_set = B_AX_STA_SCHEDULER_IMR_SET, 10162306a36Sopenharmony_ci .txpktctl_imr_b0_reg = R_AX_TXPKTCTL_B0_ERRFLAG_IMR, 10262306a36Sopenharmony_ci .txpktctl_imr_b0_clr = B_AX_TXPKTCTL_IMR_B0_CLR_V1, 10362306a36Sopenharmony_ci .txpktctl_imr_b0_set = B_AX_TXPKTCTL_IMR_B0_SET_V1, 10462306a36Sopenharmony_ci .txpktctl_imr_b1_reg = R_AX_TXPKTCTL_B1_ERRFLAG_IMR, 10562306a36Sopenharmony_ci .txpktctl_imr_b1_clr = B_AX_TXPKTCTL_IMR_B1_CLR_V1, 10662306a36Sopenharmony_ci .txpktctl_imr_b1_set = B_AX_TXPKTCTL_IMR_B1_SET_V1, 10762306a36Sopenharmony_ci .wde_imr_clr = B_AX_WDE_IMR_CLR_V1, 10862306a36Sopenharmony_ci .wde_imr_set = B_AX_WDE_IMR_SET_V1, 10962306a36Sopenharmony_ci .ple_imr_clr = B_AX_PLE_IMR_CLR_V1, 11062306a36Sopenharmony_ci .ple_imr_set = B_AX_PLE_IMR_SET_V1, 11162306a36Sopenharmony_ci .host_disp_imr_clr = B_AX_HOST_DISP_IMR_CLR_V1, 11262306a36Sopenharmony_ci .host_disp_imr_set = B_AX_HOST_DISP_IMR_SET_V1, 11362306a36Sopenharmony_ci .cpu_disp_imr_clr = B_AX_CPU_DISP_IMR_CLR_V1, 11462306a36Sopenharmony_ci .cpu_disp_imr_set = B_AX_CPU_DISP_IMR_SET_V1, 11562306a36Sopenharmony_ci .other_disp_imr_clr = B_AX_OTHER_DISP_IMR_CLR_V1, 11662306a36Sopenharmony_ci .other_disp_imr_set = B_AX_OTHER_DISP_IMR_SET_V1, 11762306a36Sopenharmony_ci .bbrpt_com_err_imr_reg = R_AX_BBRPT_COM_ERR_IMR, 11862306a36Sopenharmony_ci .bbrpt_chinfo_err_imr_reg = R_AX_BBRPT_CHINFO_ERR_IMR, 11962306a36Sopenharmony_ci .bbrpt_err_imr_set = R_AX_BBRPT_CHINFO_IMR_SET_V1, 12062306a36Sopenharmony_ci .bbrpt_dfs_err_imr_reg = R_AX_BBRPT_DFS_ERR_IMR, 12162306a36Sopenharmony_ci .ptcl_imr_clr = B_AX_PTCL_IMR_CLR_V1, 12262306a36Sopenharmony_ci .ptcl_imr_set = B_AX_PTCL_IMR_SET_V1, 12362306a36Sopenharmony_ci .cdma_imr_0_reg = R_AX_RX_ERR_FLAG_IMR, 12462306a36Sopenharmony_ci .cdma_imr_0_clr = B_AX_RX_ERR_IMR_CLR_V1, 12562306a36Sopenharmony_ci .cdma_imr_0_set = B_AX_RX_ERR_IMR_SET_V1, 12662306a36Sopenharmony_ci .cdma_imr_1_reg = R_AX_TX_ERR_FLAG_IMR, 12762306a36Sopenharmony_ci .cdma_imr_1_clr = B_AX_TX_ERR_IMR_CLR_V1, 12862306a36Sopenharmony_ci .cdma_imr_1_set = B_AX_TX_ERR_IMR_SET_V1, 12962306a36Sopenharmony_ci .phy_intf_imr_reg = R_AX_PHYINFO_ERR_IMR_V1, 13062306a36Sopenharmony_ci .phy_intf_imr_clr = B_AX_PHYINFO_IMR_CLR_V1, 13162306a36Sopenharmony_ci .phy_intf_imr_set = B_AX_PHYINFO_IMR_SET_V1, 13262306a36Sopenharmony_ci .rmac_imr_reg = R_AX_RX_ERR_IMR, 13362306a36Sopenharmony_ci .rmac_imr_clr = B_AX_RMAC_IMR_CLR_V1, 13462306a36Sopenharmony_ci .rmac_imr_set = B_AX_RMAC_IMR_SET_V1, 13562306a36Sopenharmony_ci .tmac_imr_reg = R_AX_TRXPTCL_ERROR_INDICA_MASK, 13662306a36Sopenharmony_ci .tmac_imr_clr = B_AX_TMAC_IMR_CLR_V1, 13762306a36Sopenharmony_ci .tmac_imr_set = B_AX_TMAC_IMR_SET_V1, 13862306a36Sopenharmony_ci}; 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_cistatic const struct rtw89_rrsr_cfgs rtw8852c_rrsr_cfgs = { 14162306a36Sopenharmony_ci .ref_rate = {R_AX_TRXPTCL_RRSR_CTL_0, B_AX_WMAC_RESP_REF_RATE_SEL, 0}, 14262306a36Sopenharmony_ci .rsc = {R_AX_PTCL_RRSR1, B_AX_RSC_MASK, 2}, 14362306a36Sopenharmony_ci}; 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_cistatic const struct rtw89_dig_regs rtw8852c_dig_regs = { 14662306a36Sopenharmony_ci .seg0_pd_reg = R_SEG0R_PD, 14762306a36Sopenharmony_ci .pd_lower_bound_mask = B_SEG0R_PD_LOWER_BOUND_MSK, 14862306a36Sopenharmony_ci .pd_spatial_reuse_en = B_SEG0R_PD_SPATIAL_REUSE_EN_MSK, 14962306a36Sopenharmony_ci .bmode_pd_reg = R_BMODE_PDTH_EN_V1, 15062306a36Sopenharmony_ci .bmode_cca_rssi_limit_en = B_BMODE_PDTH_LIMIT_EN_MSK_V1, 15162306a36Sopenharmony_ci .bmode_pd_lower_bound_reg = R_BMODE_PDTH_V1, 15262306a36Sopenharmony_ci .bmode_rssi_nocca_low_th_mask = B_BMODE_PDTH_LOWER_BOUND_MSK_V1, 15362306a36Sopenharmony_ci .p0_lna_init = {R_PATH0_LNA_INIT_V1, B_PATH0_LNA_INIT_IDX_MSK}, 15462306a36Sopenharmony_ci .p1_lna_init = {R_PATH1_LNA_INIT_V1, B_PATH1_LNA_INIT_IDX_MSK}, 15562306a36Sopenharmony_ci .p0_tia_init = {R_PATH0_TIA_INIT_V1, B_PATH0_TIA_INIT_IDX_MSK_V1}, 15662306a36Sopenharmony_ci .p1_tia_init = {R_PATH1_TIA_INIT_V1, B_PATH1_TIA_INIT_IDX_MSK_V1}, 15762306a36Sopenharmony_ci .p0_rxb_init = {R_PATH0_RXB_INIT_V1, B_PATH0_RXB_INIT_IDX_MSK_V1}, 15862306a36Sopenharmony_ci .p1_rxb_init = {R_PATH1_RXB_INIT_V1, B_PATH1_RXB_INIT_IDX_MSK_V1}, 15962306a36Sopenharmony_ci .p0_p20_pagcugc_en = {R_PATH0_P20_FOLLOW_BY_PAGCUGC_V1, 16062306a36Sopenharmony_ci B_PATH0_P20_FOLLOW_BY_PAGCUGC_EN_MSK}, 16162306a36Sopenharmony_ci .p0_s20_pagcugc_en = {R_PATH0_S20_FOLLOW_BY_PAGCUGC_V1, 16262306a36Sopenharmony_ci B_PATH0_S20_FOLLOW_BY_PAGCUGC_EN_MSK}, 16362306a36Sopenharmony_ci .p1_p20_pagcugc_en = {R_PATH1_P20_FOLLOW_BY_PAGCUGC_V1, 16462306a36Sopenharmony_ci B_PATH1_P20_FOLLOW_BY_PAGCUGC_EN_MSK}, 16562306a36Sopenharmony_ci .p1_s20_pagcugc_en = {R_PATH1_S20_FOLLOW_BY_PAGCUGC_V1, 16662306a36Sopenharmony_ci B_PATH1_S20_FOLLOW_BY_PAGCUGC_EN_MSK}, 16762306a36Sopenharmony_ci}; 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_cistatic void rtw8852c_ctrl_btg(struct rtw89_dev *rtwdev, bool btg); 17062306a36Sopenharmony_cistatic void rtw8852c_ctrl_tx_path_tmac(struct rtw89_dev *rtwdev, u8 tx_path, 17162306a36Sopenharmony_ci enum rtw89_mac_idx mac_idx); 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_cistatic int rtw8852c_pwr_on_func(struct rtw89_dev *rtwdev) 17462306a36Sopenharmony_ci{ 17562306a36Sopenharmony_ci u32 val32; 17662306a36Sopenharmony_ci u32 ret; 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_ci val32 = rtw89_read32_mask(rtwdev, R_AX_SYS_STATUS1, B_AX_PAD_HCI_SEL_V2_MASK); 17962306a36Sopenharmony_ci if (val32 == MAC_AX_HCI_SEL_PCIE_USB) 18062306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_LDO_AON_CTRL0, B_AX_PD_REGU_L); 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_AFSM_WLSUS_EN | 18362306a36Sopenharmony_ci B_AX_AFSM_PCIE_SUS_EN); 18462306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_DIS_WLBT_PDNSUSEN_SOPC); 18562306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_WLLPS_CTRL, B_AX_DIS_WLBT_LPSEN_LOPC); 18662306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APDM_HPDN); 18762306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_SWLPS); 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_ci ret = read_poll_timeout(rtw89_read32, val32, val32 & B_AX_RDY_SYSPWR, 19062306a36Sopenharmony_ci 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 19162306a36Sopenharmony_ci if (ret) 19262306a36Sopenharmony_ci return ret; 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_EN_WLON); 19562306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFN_ONMAC); 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci ret = read_poll_timeout(rtw89_read32, val32, !(val32 & B_AX_APFN_ONMAC), 19862306a36Sopenharmony_ci 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 19962306a36Sopenharmony_ci if (ret) 20062306a36Sopenharmony_ci return ret; 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 20362306a36Sopenharmony_ci rtw89_write8_clr(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 20462306a36Sopenharmony_ci rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 20562306a36Sopenharmony_ci rtw89_write8_clr(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_ci rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 20862306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_SDIO_CTRL, B_AX_PCIE_CALIB_EN_V1); 20962306a36Sopenharmony_ci 21062306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, B_AX_CMAC1_FEN); 21162306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, B_AX_R_SYM_ISO_CMAC12PP); 21262306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_AFE_CTRL1, B_AX_R_SYM_WLCMAC1_P4_PC_EN | 21362306a36Sopenharmony_ci B_AX_R_SYM_WLCMAC1_P3_PC_EN | 21462306a36Sopenharmony_ci B_AX_R_SYM_WLCMAC1_P2_PC_EN | 21562306a36Sopenharmony_ci B_AX_R_SYM_WLCMAC1_P1_PC_EN | 21662306a36Sopenharmony_ci B_AX_R_SYM_WLCMAC1_PC_EN); 21762306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_PTA_1P3); 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 22062306a36Sopenharmony_ci XTAL_SI_GND_SHDN_WL, XTAL_SI_GND_SHDN_WL); 22162306a36Sopenharmony_ci if (ret) 22262306a36Sopenharmony_ci return ret; 22362306a36Sopenharmony_ci 22462306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_RFC_1P3); 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 22762306a36Sopenharmony_ci XTAL_SI_SHDN_WL, XTAL_SI_SHDN_WL); 22862306a36Sopenharmony_ci if (ret) 22962306a36Sopenharmony_ci return ret; 23062306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_OFF_WEI, 23162306a36Sopenharmony_ci XTAL_SI_OFF_WEI); 23262306a36Sopenharmony_ci if (ret) 23362306a36Sopenharmony_ci return ret; 23462306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_OFF_EI, 23562306a36Sopenharmony_ci XTAL_SI_OFF_EI); 23662306a36Sopenharmony_ci if (ret) 23762306a36Sopenharmony_ci return ret; 23862306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_RFC2RF); 23962306a36Sopenharmony_ci if (ret) 24062306a36Sopenharmony_ci return ret; 24162306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_PON_WEI, 24262306a36Sopenharmony_ci XTAL_SI_PON_WEI); 24362306a36Sopenharmony_ci if (ret) 24462306a36Sopenharmony_ci return ret; 24562306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_PON_EI, 24662306a36Sopenharmony_ci XTAL_SI_PON_EI); 24762306a36Sopenharmony_ci if (ret) 24862306a36Sopenharmony_ci return ret; 24962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_SRAM2RFC); 25062306a36Sopenharmony_ci if (ret) 25162306a36Sopenharmony_ci return ret; 25262306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_XMD_2, 0, XTAL_SI_LDO_LPS); 25362306a36Sopenharmony_ci if (ret) 25462306a36Sopenharmony_ci return ret; 25562306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_XMD_4, 0, XTAL_SI_LPS_CAP); 25662306a36Sopenharmony_ci if (ret) 25762306a36Sopenharmony_ci return ret; 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_PMC_DBG_CTRL2, B_AX_SYSON_DIS_PMCR_AX_WRMSK); 26062306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_ISO_EB2CORE); 26162306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_PWC_EV2EF_B15); 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci fsleep(1000); 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_PWC_EV2EF_B14); 26662306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_PMC_DBG_CTRL2, B_AX_SYSON_DIS_PMCR_AX_WRMSK); 26762306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_GPIO0_15_EECS_EESK_LED1_PULL_LOW_EN, 26862306a36Sopenharmony_ci B_AX_EECS_PULL_LOW_EN | B_AX_EESK_PULL_LOW_EN | 26962306a36Sopenharmony_ci B_AX_LED1_PULL_LOW_EN); 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_DMAC_FUNC_EN, 27262306a36Sopenharmony_ci B_AX_MAC_FUNC_EN | B_AX_DMAC_FUNC_EN | B_AX_MPDU_PROC_EN | 27362306a36Sopenharmony_ci B_AX_WD_RLS_EN | B_AX_DLE_WDE_EN | B_AX_TXPKT_CTRL_EN | 27462306a36Sopenharmony_ci B_AX_STA_SCH_EN | B_AX_DLE_PLE_EN | B_AX_PKT_BUF_EN | 27562306a36Sopenharmony_ci B_AX_DMAC_TBL_EN | B_AX_PKT_IN_EN | B_AX_DLE_CPUIO_EN | 27662306a36Sopenharmony_ci B_AX_DISPATCHER_EN | B_AX_BBRPT_EN | B_AX_MAC_SEC_EN | 27762306a36Sopenharmony_ci B_AX_MAC_UN_EN | B_AX_H_AXIDMA_EN); 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_CMAC_FUNC_EN, 28062306a36Sopenharmony_ci B_AX_CMAC_EN | B_AX_CMAC_TXEN | B_AX_CMAC_RXEN | 28162306a36Sopenharmony_ci B_AX_FORCE_CMACREG_GCKEN | B_AX_PHYINTF_EN | 28262306a36Sopenharmony_ci B_AX_CMAC_DMA_EN | B_AX_PTCLTOP_EN | B_AX_SCHEDULER_EN | 28362306a36Sopenharmony_ci B_AX_TMAC_EN | B_AX_RMAC_EN); 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, R_AX_LED1_FUNC_SEL, B_AX_PINMUX_EESK_FUNC_SEL_V1_MASK, 28662306a36Sopenharmony_ci PINMUX_EESK_FUNC_SEL_BT_LOG); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci return 0; 28962306a36Sopenharmony_ci} 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic int rtw8852c_pwr_off_func(struct rtw89_dev *rtwdev) 29262306a36Sopenharmony_ci{ 29362306a36Sopenharmony_ci u32 val32; 29462306a36Sopenharmony_ci u32 ret; 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_RFC2RF, 29762306a36Sopenharmony_ci XTAL_SI_RFC2RF); 29862306a36Sopenharmony_ci if (ret) 29962306a36Sopenharmony_ci return ret; 30062306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_OFF_EI); 30162306a36Sopenharmony_ci if (ret) 30262306a36Sopenharmony_ci return ret; 30362306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_OFF_WEI); 30462306a36Sopenharmony_ci if (ret) 30562306a36Sopenharmony_ci return ret; 30662306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S0, 0, XTAL_SI_RF00); 30762306a36Sopenharmony_ci if (ret) 30862306a36Sopenharmony_ci return ret; 30962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S1, 0, XTAL_SI_RF10); 31062306a36Sopenharmony_ci if (ret) 31162306a36Sopenharmony_ci return ret; 31262306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_SRAM2RFC, 31362306a36Sopenharmony_ci XTAL_SI_SRAM2RFC); 31462306a36Sopenharmony_ci if (ret) 31562306a36Sopenharmony_ci return ret; 31662306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_PON_EI); 31762306a36Sopenharmony_ci if (ret) 31862306a36Sopenharmony_ci return ret; 31962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_PON_WEI); 32062306a36Sopenharmony_ci if (ret) 32162306a36Sopenharmony_ci return ret; 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_EN_WLON); 32462306a36Sopenharmony_ci rtw89_write8_clr(rtwdev, R_AX_SYS_FUNC_EN, B_AX_FEN_BB_GLB_RSTN | B_AX_FEN_BBRSTB); 32562306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, 32662306a36Sopenharmony_ci B_AX_R_SYM_FEN_WLBBGLB_1 | B_AX_R_SYM_FEN_WLBBFUN_1); 32762306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_RFC_1P3); 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_SHDN_WL); 33062306a36Sopenharmony_ci if (ret) 33162306a36Sopenharmony_ci return ret; 33262306a36Sopenharmony_ci 33362306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_PTA_1P3); 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_GND_SHDN_WL); 33662306a36Sopenharmony_ci if (ret) 33762306a36Sopenharmony_ci return ret; 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_OFFMAC); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci ret = read_poll_timeout(rtw89_read32, val32, !(val32 & B_AX_APFM_OFFMAC), 34262306a36Sopenharmony_ci 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 34362306a36Sopenharmony_ci if (ret) 34462306a36Sopenharmony_ci return ret; 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci rtw89_write32(rtwdev, R_AX_WLLPS_CTRL, 0x0001A0B0); 34762306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_XTAL_OFF_A_DIE); 34862306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_SWLPS); 34962306a36Sopenharmony_ci 35062306a36Sopenharmony_ci return 0; 35162306a36Sopenharmony_ci} 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_cistatic void rtw8852c_e_efuse_parsing(struct rtw89_efuse *efuse, 35462306a36Sopenharmony_ci struct rtw8852c_efuse *map) 35562306a36Sopenharmony_ci{ 35662306a36Sopenharmony_ci ether_addr_copy(efuse->addr, map->e.mac_addr); 35762306a36Sopenharmony_ci efuse->rfe_type = map->rfe_type; 35862306a36Sopenharmony_ci efuse->xtal_cap = map->xtal_k; 35962306a36Sopenharmony_ci} 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_cistatic void rtw8852c_efuse_parsing_tssi(struct rtw89_dev *rtwdev, 36262306a36Sopenharmony_ci struct rtw8852c_efuse *map) 36362306a36Sopenharmony_ci{ 36462306a36Sopenharmony_ci struct rtw89_tssi_info *tssi = &rtwdev->tssi; 36562306a36Sopenharmony_ci struct rtw8852c_tssi_offset *ofst[] = {&map->path_a_tssi, &map->path_b_tssi}; 36662306a36Sopenharmony_ci u8 *bw40_1s_tssi_6g_ofst[] = {map->bw40_1s_tssi_6g_a, map->bw40_1s_tssi_6g_b}; 36762306a36Sopenharmony_ci u8 i, j; 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci tssi->thermal[RF_PATH_A] = map->path_a_therm; 37062306a36Sopenharmony_ci tssi->thermal[RF_PATH_B] = map->path_b_therm; 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 37362306a36Sopenharmony_ci memcpy(tssi->tssi_cck[i], ofst[i]->cck_tssi, 37462306a36Sopenharmony_ci sizeof(ofst[i]->cck_tssi)); 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci for (j = 0; j < TSSI_CCK_CH_GROUP_NUM; j++) 37762306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TSSI, 37862306a36Sopenharmony_ci "[TSSI][EFUSE] path=%d cck[%d]=0x%x\n", 37962306a36Sopenharmony_ci i, j, tssi->tssi_cck[i][j]); 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_ci memcpy(tssi->tssi_mcs[i], ofst[i]->bw40_tssi, 38262306a36Sopenharmony_ci sizeof(ofst[i]->bw40_tssi)); 38362306a36Sopenharmony_ci memcpy(tssi->tssi_mcs[i] + TSSI_MCS_2G_CH_GROUP_NUM, 38462306a36Sopenharmony_ci ofst[i]->bw40_1s_tssi_5g, sizeof(ofst[i]->bw40_1s_tssi_5g)); 38562306a36Sopenharmony_ci memcpy(tssi->tssi_6g_mcs[i], bw40_1s_tssi_6g_ofst[i], 38662306a36Sopenharmony_ci sizeof(tssi->tssi_6g_mcs[i])); 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci for (j = 0; j < TSSI_MCS_CH_GROUP_NUM; j++) 38962306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TSSI, 39062306a36Sopenharmony_ci "[TSSI][EFUSE] path=%d mcs[%d]=0x%x\n", 39162306a36Sopenharmony_ci i, j, tssi->tssi_mcs[i][j]); 39262306a36Sopenharmony_ci } 39362306a36Sopenharmony_ci} 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_cistatic bool _decode_efuse_gain(u8 data, s8 *high, s8 *low) 39662306a36Sopenharmony_ci{ 39762306a36Sopenharmony_ci if (high) 39862306a36Sopenharmony_ci *high = sign_extend32(FIELD_GET(GENMASK(7, 4), data), 3); 39962306a36Sopenharmony_ci if (low) 40062306a36Sopenharmony_ci *low = sign_extend32(FIELD_GET(GENMASK(3, 0), data), 3); 40162306a36Sopenharmony_ci 40262306a36Sopenharmony_ci return data != 0xff; 40362306a36Sopenharmony_ci} 40462306a36Sopenharmony_ci 40562306a36Sopenharmony_cistatic void rtw8852c_efuse_parsing_gain_offset(struct rtw89_dev *rtwdev, 40662306a36Sopenharmony_ci struct rtw8852c_efuse *map) 40762306a36Sopenharmony_ci{ 40862306a36Sopenharmony_ci struct rtw89_phy_efuse_gain *gain = &rtwdev->efuse_gain; 40962306a36Sopenharmony_ci bool valid = false; 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci valid |= _decode_efuse_gain(map->rx_gain_2g_cck, 41262306a36Sopenharmony_ci &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_2G_CCK], 41362306a36Sopenharmony_ci &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_2G_CCK]); 41462306a36Sopenharmony_ci valid |= _decode_efuse_gain(map->rx_gain_2g_ofdm, 41562306a36Sopenharmony_ci &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_2G_OFDM], 41662306a36Sopenharmony_ci &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_2G_OFDM]); 41762306a36Sopenharmony_ci valid |= _decode_efuse_gain(map->rx_gain_5g_low, 41862306a36Sopenharmony_ci &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_LOW], 41962306a36Sopenharmony_ci &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_LOW]); 42062306a36Sopenharmony_ci valid |= _decode_efuse_gain(map->rx_gain_5g_mid, 42162306a36Sopenharmony_ci &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_MID], 42262306a36Sopenharmony_ci &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_MID]); 42362306a36Sopenharmony_ci valid |= _decode_efuse_gain(map->rx_gain_5g_high, 42462306a36Sopenharmony_ci &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_HIGH], 42562306a36Sopenharmony_ci &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_HIGH]); 42662306a36Sopenharmony_ci 42762306a36Sopenharmony_ci gain->offset_valid = valid; 42862306a36Sopenharmony_ci} 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_cistatic int rtw8852c_read_efuse(struct rtw89_dev *rtwdev, u8 *log_map) 43162306a36Sopenharmony_ci{ 43262306a36Sopenharmony_ci struct rtw89_efuse *efuse = &rtwdev->efuse; 43362306a36Sopenharmony_ci struct rtw8852c_efuse *map; 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ci map = (struct rtw8852c_efuse *)log_map; 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ci efuse->country_code[0] = map->country_code[0]; 43862306a36Sopenharmony_ci efuse->country_code[1] = map->country_code[1]; 43962306a36Sopenharmony_ci rtw8852c_efuse_parsing_tssi(rtwdev, map); 44062306a36Sopenharmony_ci rtw8852c_efuse_parsing_gain_offset(rtwdev, map); 44162306a36Sopenharmony_ci 44262306a36Sopenharmony_ci switch (rtwdev->hci.type) { 44362306a36Sopenharmony_ci case RTW89_HCI_TYPE_PCIE: 44462306a36Sopenharmony_ci rtw8852c_e_efuse_parsing(efuse, map); 44562306a36Sopenharmony_ci break; 44662306a36Sopenharmony_ci default: 44762306a36Sopenharmony_ci return -ENOTSUPP; 44862306a36Sopenharmony_ci } 44962306a36Sopenharmony_ci 45062306a36Sopenharmony_ci rtw89_info(rtwdev, "chip rfe_type is %d\n", efuse->rfe_type); 45162306a36Sopenharmony_ci 45262306a36Sopenharmony_ci return 0; 45362306a36Sopenharmony_ci} 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_cistatic void rtw8852c_phycap_parsing_tssi(struct rtw89_dev *rtwdev, u8 *phycap_map) 45662306a36Sopenharmony_ci{ 45762306a36Sopenharmony_ci struct rtw89_tssi_info *tssi = &rtwdev->tssi; 45862306a36Sopenharmony_ci static const u32 tssi_trim_addr[RF_PATH_NUM_8852C] = {0x5D6, 0x5AB}; 45962306a36Sopenharmony_ci static const u32 tssi_trim_addr_6g[RF_PATH_NUM_8852C] = {0x5CE, 0x5A3}; 46062306a36Sopenharmony_ci u32 addr = rtwdev->chip->phycap_addr; 46162306a36Sopenharmony_ci bool pg = false; 46262306a36Sopenharmony_ci u32 ofst; 46362306a36Sopenharmony_ci u8 i, j; 46462306a36Sopenharmony_ci 46562306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 46662306a36Sopenharmony_ci for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM; j++) { 46762306a36Sopenharmony_ci /* addrs are in decreasing order */ 46862306a36Sopenharmony_ci ofst = tssi_trim_addr[i] - addr - j; 46962306a36Sopenharmony_ci tssi->tssi_trim[i][j] = phycap_map[ofst]; 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_ci if (phycap_map[ofst] != 0xff) 47262306a36Sopenharmony_ci pg = true; 47362306a36Sopenharmony_ci } 47462306a36Sopenharmony_ci 47562306a36Sopenharmony_ci for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM_6G; j++) { 47662306a36Sopenharmony_ci /* addrs are in decreasing order */ 47762306a36Sopenharmony_ci ofst = tssi_trim_addr_6g[i] - addr - j; 47862306a36Sopenharmony_ci tssi->tssi_trim_6g[i][j] = phycap_map[ofst]; 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_ci if (phycap_map[ofst] != 0xff) 48162306a36Sopenharmony_ci pg = true; 48262306a36Sopenharmony_ci } 48362306a36Sopenharmony_ci } 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci if (!pg) { 48662306a36Sopenharmony_ci memset(tssi->tssi_trim, 0, sizeof(tssi->tssi_trim)); 48762306a36Sopenharmony_ci memset(tssi->tssi_trim_6g, 0, sizeof(tssi->tssi_trim_6g)); 48862306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TSSI, 48962306a36Sopenharmony_ci "[TSSI][TRIM] no PG, set all trim info to 0\n"); 49062306a36Sopenharmony_ci } 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) 49362306a36Sopenharmony_ci for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM; j++) 49462306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TSSI, 49562306a36Sopenharmony_ci "[TSSI] path=%d idx=%d trim=0x%x addr=0x%x\n", 49662306a36Sopenharmony_ci i, j, tssi->tssi_trim[i][j], 49762306a36Sopenharmony_ci tssi_trim_addr[i] - j); 49862306a36Sopenharmony_ci} 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_cistatic void rtw8852c_phycap_parsing_thermal_trim(struct rtw89_dev *rtwdev, 50162306a36Sopenharmony_ci u8 *phycap_map) 50262306a36Sopenharmony_ci{ 50362306a36Sopenharmony_ci struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 50462306a36Sopenharmony_ci static const u32 thm_trim_addr[RF_PATH_NUM_8852C] = {0x5DF, 0x5DC}; 50562306a36Sopenharmony_ci u32 addr = rtwdev->chip->phycap_addr; 50662306a36Sopenharmony_ci u8 i; 50762306a36Sopenharmony_ci 50862306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 50962306a36Sopenharmony_ci info->thermal_trim[i] = phycap_map[thm_trim_addr[i] - addr]; 51062306a36Sopenharmony_ci 51162306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 51262306a36Sopenharmony_ci "[THERMAL][TRIM] path=%d thermal_trim=0x%x\n", 51362306a36Sopenharmony_ci i, info->thermal_trim[i]); 51462306a36Sopenharmony_ci 51562306a36Sopenharmony_ci if (info->thermal_trim[i] != 0xff) 51662306a36Sopenharmony_ci info->pg_thermal_trim = true; 51762306a36Sopenharmony_ci } 51862306a36Sopenharmony_ci} 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_cistatic void rtw8852c_thermal_trim(struct rtw89_dev *rtwdev) 52162306a36Sopenharmony_ci{ 52262306a36Sopenharmony_ci#define __thm_setting(raw) \ 52362306a36Sopenharmony_ci({ \ 52462306a36Sopenharmony_ci u8 __v = (raw); \ 52562306a36Sopenharmony_ci ((__v & 0x1) << 3) | ((__v & 0x1f) >> 1); \ 52662306a36Sopenharmony_ci}) 52762306a36Sopenharmony_ci struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 52862306a36Sopenharmony_ci u8 i, val; 52962306a36Sopenharmony_ci 53062306a36Sopenharmony_ci if (!info->pg_thermal_trim) { 53162306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 53262306a36Sopenharmony_ci "[THERMAL][TRIM] no PG, do nothing\n"); 53362306a36Sopenharmony_ci 53462306a36Sopenharmony_ci return; 53562306a36Sopenharmony_ci } 53662306a36Sopenharmony_ci 53762306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 53862306a36Sopenharmony_ci val = __thm_setting(info->thermal_trim[i]); 53962306a36Sopenharmony_ci rtw89_write_rf(rtwdev, i, RR_TM2, RR_TM2_OFF, val); 54062306a36Sopenharmony_ci 54162306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 54262306a36Sopenharmony_ci "[THERMAL][TRIM] path=%d thermal_setting=0x%x\n", 54362306a36Sopenharmony_ci i, val); 54462306a36Sopenharmony_ci } 54562306a36Sopenharmony_ci#undef __thm_setting 54662306a36Sopenharmony_ci} 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_cistatic void rtw8852c_phycap_parsing_pa_bias_trim(struct rtw89_dev *rtwdev, 54962306a36Sopenharmony_ci u8 *phycap_map) 55062306a36Sopenharmony_ci{ 55162306a36Sopenharmony_ci struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 55262306a36Sopenharmony_ci static const u32 pabias_trim_addr[RF_PATH_NUM_8852C] = {0x5DE, 0x5DB}; 55362306a36Sopenharmony_ci u32 addr = rtwdev->chip->phycap_addr; 55462306a36Sopenharmony_ci u8 i; 55562306a36Sopenharmony_ci 55662306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 55762306a36Sopenharmony_ci info->pa_bias_trim[i] = phycap_map[pabias_trim_addr[i] - addr]; 55862306a36Sopenharmony_ci 55962306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 56062306a36Sopenharmony_ci "[PA_BIAS][TRIM] path=%d pa_bias_trim=0x%x\n", 56162306a36Sopenharmony_ci i, info->pa_bias_trim[i]); 56262306a36Sopenharmony_ci 56362306a36Sopenharmony_ci if (info->pa_bias_trim[i] != 0xff) 56462306a36Sopenharmony_ci info->pg_pa_bias_trim = true; 56562306a36Sopenharmony_ci } 56662306a36Sopenharmony_ci} 56762306a36Sopenharmony_ci 56862306a36Sopenharmony_cistatic void rtw8852c_pa_bias_trim(struct rtw89_dev *rtwdev) 56962306a36Sopenharmony_ci{ 57062306a36Sopenharmony_ci struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 57162306a36Sopenharmony_ci u8 pabias_2g, pabias_5g; 57262306a36Sopenharmony_ci u8 i; 57362306a36Sopenharmony_ci 57462306a36Sopenharmony_ci if (!info->pg_pa_bias_trim) { 57562306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 57662306a36Sopenharmony_ci "[PA_BIAS][TRIM] no PG, do nothing\n"); 57762306a36Sopenharmony_ci 57862306a36Sopenharmony_ci return; 57962306a36Sopenharmony_ci } 58062306a36Sopenharmony_ci 58162306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) { 58262306a36Sopenharmony_ci pabias_2g = FIELD_GET(GENMASK(3, 0), info->pa_bias_trim[i]); 58362306a36Sopenharmony_ci pabias_5g = FIELD_GET(GENMASK(7, 4), info->pa_bias_trim[i]); 58462306a36Sopenharmony_ci 58562306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_RFK, 58662306a36Sopenharmony_ci "[PA_BIAS][TRIM] path=%d 2G=0x%x 5G=0x%x\n", 58762306a36Sopenharmony_ci i, pabias_2g, pabias_5g); 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_ci rtw89_write_rf(rtwdev, i, RR_BIASA, RR_BIASA_TXG, pabias_2g); 59062306a36Sopenharmony_ci rtw89_write_rf(rtwdev, i, RR_BIASA, RR_BIASA_TXA, pabias_5g); 59162306a36Sopenharmony_ci } 59262306a36Sopenharmony_ci} 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_cistatic int rtw8852c_read_phycap(struct rtw89_dev *rtwdev, u8 *phycap_map) 59562306a36Sopenharmony_ci{ 59662306a36Sopenharmony_ci rtw8852c_phycap_parsing_tssi(rtwdev, phycap_map); 59762306a36Sopenharmony_ci rtw8852c_phycap_parsing_thermal_trim(rtwdev, phycap_map); 59862306a36Sopenharmony_ci rtw8852c_phycap_parsing_pa_bias_trim(rtwdev, phycap_map); 59962306a36Sopenharmony_ci 60062306a36Sopenharmony_ci return 0; 60162306a36Sopenharmony_ci} 60262306a36Sopenharmony_ci 60362306a36Sopenharmony_cistatic void rtw8852c_power_trim(struct rtw89_dev *rtwdev) 60462306a36Sopenharmony_ci{ 60562306a36Sopenharmony_ci rtw8852c_thermal_trim(rtwdev); 60662306a36Sopenharmony_ci rtw8852c_pa_bias_trim(rtwdev); 60762306a36Sopenharmony_ci} 60862306a36Sopenharmony_ci 60962306a36Sopenharmony_cistatic void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev, 61062306a36Sopenharmony_ci const struct rtw89_chan *chan, 61162306a36Sopenharmony_ci u8 mac_idx) 61262306a36Sopenharmony_ci{ 61362306a36Sopenharmony_ci u32 rf_mod = rtw89_mac_reg_by_idx(rtwdev, R_AX_WMAC_RFMOD, mac_idx); 61462306a36Sopenharmony_ci u32 sub_carr = rtw89_mac_reg_by_idx(rtwdev, R_AX_TX_SUB_CARRIER_VALUE, mac_idx); 61562306a36Sopenharmony_ci u32 chk_rate = rtw89_mac_reg_by_idx(rtwdev, R_AX_TXRATE_CHK, mac_idx); 61662306a36Sopenharmony_ci u8 txsc20 = 0, txsc40 = 0, txsc80 = 0; 61762306a36Sopenharmony_ci u8 rf_mod_val = 0, chk_rate_mask = 0; 61862306a36Sopenharmony_ci u32 txsc; 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_ci switch (chan->band_width) { 62162306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_160: 62262306a36Sopenharmony_ci txsc80 = rtw89_phy_get_txsc(rtwdev, chan, 62362306a36Sopenharmony_ci RTW89_CHANNEL_WIDTH_80); 62462306a36Sopenharmony_ci fallthrough; 62562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_80: 62662306a36Sopenharmony_ci txsc40 = rtw89_phy_get_txsc(rtwdev, chan, 62762306a36Sopenharmony_ci RTW89_CHANNEL_WIDTH_40); 62862306a36Sopenharmony_ci fallthrough; 62962306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_40: 63062306a36Sopenharmony_ci txsc20 = rtw89_phy_get_txsc(rtwdev, chan, 63162306a36Sopenharmony_ci RTW89_CHANNEL_WIDTH_20); 63262306a36Sopenharmony_ci break; 63362306a36Sopenharmony_ci default: 63462306a36Sopenharmony_ci break; 63562306a36Sopenharmony_ci } 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_ci switch (chan->band_width) { 63862306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_160: 63962306a36Sopenharmony_ci rf_mod_val = AX_WMAC_RFMOD_160M; 64062306a36Sopenharmony_ci txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20) | 64162306a36Sopenharmony_ci FIELD_PREP(B_AX_TXSC_40M_MASK, txsc40) | 64262306a36Sopenharmony_ci FIELD_PREP(B_AX_TXSC_80M_MASK, txsc80); 64362306a36Sopenharmony_ci break; 64462306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_80: 64562306a36Sopenharmony_ci rf_mod_val = AX_WMAC_RFMOD_80M; 64662306a36Sopenharmony_ci txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20) | 64762306a36Sopenharmony_ci FIELD_PREP(B_AX_TXSC_40M_MASK, txsc40); 64862306a36Sopenharmony_ci break; 64962306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_40: 65062306a36Sopenharmony_ci rf_mod_val = AX_WMAC_RFMOD_40M; 65162306a36Sopenharmony_ci txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20); 65262306a36Sopenharmony_ci break; 65362306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_20: 65462306a36Sopenharmony_ci default: 65562306a36Sopenharmony_ci rf_mod_val = AX_WMAC_RFMOD_20M; 65662306a36Sopenharmony_ci txsc = 0; 65762306a36Sopenharmony_ci break; 65862306a36Sopenharmony_ci } 65962306a36Sopenharmony_ci rtw89_write8_mask(rtwdev, rf_mod, B_AX_WMAC_RFMOD_MASK, rf_mod_val); 66062306a36Sopenharmony_ci rtw89_write32(rtwdev, sub_carr, txsc); 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci switch (chan->band_type) { 66362306a36Sopenharmony_ci case RTW89_BAND_2G: 66462306a36Sopenharmony_ci chk_rate_mask = B_AX_BAND_MODE; 66562306a36Sopenharmony_ci break; 66662306a36Sopenharmony_ci case RTW89_BAND_5G: 66762306a36Sopenharmony_ci case RTW89_BAND_6G: 66862306a36Sopenharmony_ci chk_rate_mask = B_AX_CHECK_CCK_EN | B_AX_RTS_LIMIT_IN_OFDM6; 66962306a36Sopenharmony_ci break; 67062306a36Sopenharmony_ci default: 67162306a36Sopenharmony_ci rtw89_warn(rtwdev, "Invalid band_type:%d\n", chan->band_type); 67262306a36Sopenharmony_ci return; 67362306a36Sopenharmony_ci } 67462306a36Sopenharmony_ci rtw89_write8_clr(rtwdev, chk_rate, B_AX_BAND_MODE | B_AX_CHECK_CCK_EN | 67562306a36Sopenharmony_ci B_AX_RTS_LIMIT_IN_OFDM6); 67662306a36Sopenharmony_ci rtw89_write8_set(rtwdev, chk_rate, chk_rate_mask); 67762306a36Sopenharmony_ci} 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_cistatic const u32 rtw8852c_sco_barker_threshold[14] = { 68062306a36Sopenharmony_ci 0x1fe4f, 0x1ff5e, 0x2006c, 0x2017b, 0x2028a, 0x20399, 0x204a8, 0x205b6, 68162306a36Sopenharmony_ci 0x206c5, 0x207d4, 0x208e3, 0x209f2, 0x20b00, 0x20d8a 68262306a36Sopenharmony_ci}; 68362306a36Sopenharmony_ci 68462306a36Sopenharmony_cistatic const u32 rtw8852c_sco_cck_threshold[14] = { 68562306a36Sopenharmony_ci 0x2bdac, 0x2bf21, 0x2c095, 0x2c209, 0x2c37e, 0x2c4f2, 0x2c666, 0x2c7db, 68662306a36Sopenharmony_ci 0x2c94f, 0x2cac3, 0x2cc38, 0x2cdac, 0x2cf21, 0x2d29e 68762306a36Sopenharmony_ci}; 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_cistatic int rtw8852c_ctrl_sco_cck(struct rtw89_dev *rtwdev, u8 central_ch, 69062306a36Sopenharmony_ci u8 primary_ch, enum rtw89_bandwidth bw) 69162306a36Sopenharmony_ci{ 69262306a36Sopenharmony_ci u8 ch_element; 69362306a36Sopenharmony_ci 69462306a36Sopenharmony_ci if (bw == RTW89_CHANNEL_WIDTH_20) { 69562306a36Sopenharmony_ci ch_element = central_ch - 1; 69662306a36Sopenharmony_ci } else if (bw == RTW89_CHANNEL_WIDTH_40) { 69762306a36Sopenharmony_ci if (primary_ch == 1) 69862306a36Sopenharmony_ci ch_element = central_ch - 1 + 2; 69962306a36Sopenharmony_ci else 70062306a36Sopenharmony_ci ch_element = central_ch - 1 - 2; 70162306a36Sopenharmony_ci } else { 70262306a36Sopenharmony_ci rtw89_warn(rtwdev, "Invalid BW:%d for CCK\n", bw); 70362306a36Sopenharmony_ci return -EINVAL; 70462306a36Sopenharmony_ci } 70562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_BK_FC0_INV_V1, B_BK_FC0_INV_MSK_V1, 70662306a36Sopenharmony_ci rtw8852c_sco_barker_threshold[ch_element]); 70762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CCK_FC0_INV_V1, B_CCK_FC0_INV_MSK_V1, 70862306a36Sopenharmony_ci rtw8852c_sco_cck_threshold[ch_element]); 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci return 0; 71162306a36Sopenharmony_ci} 71262306a36Sopenharmony_ci 71362306a36Sopenharmony_cistruct rtw8852c_bb_gain { 71462306a36Sopenharmony_ci u32 gain_g[BB_PATH_NUM_8852C]; 71562306a36Sopenharmony_ci u32 gain_a[BB_PATH_NUM_8852C]; 71662306a36Sopenharmony_ci u32 gain_mask; 71762306a36Sopenharmony_ci}; 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_cistatic const struct rtw8852c_bb_gain bb_gain_lna[LNA_GAIN_NUM] = { 72062306a36Sopenharmony_ci { .gain_g = {0x4678, 0x475C}, .gain_a = {0x45DC, 0x4740}, 72162306a36Sopenharmony_ci .gain_mask = 0x00ff0000 }, 72262306a36Sopenharmony_ci { .gain_g = {0x4678, 0x475C}, .gain_a = {0x45DC, 0x4740}, 72362306a36Sopenharmony_ci .gain_mask = 0xff000000 }, 72462306a36Sopenharmony_ci { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 72562306a36Sopenharmony_ci .gain_mask = 0x000000ff }, 72662306a36Sopenharmony_ci { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 72762306a36Sopenharmony_ci .gain_mask = 0x0000ff00 }, 72862306a36Sopenharmony_ci { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 72962306a36Sopenharmony_ci .gain_mask = 0x00ff0000 }, 73062306a36Sopenharmony_ci { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 73162306a36Sopenharmony_ci .gain_mask = 0xff000000 }, 73262306a36Sopenharmony_ci { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 73362306a36Sopenharmony_ci .gain_mask = 0x000000ff }, 73462306a36Sopenharmony_ci}; 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_cistatic const struct rtw8852c_bb_gain bb_gain_tia[TIA_GAIN_NUM] = { 73762306a36Sopenharmony_ci { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 73862306a36Sopenharmony_ci .gain_mask = 0x00ff0000 }, 73962306a36Sopenharmony_ci { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 74062306a36Sopenharmony_ci .gain_mask = 0xff000000 }, 74162306a36Sopenharmony_ci}; 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_cistruct rtw8852c_bb_gain_bypass { 74462306a36Sopenharmony_ci u32 gain_g[BB_PATH_NUM_8852C]; 74562306a36Sopenharmony_ci u32 gain_a[BB_PATH_NUM_8852C]; 74662306a36Sopenharmony_ci u32 gain_mask_g; 74762306a36Sopenharmony_ci u32 gain_mask_a; 74862306a36Sopenharmony_ci}; 74962306a36Sopenharmony_ci 75062306a36Sopenharmony_cistatic 75162306a36Sopenharmony_ciconst struct rtw8852c_bb_gain_bypass bb_gain_bypass_lna[LNA_GAIN_NUM] = { 75262306a36Sopenharmony_ci { .gain_g = {0x4BB8, 0x4C7C}, .gain_a = {0x4BB4, 0x4C78}, 75362306a36Sopenharmony_ci .gain_mask_g = 0xff000000, .gain_mask_a = 0xff}, 75462306a36Sopenharmony_ci { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 75562306a36Sopenharmony_ci .gain_mask_g = 0xff, .gain_mask_a = 0xff00}, 75662306a36Sopenharmony_ci { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 75762306a36Sopenharmony_ci .gain_mask_g = 0xff00, .gain_mask_a = 0xff0000}, 75862306a36Sopenharmony_ci { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 75962306a36Sopenharmony_ci .gain_mask_g = 0xff0000, .gain_mask_a = 0xff000000}, 76062306a36Sopenharmony_ci { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB8, 0x4C7C}, 76162306a36Sopenharmony_ci .gain_mask_g = 0xff000000, .gain_mask_a = 0xff}, 76262306a36Sopenharmony_ci { .gain_g = {0x4BC0, 0x4C84}, .gain_a = {0x4BB8, 0x4C7C}, 76362306a36Sopenharmony_ci .gain_mask_g = 0xff, .gain_mask_a = 0xff00}, 76462306a36Sopenharmony_ci { .gain_g = {0x4BC0, 0x4C84}, .gain_a = {0x4BB8, 0x4C7C}, 76562306a36Sopenharmony_ci .gain_mask_g = 0xff00, .gain_mask_a = 0xff0000}, 76662306a36Sopenharmony_ci}; 76762306a36Sopenharmony_ci 76862306a36Sopenharmony_cistruct rtw8852c_bb_gain_op1db { 76962306a36Sopenharmony_ci struct { 77062306a36Sopenharmony_ci u32 lna[BB_PATH_NUM_8852C]; 77162306a36Sopenharmony_ci u32 tia_lna[BB_PATH_NUM_8852C]; 77262306a36Sopenharmony_ci u32 mask; 77362306a36Sopenharmony_ci } reg[LNA_GAIN_NUM]; 77462306a36Sopenharmony_ci u32 reg_tia0_lna6[BB_PATH_NUM_8852C]; 77562306a36Sopenharmony_ci u32 mask_tia0_lna6; 77662306a36Sopenharmony_ci}; 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_cistatic const struct rtw8852c_bb_gain_op1db bb_gain_op1db_a = { 77962306a36Sopenharmony_ci .reg = { 78062306a36Sopenharmony_ci { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 78162306a36Sopenharmony_ci .mask = 0xff}, 78262306a36Sopenharmony_ci { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 78362306a36Sopenharmony_ci .mask = 0xff00}, 78462306a36Sopenharmony_ci { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 78562306a36Sopenharmony_ci .mask = 0xff0000}, 78662306a36Sopenharmony_ci { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 78762306a36Sopenharmony_ci .mask = 0xff000000}, 78862306a36Sopenharmony_ci { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 78962306a36Sopenharmony_ci .mask = 0xff}, 79062306a36Sopenharmony_ci { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 79162306a36Sopenharmony_ci .mask = 0xff00}, 79262306a36Sopenharmony_ci { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 79362306a36Sopenharmony_ci .mask = 0xff0000}, 79462306a36Sopenharmony_ci }, 79562306a36Sopenharmony_ci .reg_tia0_lna6 = {0x4674, 0x4758}, 79662306a36Sopenharmony_ci .mask_tia0_lna6 = 0xff000000, 79762306a36Sopenharmony_ci}; 79862306a36Sopenharmony_ci 79962306a36Sopenharmony_cistatic void rtw8852c_set_gain_error(struct rtw89_dev *rtwdev, 80062306a36Sopenharmony_ci enum rtw89_subband subband, 80162306a36Sopenharmony_ci enum rtw89_rf_path path) 80262306a36Sopenharmony_ci{ 80362306a36Sopenharmony_ci const struct rtw89_phy_bb_gain_info *gain = &rtwdev->bb_gain; 80462306a36Sopenharmony_ci u8 gain_band = rtw89_subband_to_bb_gain_band(subband); 80562306a36Sopenharmony_ci s32 val; 80662306a36Sopenharmony_ci u32 reg; 80762306a36Sopenharmony_ci u32 mask; 80862306a36Sopenharmony_ci int i; 80962306a36Sopenharmony_ci 81062306a36Sopenharmony_ci for (i = 0; i < LNA_GAIN_NUM; i++) { 81162306a36Sopenharmony_ci if (subband == RTW89_CH_2G) 81262306a36Sopenharmony_ci reg = bb_gain_lna[i].gain_g[path]; 81362306a36Sopenharmony_ci else 81462306a36Sopenharmony_ci reg = bb_gain_lna[i].gain_a[path]; 81562306a36Sopenharmony_ci 81662306a36Sopenharmony_ci mask = bb_gain_lna[i].gain_mask; 81762306a36Sopenharmony_ci val = gain->lna_gain[gain_band][path][i]; 81862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 81962306a36Sopenharmony_ci 82062306a36Sopenharmony_ci if (subband == RTW89_CH_2G) { 82162306a36Sopenharmony_ci reg = bb_gain_bypass_lna[i].gain_g[path]; 82262306a36Sopenharmony_ci mask = bb_gain_bypass_lna[i].gain_mask_g; 82362306a36Sopenharmony_ci } else { 82462306a36Sopenharmony_ci reg = bb_gain_bypass_lna[i].gain_a[path]; 82562306a36Sopenharmony_ci mask = bb_gain_bypass_lna[i].gain_mask_a; 82662306a36Sopenharmony_ci } 82762306a36Sopenharmony_ci 82862306a36Sopenharmony_ci val = gain->lna_gain_bypass[gain_band][path][i]; 82962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 83062306a36Sopenharmony_ci 83162306a36Sopenharmony_ci if (subband != RTW89_CH_2G) { 83262306a36Sopenharmony_ci reg = bb_gain_op1db_a.reg[i].lna[path]; 83362306a36Sopenharmony_ci mask = bb_gain_op1db_a.reg[i].mask; 83462306a36Sopenharmony_ci val = gain->lna_op1db[gain_band][path][i]; 83562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 83662306a36Sopenharmony_ci 83762306a36Sopenharmony_ci reg = bb_gain_op1db_a.reg[i].tia_lna[path]; 83862306a36Sopenharmony_ci mask = bb_gain_op1db_a.reg[i].mask; 83962306a36Sopenharmony_ci val = gain->tia_lna_op1db[gain_band][path][i]; 84062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 84162306a36Sopenharmony_ci } 84262306a36Sopenharmony_ci } 84362306a36Sopenharmony_ci 84462306a36Sopenharmony_ci if (subband != RTW89_CH_2G) { 84562306a36Sopenharmony_ci reg = bb_gain_op1db_a.reg_tia0_lna6[path]; 84662306a36Sopenharmony_ci mask = bb_gain_op1db_a.mask_tia0_lna6; 84762306a36Sopenharmony_ci val = gain->tia_lna_op1db[gain_band][path][7]; 84862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 84962306a36Sopenharmony_ci } 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_ci for (i = 0; i < TIA_GAIN_NUM; i++) { 85262306a36Sopenharmony_ci if (subband == RTW89_CH_2G) 85362306a36Sopenharmony_ci reg = bb_gain_tia[i].gain_g[path]; 85462306a36Sopenharmony_ci else 85562306a36Sopenharmony_ci reg = bb_gain_tia[i].gain_a[path]; 85662306a36Sopenharmony_ci 85762306a36Sopenharmony_ci mask = bb_gain_tia[i].gain_mask; 85862306a36Sopenharmony_ci val = gain->tia_gain[gain_band][path][i]; 85962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, reg, mask, val); 86062306a36Sopenharmony_ci } 86162306a36Sopenharmony_ci} 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_cistatic void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev, 86462306a36Sopenharmony_ci const struct rtw89_chan *chan, 86562306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx, 86662306a36Sopenharmony_ci enum rtw89_rf_path path) 86762306a36Sopenharmony_ci{ 86862306a36Sopenharmony_ci static const u32 rssi_ofst_addr[2] = {R_PATH0_G_TIA0_LNA6_OP1DB_V1, 86962306a36Sopenharmony_ci R_PATH1_G_TIA0_LNA6_OP1DB_V1}; 87062306a36Sopenharmony_ci static const u32 rpl_mask[2] = {B_RPL_PATHA_MASK, B_RPL_PATHB_MASK}; 87162306a36Sopenharmony_ci static const u32 rpl_tb_mask[2] = {B_RSSI_M_PATHA_MASK, B_RSSI_M_PATHB_MASK}; 87262306a36Sopenharmony_ci struct rtw89_phy_efuse_gain *efuse_gain = &rtwdev->efuse_gain; 87362306a36Sopenharmony_ci enum rtw89_gain_offset gain_band; 87462306a36Sopenharmony_ci s32 offset_q0, offset_base_q4; 87562306a36Sopenharmony_ci s32 tmp = 0; 87662306a36Sopenharmony_ci 87762306a36Sopenharmony_ci if (!efuse_gain->offset_valid) 87862306a36Sopenharmony_ci return; 87962306a36Sopenharmony_ci 88062306a36Sopenharmony_ci if (rtwdev->dbcc_en && path == RF_PATH_B) 88162306a36Sopenharmony_ci phy_idx = RTW89_PHY_1; 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci if (chan->band_type == RTW89_BAND_2G) { 88462306a36Sopenharmony_ci offset_q0 = efuse_gain->offset[path][RTW89_GAIN_OFFSET_2G_CCK]; 88562306a36Sopenharmony_ci offset_base_q4 = efuse_gain->offset_base[phy_idx]; 88662306a36Sopenharmony_ci 88762306a36Sopenharmony_ci tmp = clamp_t(s32, (-offset_q0 << 3) + (offset_base_q4 >> 1), 88862306a36Sopenharmony_ci S8_MIN >> 1, S8_MAX >> 1); 88962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RPL_OFST, B_RPL_OFST_MASK, tmp & 0x7f); 89062306a36Sopenharmony_ci } 89162306a36Sopenharmony_ci 89262306a36Sopenharmony_ci gain_band = rtw89_subband_to_gain_offset_band_of_ofdm(chan->subband_type); 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_ci offset_q0 = -efuse_gain->offset[path][gain_band]; 89562306a36Sopenharmony_ci offset_base_q4 = efuse_gain->offset_base[phy_idx]; 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_ci tmp = (offset_q0 << 2) + (offset_base_q4 >> 2); 89862306a36Sopenharmony_ci tmp = clamp_t(s32, -tmp, S8_MIN, S8_MAX); 89962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, rssi_ofst_addr[path], B_PATH0_R_G_OFST_MASK, tmp & 0xff); 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_ci tmp = clamp_t(s32, offset_q0 << 4, S8_MIN, S8_MAX); 90262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RPL_PATHAB, rpl_mask[path], tmp & 0xff, phy_idx); 90362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSSI_M_PATHAB, rpl_tb_mask[path], tmp & 0xff, phy_idx); 90462306a36Sopenharmony_ci} 90562306a36Sopenharmony_ci 90662306a36Sopenharmony_cistatic void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev, 90762306a36Sopenharmony_ci const struct rtw89_chan *chan, 90862306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 90962306a36Sopenharmony_ci{ 91062306a36Sopenharmony_ci u8 sco; 91162306a36Sopenharmony_ci u16 central_freq = chan->freq; 91262306a36Sopenharmony_ci u8 central_ch = chan->channel; 91362306a36Sopenharmony_ci u8 band = chan->band_type; 91462306a36Sopenharmony_ci u8 subband = chan->subband_type; 91562306a36Sopenharmony_ci bool is_2g = band == RTW89_BAND_2G; 91662306a36Sopenharmony_ci u8 chan_idx; 91762306a36Sopenharmony_ci 91862306a36Sopenharmony_ci if (!central_freq) { 91962306a36Sopenharmony_ci rtw89_warn(rtwdev, "Invalid central_freq\n"); 92062306a36Sopenharmony_ci return; 92162306a36Sopenharmony_ci } 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci if (phy_idx == RTW89_PHY_0) { 92462306a36Sopenharmony_ci /* Path A */ 92562306a36Sopenharmony_ci rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_A); 92662306a36Sopenharmony_ci rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_A); 92762306a36Sopenharmony_ci 92862306a36Sopenharmony_ci if (is_2g) 92962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PATH0_BAND_SEL_V1, 93062306a36Sopenharmony_ci B_PATH0_BAND_SEL_MSK_V1, 1, 93162306a36Sopenharmony_ci phy_idx); 93262306a36Sopenharmony_ci else 93362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PATH0_BAND_SEL_V1, 93462306a36Sopenharmony_ci B_PATH0_BAND_SEL_MSK_V1, 0, 93562306a36Sopenharmony_ci phy_idx); 93662306a36Sopenharmony_ci /* Path B */ 93762306a36Sopenharmony_ci if (!rtwdev->dbcc_en) { 93862306a36Sopenharmony_ci rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B); 93962306a36Sopenharmony_ci rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_B); 94062306a36Sopenharmony_ci 94162306a36Sopenharmony_ci if (is_2g) 94262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, 94362306a36Sopenharmony_ci R_PATH1_BAND_SEL_V1, 94462306a36Sopenharmony_ci B_PATH1_BAND_SEL_MSK_V1, 94562306a36Sopenharmony_ci 1, phy_idx); 94662306a36Sopenharmony_ci else 94762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, 94862306a36Sopenharmony_ci R_PATH1_BAND_SEL_V1, 94962306a36Sopenharmony_ci B_PATH1_BAND_SEL_MSK_V1, 95062306a36Sopenharmony_ci 0, phy_idx); 95162306a36Sopenharmony_ci rtw89_phy_write32_clr(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 95262306a36Sopenharmony_ci } else { 95362306a36Sopenharmony_ci if (is_2g) 95462306a36Sopenharmony_ci rtw89_phy_write32_clr(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 95562306a36Sopenharmony_ci else 95662306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 95762306a36Sopenharmony_ci } 95862306a36Sopenharmony_ci /* SCO compensate FC setting */ 95962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_V1, B_FC0_MSK_V1, 96062306a36Sopenharmony_ci central_freq, phy_idx); 96162306a36Sopenharmony_ci /* round_up((1/fc0)*pow(2,18)) */ 96262306a36Sopenharmony_ci sco = DIV_ROUND_CLOSEST(1 << 18, central_freq); 96362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_INV, sco, 96462306a36Sopenharmony_ci phy_idx); 96562306a36Sopenharmony_ci } else { 96662306a36Sopenharmony_ci /* Path B */ 96762306a36Sopenharmony_ci rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B); 96862306a36Sopenharmony_ci rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_B); 96962306a36Sopenharmony_ci 97062306a36Sopenharmony_ci if (is_2g) 97162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PATH1_BAND_SEL_V1, 97262306a36Sopenharmony_ci B_PATH1_BAND_SEL_MSK_V1, 97362306a36Sopenharmony_ci 1, phy_idx); 97462306a36Sopenharmony_ci else 97562306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PATH1_BAND_SEL_V1, 97662306a36Sopenharmony_ci B_PATH1_BAND_SEL_MSK_V1, 97762306a36Sopenharmony_ci 0, phy_idx); 97862306a36Sopenharmony_ci /* SCO compensate FC setting */ 97962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_V1, B_FC0_MSK_V1, 98062306a36Sopenharmony_ci central_freq, phy_idx); 98162306a36Sopenharmony_ci /* round_up((1/fc0)*pow(2,18)) */ 98262306a36Sopenharmony_ci sco = DIV_ROUND_CLOSEST(1 << 18, central_freq); 98362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_INV, sco, 98462306a36Sopenharmony_ci phy_idx); 98562306a36Sopenharmony_ci } 98662306a36Sopenharmony_ci /* CCK parameters */ 98762306a36Sopenharmony_ci if (band == RTW89_BAND_2G) { 98862306a36Sopenharmony_ci if (central_ch == 14) { 98962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF0_V1, 99062306a36Sopenharmony_ci B_PCOEFF01_MSK_V1, 0x3b13ff); 99162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF2_V1, 99262306a36Sopenharmony_ci B_PCOEFF23_MSK_V1, 0x1c42de); 99362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF4_V1, 99462306a36Sopenharmony_ci B_PCOEFF45_MSK_V1, 0xfdb0ad); 99562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF6_V1, 99662306a36Sopenharmony_ci B_PCOEFF67_MSK_V1, 0xf60f6e); 99762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF8_V1, 99862306a36Sopenharmony_ci B_PCOEFF89_MSK_V1, 0xfd8f92); 99962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFA_V1, 100062306a36Sopenharmony_ci B_PCOEFFAB_MSK_V1, 0x2d011); 100162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFC_V1, 100262306a36Sopenharmony_ci B_PCOEFFCD_MSK_V1, 0x1c02c); 100362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFE_V1, 100462306a36Sopenharmony_ci B_PCOEFFEF_MSK_V1, 0xfff00a); 100562306a36Sopenharmony_ci } else { 100662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF0_V1, 100762306a36Sopenharmony_ci B_PCOEFF01_MSK_V1, 0x3d23ff); 100862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF2_V1, 100962306a36Sopenharmony_ci B_PCOEFF23_MSK_V1, 0x29b354); 101062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF4_V1, 101162306a36Sopenharmony_ci B_PCOEFF45_MSK_V1, 0xfc1c8); 101262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF6_V1, 101362306a36Sopenharmony_ci B_PCOEFF67_MSK_V1, 0xfdb053); 101462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFF8_V1, 101562306a36Sopenharmony_ci B_PCOEFF89_MSK_V1, 0xf86f9a); 101662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFA_V1, 101762306a36Sopenharmony_ci B_PCOEFFAB_MSK_V1, 0xfaef92); 101862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFC_V1, 101962306a36Sopenharmony_ci B_PCOEFFCD_MSK_V1, 0xfe5fcc); 102062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PCOEFFE_V1, 102162306a36Sopenharmony_ci B_PCOEFFEF_MSK_V1, 0xffdff5); 102262306a36Sopenharmony_ci } 102362306a36Sopenharmony_ci } 102462306a36Sopenharmony_ci 102562306a36Sopenharmony_ci chan_idx = rtw89_encode_chan_idx(rtwdev, chan->primary_channel, band); 102662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_MAC_PIN_SEL, B_CH_IDX_SEG0, chan_idx, phy_idx); 102762306a36Sopenharmony_ci} 102862306a36Sopenharmony_ci 102962306a36Sopenharmony_cistatic void rtw8852c_bw_setting(struct rtw89_dev *rtwdev, u8 bw, u8 path) 103062306a36Sopenharmony_ci{ 103162306a36Sopenharmony_ci static const u32 adc_sel[2] = {0xC0EC, 0xC1EC}; 103262306a36Sopenharmony_ci static const u32 wbadc_sel[2] = {0xC0E4, 0xC1E4}; 103362306a36Sopenharmony_ci 103462306a36Sopenharmony_ci switch (bw) { 103562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_5: 103662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x1); 103762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x0); 103862306a36Sopenharmony_ci break; 103962306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_10: 104062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x2); 104162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x1); 104262306a36Sopenharmony_ci break; 104362306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_20: 104462306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_40: 104562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_80: 104662306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_160: 104762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x0); 104862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x2); 104962306a36Sopenharmony_ci break; 105062306a36Sopenharmony_ci default: 105162306a36Sopenharmony_ci rtw89_warn(rtwdev, "Fail to set ADC\n"); 105262306a36Sopenharmony_ci } 105362306a36Sopenharmony_ci} 105462306a36Sopenharmony_ci 105562306a36Sopenharmony_cistatic void rtw8852c_edcca_per20_bitmap_sifs(struct rtw89_dev *rtwdev, u8 bw, 105662306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 105762306a36Sopenharmony_ci{ 105862306a36Sopenharmony_ci if (bw == RTW89_CHANNEL_WIDTH_20) { 105962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A1, B_SNDCCA_A1_EN, 0xff, phy_idx); 106062306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A2, B_SNDCCA_A2_VAL, 0, phy_idx); 106162306a36Sopenharmony_ci } else { 106262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A1, B_SNDCCA_A1_EN, 0, phy_idx); 106362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A2, B_SNDCCA_A2_VAL, 0, phy_idx); 106462306a36Sopenharmony_ci } 106562306a36Sopenharmony_ci} 106662306a36Sopenharmony_ci 106762306a36Sopenharmony_cistatic void 106862306a36Sopenharmony_cirtw8852c_ctrl_bw(struct rtw89_dev *rtwdev, u8 pri_ch, u8 bw, 106962306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 107062306a36Sopenharmony_ci{ 107162306a36Sopenharmony_ci u8 mod_sbw = 0; 107262306a36Sopenharmony_ci 107362306a36Sopenharmony_ci switch (bw) { 107462306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_5: 107562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_10: 107662306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_20: 107762306a36Sopenharmony_ci if (bw == RTW89_CHANNEL_WIDTH_5) 107862306a36Sopenharmony_ci mod_sbw = 0x1; 107962306a36Sopenharmony_ci else if (bw == RTW89_CHANNEL_WIDTH_10) 108062306a36Sopenharmony_ci mod_sbw = 0x2; 108162306a36Sopenharmony_ci else if (bw == RTW89_CHANNEL_WIDTH_20) 108262306a36Sopenharmony_ci mod_sbw = 0x0; 108362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x0, 108462306a36Sopenharmony_ci phy_idx); 108562306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 108662306a36Sopenharmony_ci mod_sbw, phy_idx); 108762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 0x0, 108862306a36Sopenharmony_ci phy_idx); 108962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 109062306a36Sopenharmony_ci B_PATH0_SAMPL_DLY_T_MSK_V1, 0x3); 109162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 109262306a36Sopenharmony_ci B_PATH1_SAMPL_DLY_T_MSK_V1, 0x3); 109362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 109462306a36Sopenharmony_ci B_PATH0_BW_SEL_MSK_V1, 0xf); 109562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 109662306a36Sopenharmony_ci B_PATH1_BW_SEL_MSK_V1, 0xf); 109762306a36Sopenharmony_ci break; 109862306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_40: 109962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x1, 110062306a36Sopenharmony_ci phy_idx); 110162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 110262306a36Sopenharmony_ci phy_idx); 110362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 110462306a36Sopenharmony_ci pri_ch, 110562306a36Sopenharmony_ci phy_idx); 110662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 110762306a36Sopenharmony_ci B_PATH0_SAMPL_DLY_T_MSK_V1, 0x3); 110862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 110962306a36Sopenharmony_ci B_PATH1_SAMPL_DLY_T_MSK_V1, 0x3); 111062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 111162306a36Sopenharmony_ci B_PATH0_BW_SEL_MSK_V1, 0xf); 111262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 111362306a36Sopenharmony_ci B_PATH1_BW_SEL_MSK_V1, 0xf); 111462306a36Sopenharmony_ci break; 111562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_80: 111662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x2, 111762306a36Sopenharmony_ci phy_idx); 111862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 111962306a36Sopenharmony_ci phy_idx); 112062306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 112162306a36Sopenharmony_ci pri_ch, 112262306a36Sopenharmony_ci phy_idx); 112362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 112462306a36Sopenharmony_ci B_PATH0_SAMPL_DLY_T_MSK_V1, 0x2); 112562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 112662306a36Sopenharmony_ci B_PATH1_SAMPL_DLY_T_MSK_V1, 0x2); 112762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 112862306a36Sopenharmony_ci B_PATH0_BW_SEL_MSK_V1, 0xd); 112962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 113062306a36Sopenharmony_ci B_PATH1_BW_SEL_MSK_V1, 0xd); 113162306a36Sopenharmony_ci break; 113262306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_160: 113362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x3, 113462306a36Sopenharmony_ci phy_idx); 113562306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 113662306a36Sopenharmony_ci phy_idx); 113762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 113862306a36Sopenharmony_ci pri_ch, 113962306a36Sopenharmony_ci phy_idx); 114062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 114162306a36Sopenharmony_ci B_PATH0_SAMPL_DLY_T_MSK_V1, 0x1); 114262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 114362306a36Sopenharmony_ci B_PATH1_SAMPL_DLY_T_MSK_V1, 0x1); 114462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 114562306a36Sopenharmony_ci B_PATH0_BW_SEL_MSK_V1, 0xb); 114662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 114762306a36Sopenharmony_ci B_PATH1_BW_SEL_MSK_V1, 0xb); 114862306a36Sopenharmony_ci break; 114962306a36Sopenharmony_ci default: 115062306a36Sopenharmony_ci rtw89_warn(rtwdev, "Fail to switch bw (bw:%d, pri ch:%d)\n", bw, 115162306a36Sopenharmony_ci pri_ch); 115262306a36Sopenharmony_ci } 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_ci if (bw == RTW89_CHANNEL_WIDTH_40) { 115562306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RX_BW40_2XFFT_EN_V1, 115662306a36Sopenharmony_ci B_RX_BW40_2XFFT_EN_MSK_V1, 0x1, phy_idx); 115762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_T2F_GI_COMB, B_T2F_GI_COMB_EN, 1, phy_idx); 115862306a36Sopenharmony_ci } else { 115962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RX_BW40_2XFFT_EN_V1, 116062306a36Sopenharmony_ci B_RX_BW40_2XFFT_EN_MSK_V1, 0x0, phy_idx); 116162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_T2F_GI_COMB, B_T2F_GI_COMB_EN, 0, phy_idx); 116262306a36Sopenharmony_ci } 116362306a36Sopenharmony_ci 116462306a36Sopenharmony_ci if (phy_idx == RTW89_PHY_0) { 116562306a36Sopenharmony_ci rtw8852c_bw_setting(rtwdev, bw, RF_PATH_A); 116662306a36Sopenharmony_ci if (!rtwdev->dbcc_en) 116762306a36Sopenharmony_ci rtw8852c_bw_setting(rtwdev, bw, RF_PATH_B); 116862306a36Sopenharmony_ci } else { 116962306a36Sopenharmony_ci rtw8852c_bw_setting(rtwdev, bw, RF_PATH_B); 117062306a36Sopenharmony_ci } 117162306a36Sopenharmony_ci 117262306a36Sopenharmony_ci rtw8852c_edcca_per20_bitmap_sifs(rtwdev, bw, phy_idx); 117362306a36Sopenharmony_ci} 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_cistatic u32 rtw8852c_spur_freq(struct rtw89_dev *rtwdev, 117662306a36Sopenharmony_ci const struct rtw89_chan *chan) 117762306a36Sopenharmony_ci{ 117862306a36Sopenharmony_ci u8 center_chan = chan->channel; 117962306a36Sopenharmony_ci u8 bw = chan->band_width; 118062306a36Sopenharmony_ci 118162306a36Sopenharmony_ci switch (chan->band_type) { 118262306a36Sopenharmony_ci case RTW89_BAND_2G: 118362306a36Sopenharmony_ci if (bw == RTW89_CHANNEL_WIDTH_20) { 118462306a36Sopenharmony_ci if (center_chan >= 5 && center_chan <= 8) 118562306a36Sopenharmony_ci return 2440; 118662306a36Sopenharmony_ci if (center_chan == 13) 118762306a36Sopenharmony_ci return 2480; 118862306a36Sopenharmony_ci } else if (bw == RTW89_CHANNEL_WIDTH_40) { 118962306a36Sopenharmony_ci if (center_chan >= 3 && center_chan <= 10) 119062306a36Sopenharmony_ci return 2440; 119162306a36Sopenharmony_ci } 119262306a36Sopenharmony_ci break; 119362306a36Sopenharmony_ci case RTW89_BAND_5G: 119462306a36Sopenharmony_ci if (center_chan == 151 || center_chan == 153 || 119562306a36Sopenharmony_ci center_chan == 155 || center_chan == 163) 119662306a36Sopenharmony_ci return 5760; 119762306a36Sopenharmony_ci break; 119862306a36Sopenharmony_ci case RTW89_BAND_6G: 119962306a36Sopenharmony_ci if (center_chan == 195 || center_chan == 197 || 120062306a36Sopenharmony_ci center_chan == 199 || center_chan == 207) 120162306a36Sopenharmony_ci return 6920; 120262306a36Sopenharmony_ci break; 120362306a36Sopenharmony_ci default: 120462306a36Sopenharmony_ci break; 120562306a36Sopenharmony_ci } 120662306a36Sopenharmony_ci 120762306a36Sopenharmony_ci return 0; 120862306a36Sopenharmony_ci} 120962306a36Sopenharmony_ci 121062306a36Sopenharmony_ci#define CARRIER_SPACING_312_5 312500 /* 312.5 kHz */ 121162306a36Sopenharmony_ci#define CARRIER_SPACING_78_125 78125 /* 78.125 kHz */ 121262306a36Sopenharmony_ci#define MAX_TONE_NUM 2048 121362306a36Sopenharmony_ci 121462306a36Sopenharmony_cistatic void rtw8852c_set_csi_tone_idx(struct rtw89_dev *rtwdev, 121562306a36Sopenharmony_ci const struct rtw89_chan *chan, 121662306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 121762306a36Sopenharmony_ci{ 121862306a36Sopenharmony_ci u32 spur_freq; 121962306a36Sopenharmony_ci s32 freq_diff, csi_idx, csi_tone_idx; 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_ci spur_freq = rtw8852c_spur_freq(rtwdev, chan); 122262306a36Sopenharmony_ci if (spur_freq == 0) { 122362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SEG0CSI_EN, B_SEG0CSI_EN, 0, phy_idx); 122462306a36Sopenharmony_ci return; 122562306a36Sopenharmony_ci } 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_ci freq_diff = (spur_freq - chan->freq) * 1000000; 122862306a36Sopenharmony_ci csi_idx = s32_div_u32_round_closest(freq_diff, CARRIER_SPACING_78_125); 122962306a36Sopenharmony_ci s32_div_u32_round_down(csi_idx, MAX_TONE_NUM, &csi_tone_idx); 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SEG0CSI, B_SEG0CSI_IDX, csi_tone_idx, phy_idx); 123262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_SEG0CSI_EN, B_SEG0CSI_EN, 1, phy_idx); 123362306a36Sopenharmony_ci} 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_cistatic const struct rtw89_nbi_reg_def rtw8852c_nbi_reg_def[] = { 123662306a36Sopenharmony_ci [RF_PATH_A] = { 123762306a36Sopenharmony_ci .notch1_idx = {0x4C14, 0xFF}, 123862306a36Sopenharmony_ci .notch1_frac_idx = {0x4C14, 0xC00}, 123962306a36Sopenharmony_ci .notch1_en = {0x4C14, 0x1000}, 124062306a36Sopenharmony_ci .notch2_idx = {0x4C20, 0xFF}, 124162306a36Sopenharmony_ci .notch2_frac_idx = {0x4C20, 0xC00}, 124262306a36Sopenharmony_ci .notch2_en = {0x4C20, 0x1000}, 124362306a36Sopenharmony_ci }, 124462306a36Sopenharmony_ci [RF_PATH_B] = { 124562306a36Sopenharmony_ci .notch1_idx = {0x4CD8, 0xFF}, 124662306a36Sopenharmony_ci .notch1_frac_idx = {0x4CD8, 0xC00}, 124762306a36Sopenharmony_ci .notch1_en = {0x4CD8, 0x1000}, 124862306a36Sopenharmony_ci .notch2_idx = {0x4CE4, 0xFF}, 124962306a36Sopenharmony_ci .notch2_frac_idx = {0x4CE4, 0xC00}, 125062306a36Sopenharmony_ci .notch2_en = {0x4CE4, 0x1000}, 125162306a36Sopenharmony_ci }, 125262306a36Sopenharmony_ci}; 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_cistatic void rtw8852c_set_nbi_tone_idx(struct rtw89_dev *rtwdev, 125562306a36Sopenharmony_ci const struct rtw89_chan *chan, 125662306a36Sopenharmony_ci enum rtw89_rf_path path) 125762306a36Sopenharmony_ci{ 125862306a36Sopenharmony_ci const struct rtw89_nbi_reg_def *nbi = &rtw8852c_nbi_reg_def[path]; 125962306a36Sopenharmony_ci u32 spur_freq, fc; 126062306a36Sopenharmony_ci s32 freq_diff; 126162306a36Sopenharmony_ci s32 nbi_idx, nbi_tone_idx; 126262306a36Sopenharmony_ci s32 nbi_frac_idx, nbi_frac_tone_idx; 126362306a36Sopenharmony_ci bool notch2_chk = false; 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_ci spur_freq = rtw8852c_spur_freq(rtwdev, chan); 126662306a36Sopenharmony_ci if (spur_freq == 0) { 126762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 126862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 126962306a36Sopenharmony_ci return; 127062306a36Sopenharmony_ci } 127162306a36Sopenharmony_ci 127262306a36Sopenharmony_ci fc = chan->freq; 127362306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_160) { 127462306a36Sopenharmony_ci fc = (spur_freq > fc) ? fc + 40 : fc - 40; 127562306a36Sopenharmony_ci if ((fc > spur_freq && 127662306a36Sopenharmony_ci chan->channel < chan->primary_channel) || 127762306a36Sopenharmony_ci (fc < spur_freq && 127862306a36Sopenharmony_ci chan->channel > chan->primary_channel)) 127962306a36Sopenharmony_ci notch2_chk = true; 128062306a36Sopenharmony_ci } 128162306a36Sopenharmony_ci 128262306a36Sopenharmony_ci freq_diff = (spur_freq - fc) * 1000000; 128362306a36Sopenharmony_ci nbi_idx = s32_div_u32_round_down(freq_diff, CARRIER_SPACING_312_5, &nbi_frac_idx); 128462306a36Sopenharmony_ci 128562306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_20) { 128662306a36Sopenharmony_ci s32_div_u32_round_down(nbi_idx + 32, 64, &nbi_tone_idx); 128762306a36Sopenharmony_ci } else { 128862306a36Sopenharmony_ci u16 tone_para = (chan->band_width == RTW89_CHANNEL_WIDTH_40) ? 128962306a36Sopenharmony_ci 128 : 256; 129062306a36Sopenharmony_ci 129162306a36Sopenharmony_ci s32_div_u32_round_down(nbi_idx, tone_para, &nbi_tone_idx); 129262306a36Sopenharmony_ci } 129362306a36Sopenharmony_ci nbi_frac_tone_idx = s32_div_u32_round_closest(nbi_frac_idx, CARRIER_SPACING_78_125); 129462306a36Sopenharmony_ci 129562306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && notch2_chk) { 129662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch2_idx.addr, 129762306a36Sopenharmony_ci nbi->notch2_idx.mask, nbi_tone_idx); 129862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch2_frac_idx.addr, 129962306a36Sopenharmony_ci nbi->notch2_frac_idx.mask, nbi_frac_tone_idx); 130062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 0); 130162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 1); 130262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 130362306a36Sopenharmony_ci } else { 130462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_idx.addr, 130562306a36Sopenharmony_ci nbi->notch1_idx.mask, nbi_tone_idx); 130662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_frac_idx.addr, 130762306a36Sopenharmony_ci nbi->notch1_frac_idx.mask, nbi_frac_tone_idx); 130862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 130962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 1); 131062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 0); 131162306a36Sopenharmony_ci } 131262306a36Sopenharmony_ci} 131362306a36Sopenharmony_ci 131462306a36Sopenharmony_cistatic void rtw8852c_spur_notch(struct rtw89_dev *rtwdev, u32 val, 131562306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 131662306a36Sopenharmony_ci{ 131762306a36Sopenharmony_ci u32 notch; 131862306a36Sopenharmony_ci u32 notch2; 131962306a36Sopenharmony_ci 132062306a36Sopenharmony_ci if (phy_idx == RTW89_PHY_0) { 132162306a36Sopenharmony_ci notch = R_PATH0_NOTCH; 132262306a36Sopenharmony_ci notch2 = R_PATH0_NOTCH2; 132362306a36Sopenharmony_ci } else { 132462306a36Sopenharmony_ci notch = R_PATH1_NOTCH; 132562306a36Sopenharmony_ci notch2 = R_PATH1_NOTCH2; 132662306a36Sopenharmony_ci } 132762306a36Sopenharmony_ci 132862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, notch, 132962306a36Sopenharmony_ci B_PATH0_NOTCH_VAL | B_PATH0_NOTCH_EN, val); 133062306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, notch, B_PATH0_NOTCH_EN); 133162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, notch2, 133262306a36Sopenharmony_ci B_PATH0_NOTCH2_VAL | B_PATH0_NOTCH2_EN, val); 133362306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, notch2, B_PATH0_NOTCH2_EN); 133462306a36Sopenharmony_ci} 133562306a36Sopenharmony_ci 133662306a36Sopenharmony_cistatic void rtw8852c_spur_elimination(struct rtw89_dev *rtwdev, 133762306a36Sopenharmony_ci const struct rtw89_chan *chan, 133862306a36Sopenharmony_ci u8 pri_ch_idx, 133962306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 134062306a36Sopenharmony_ci{ 134162306a36Sopenharmony_ci rtw8852c_set_csi_tone_idx(rtwdev, chan, phy_idx); 134262306a36Sopenharmony_ci 134362306a36Sopenharmony_ci if (phy_idx == RTW89_PHY_0) { 134462306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && 134562306a36Sopenharmony_ci (pri_ch_idx == RTW89_SC_20_LOWER || 134662306a36Sopenharmony_ci pri_ch_idx == RTW89_SC_20_UP3X)) { 134762306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_0); 134862306a36Sopenharmony_ci if (!rtwdev->dbcc_en) 134962306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_1); 135062306a36Sopenharmony_ci } else if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && 135162306a36Sopenharmony_ci (pri_ch_idx == RTW89_SC_20_UPPER || 135262306a36Sopenharmony_ci pri_ch_idx == RTW89_SC_20_LOW3X)) { 135362306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_0); 135462306a36Sopenharmony_ci if (!rtwdev->dbcc_en) 135562306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_1); 135662306a36Sopenharmony_ci } else { 135762306a36Sopenharmony_ci rtw8852c_set_nbi_tone_idx(rtwdev, chan, RF_PATH_A); 135862306a36Sopenharmony_ci if (!rtwdev->dbcc_en) 135962306a36Sopenharmony_ci rtw8852c_set_nbi_tone_idx(rtwdev, chan, 136062306a36Sopenharmony_ci RF_PATH_B); 136162306a36Sopenharmony_ci } 136262306a36Sopenharmony_ci } else { 136362306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && 136462306a36Sopenharmony_ci (pri_ch_idx == RTW89_SC_20_LOWER || 136562306a36Sopenharmony_ci pri_ch_idx == RTW89_SC_20_UP3X)) { 136662306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_1); 136762306a36Sopenharmony_ci } else if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && 136862306a36Sopenharmony_ci (pri_ch_idx == RTW89_SC_20_UPPER || 136962306a36Sopenharmony_ci pri_ch_idx == RTW89_SC_20_LOW3X)) { 137062306a36Sopenharmony_ci rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_1); 137162306a36Sopenharmony_ci } else { 137262306a36Sopenharmony_ci rtw8852c_set_nbi_tone_idx(rtwdev, chan, RF_PATH_B); 137362306a36Sopenharmony_ci } 137462306a36Sopenharmony_ci } 137562306a36Sopenharmony_ci 137662306a36Sopenharmony_ci if (pri_ch_idx == RTW89_SC_20_UP3X || pri_ch_idx == RTW89_SC_20_LOW3X) 137762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PD_BOOST_EN, B_PD_BOOST_EN, 0, phy_idx); 137862306a36Sopenharmony_ci else 137962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PD_BOOST_EN, B_PD_BOOST_EN, 1, phy_idx); 138062306a36Sopenharmony_ci} 138162306a36Sopenharmony_ci 138262306a36Sopenharmony_cistatic void rtw8852c_5m_mask(struct rtw89_dev *rtwdev, 138362306a36Sopenharmony_ci const struct rtw89_chan *chan, 138462306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 138562306a36Sopenharmony_ci{ 138662306a36Sopenharmony_ci u8 pri_ch = chan->pri_ch_idx; 138762306a36Sopenharmony_ci bool mask_5m_low; 138862306a36Sopenharmony_ci bool mask_5m_en; 138962306a36Sopenharmony_ci 139062306a36Sopenharmony_ci switch (chan->band_width) { 139162306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_40: 139262306a36Sopenharmony_ci mask_5m_en = true; 139362306a36Sopenharmony_ci mask_5m_low = pri_ch == RTW89_SC_20_LOWER; 139462306a36Sopenharmony_ci break; 139562306a36Sopenharmony_ci case RTW89_CHANNEL_WIDTH_80: 139662306a36Sopenharmony_ci mask_5m_en = pri_ch == RTW89_SC_20_UPMOST || 139762306a36Sopenharmony_ci pri_ch == RTW89_SC_20_LOWEST; 139862306a36Sopenharmony_ci mask_5m_low = pri_ch == RTW89_SC_20_LOWEST; 139962306a36Sopenharmony_ci break; 140062306a36Sopenharmony_ci default: 140162306a36Sopenharmony_ci mask_5m_en = false; 140262306a36Sopenharmony_ci mask_5m_low = false; 140362306a36Sopenharmony_ci break; 140462306a36Sopenharmony_ci } 140562306a36Sopenharmony_ci 140662306a36Sopenharmony_ci if (!mask_5m_en) { 140762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x0); 140862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x0); 140962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_ASSIGN_SBD_OPT, 141062306a36Sopenharmony_ci B_ASSIGN_SBD_OPT_EN, 0x0, phy_idx); 141162306a36Sopenharmony_ci } else { 141262306a36Sopenharmony_ci if (mask_5m_low) { 141362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_TH, 0x4); 141462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x1); 141562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB2, 0x0); 141662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB0, 0x1); 141762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_TH, 0x4); 141862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x1); 141962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB2, 0x0); 142062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB0, 0x1); 142162306a36Sopenharmony_ci } else { 142262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_TH, 0x4); 142362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x1); 142462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB2, 0x1); 142562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB0, 0x0); 142662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_TH, 0x4); 142762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x1); 142862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB2, 0x1); 142962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB0, 0x0); 143062306a36Sopenharmony_ci } 143162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_ASSIGN_SBD_OPT, B_ASSIGN_SBD_OPT_EN, 0x1, phy_idx); 143262306a36Sopenharmony_ci } 143362306a36Sopenharmony_ci} 143462306a36Sopenharmony_ci 143562306a36Sopenharmony_cistatic void rtw8852c_bb_reset_all(struct rtw89_dev *rtwdev, 143662306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 143762306a36Sopenharmony_ci{ 143862306a36Sopenharmony_ci /*HW SI reset*/ 143962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_S0_HW_SI_DIS, B_S0_HW_SI_DIS_W_R_TRIG, 144062306a36Sopenharmony_ci 0x7); 144162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_S1_HW_SI_DIS, B_S1_HW_SI_DIS_W_R_TRIG, 144262306a36Sopenharmony_ci 0x7); 144362306a36Sopenharmony_ci 144462306a36Sopenharmony_ci udelay(1); 144562306a36Sopenharmony_ci 144662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 144762306a36Sopenharmony_ci phy_idx); 144862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 0, 144962306a36Sopenharmony_ci phy_idx); 145062306a36Sopenharmony_ci /*HW SI reset*/ 145162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_S0_HW_SI_DIS, B_S0_HW_SI_DIS_W_R_TRIG, 145262306a36Sopenharmony_ci 0x0); 145362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_S1_HW_SI_DIS, B_S1_HW_SI_DIS_W_R_TRIG, 145462306a36Sopenharmony_ci 0x0); 145562306a36Sopenharmony_ci 145662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 145762306a36Sopenharmony_ci phy_idx); 145862306a36Sopenharmony_ci} 145962306a36Sopenharmony_ci 146062306a36Sopenharmony_cistatic void rtw8852c_bb_reset_en(struct rtw89_dev *rtwdev, enum rtw89_band band, 146162306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx, bool en) 146262306a36Sopenharmony_ci{ 146362306a36Sopenharmony_ci if (en) { 146462306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_S0_HW_SI_DIS, 146562306a36Sopenharmony_ci B_S0_HW_SI_DIS_W_R_TRIG, 0x0, phy_idx); 146662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_S1_HW_SI_DIS, 146762306a36Sopenharmony_ci B_S1_HW_SI_DIS_W_R_TRIG, 0x0, phy_idx); 146862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 146962306a36Sopenharmony_ci phy_idx); 147062306a36Sopenharmony_ci if (band == RTW89_BAND_2G) 147162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0x0); 147262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PD_CTRL, B_PD_HIT_DIS, 0x0); 147362306a36Sopenharmony_ci } else { 147462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0x1); 147562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PD_CTRL, B_PD_HIT_DIS, 0x1); 147662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_S0_HW_SI_DIS, 147762306a36Sopenharmony_ci B_S0_HW_SI_DIS_W_R_TRIG, 0x7, phy_idx); 147862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_S1_HW_SI_DIS, 147962306a36Sopenharmony_ci B_S1_HW_SI_DIS_W_R_TRIG, 0x7, phy_idx); 148062306a36Sopenharmony_ci fsleep(1); 148162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 0, 148262306a36Sopenharmony_ci phy_idx); 148362306a36Sopenharmony_ci } 148462306a36Sopenharmony_ci} 148562306a36Sopenharmony_ci 148662306a36Sopenharmony_cistatic void rtw8852c_bb_reset(struct rtw89_dev *rtwdev, 148762306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 148862306a36Sopenharmony_ci{ 148962306a36Sopenharmony_ci rtw8852c_bb_reset_all(rtwdev, phy_idx); 149062306a36Sopenharmony_ci} 149162306a36Sopenharmony_ci 149262306a36Sopenharmony_cistatic 149362306a36Sopenharmony_civoid rtw8852c_bb_gpio_trsw(struct rtw89_dev *rtwdev, enum rtw89_rf_path path, 149462306a36Sopenharmony_ci u8 tx_path_en, u8 trsw_tx, 149562306a36Sopenharmony_ci u8 trsw_rx, u8 trsw, u8 trsw_b) 149662306a36Sopenharmony_ci{ 149762306a36Sopenharmony_ci static const u32 path_cr_bases[] = {0x5868, 0x7868}; 149862306a36Sopenharmony_ci u32 mask_ofst = 16; 149962306a36Sopenharmony_ci u32 cr; 150062306a36Sopenharmony_ci u32 val; 150162306a36Sopenharmony_ci 150262306a36Sopenharmony_ci if (path >= ARRAY_SIZE(path_cr_bases)) 150362306a36Sopenharmony_ci return; 150462306a36Sopenharmony_ci 150562306a36Sopenharmony_ci cr = path_cr_bases[path]; 150662306a36Sopenharmony_ci 150762306a36Sopenharmony_ci mask_ofst += (tx_path_en * 4 + trsw_tx * 2 + trsw_rx) * 2; 150862306a36Sopenharmony_ci val = FIELD_PREP(B_P0_TRSW_A, trsw) | FIELD_PREP(B_P0_TRSW_B, trsw_b); 150962306a36Sopenharmony_ci 151062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, cr, (B_P0_TRSW_A | B_P0_TRSW_B) << mask_ofst, val); 151162306a36Sopenharmony_ci} 151262306a36Sopenharmony_ci 151362306a36Sopenharmony_cienum rtw8852c_rfe_src { 151462306a36Sopenharmony_ci PAPE_RFM, 151562306a36Sopenharmony_ci TRSW_RFM, 151662306a36Sopenharmony_ci LNAON_RFM, 151762306a36Sopenharmony_ci}; 151862306a36Sopenharmony_ci 151962306a36Sopenharmony_cistatic 152062306a36Sopenharmony_civoid rtw8852c_bb_gpio_rfm(struct rtw89_dev *rtwdev, enum rtw89_rf_path path, 152162306a36Sopenharmony_ci enum rtw8852c_rfe_src src, u8 dis_tx_gnt_wl, 152262306a36Sopenharmony_ci u8 active_tx_opt, u8 act_bt_en, u8 rfm_output_val) 152362306a36Sopenharmony_ci{ 152462306a36Sopenharmony_ci static const u32 path_cr_bases[] = {0x5894, 0x7894}; 152562306a36Sopenharmony_ci static const u32 masks[] = {0, 8, 16}; 152662306a36Sopenharmony_ci u32 mask, mask_ofst; 152762306a36Sopenharmony_ci u32 cr; 152862306a36Sopenharmony_ci u32 val; 152962306a36Sopenharmony_ci 153062306a36Sopenharmony_ci if (src >= ARRAY_SIZE(masks) || path >= ARRAY_SIZE(path_cr_bases)) 153162306a36Sopenharmony_ci return; 153262306a36Sopenharmony_ci 153362306a36Sopenharmony_ci mask_ofst = masks[src]; 153462306a36Sopenharmony_ci cr = path_cr_bases[path]; 153562306a36Sopenharmony_ci 153662306a36Sopenharmony_ci val = FIELD_PREP(B_P0_RFM_DIS_WL, dis_tx_gnt_wl) | 153762306a36Sopenharmony_ci FIELD_PREP(B_P0_RFM_TX_OPT, active_tx_opt) | 153862306a36Sopenharmony_ci FIELD_PREP(B_P0_RFM_BT_EN, act_bt_en) | 153962306a36Sopenharmony_ci FIELD_PREP(B_P0_RFM_OUT, rfm_output_val); 154062306a36Sopenharmony_ci mask = 0xff << mask_ofst; 154162306a36Sopenharmony_ci 154262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, cr, mask, val); 154362306a36Sopenharmony_ci} 154462306a36Sopenharmony_ci 154562306a36Sopenharmony_cistatic void rtw8852c_bb_gpio_init(struct rtw89_dev *rtwdev) 154662306a36Sopenharmony_ci{ 154762306a36Sopenharmony_ci static const u32 cr_bases[] = {0x5800, 0x7800}; 154862306a36Sopenharmony_ci u32 addr; 154962306a36Sopenharmony_ci u8 i; 155062306a36Sopenharmony_ci 155162306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(cr_bases); i++) { 155262306a36Sopenharmony_ci addr = cr_bases[i]; 155362306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, (addr | 0x68), B_P0_TRSW_A); 155462306a36Sopenharmony_ci rtw89_phy_write32_clr(rtwdev, (addr | 0x68), B_P0_TRSW_X); 155562306a36Sopenharmony_ci rtw89_phy_write32_clr(rtwdev, (addr | 0x68), B_P0_TRSW_SO_A2); 155662306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, (addr | 0x80), 0x77777777); 155762306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, (addr | 0x84), 0x77777777); 155862306a36Sopenharmony_ci } 155962306a36Sopenharmony_ci 156062306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, R_RFE_E_A2, 0xffffffff); 156162306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, R_RFE_O_SEL_A2, 0); 156262306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, R_RFE_SEL0_A2, 0); 156362306a36Sopenharmony_ci rtw89_phy_write32(rtwdev, R_RFE_SEL32_A2, 0); 156462306a36Sopenharmony_ci 156562306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 0, 0, 0, 1); 156662306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 0, 1, 1, 0); 156762306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 1, 0, 1, 0); 156862306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 1, 1, 1, 0); 156962306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 0, 0, 0, 1); 157062306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 0, 1, 1, 0); 157162306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 1, 0, 1, 0); 157262306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 1, 1, 1, 0); 157362306a36Sopenharmony_ci 157462306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 0, 0, 0, 1); 157562306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 0, 1, 1, 0); 157662306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 1, 0, 1, 0); 157762306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 1, 1, 1, 0); 157862306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 0, 0, 0, 1); 157962306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 0, 1, 1, 0); 158062306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 1, 0, 1, 0); 158162306a36Sopenharmony_ci rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 1, 1, 1, 0); 158262306a36Sopenharmony_ci 158362306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, PAPE_RFM, 0, 0, 0, 0x0); 158462306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, TRSW_RFM, 0, 0, 0, 0x4); 158562306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, LNAON_RFM, 0, 0, 0, 0x8); 158662306a36Sopenharmony_ci 158762306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, PAPE_RFM, 0, 0, 0, 0x0); 158862306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, TRSW_RFM, 0, 0, 0, 0x4); 158962306a36Sopenharmony_ci rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, LNAON_RFM, 0, 0, 0, 0x8); 159062306a36Sopenharmony_ci} 159162306a36Sopenharmony_ci 159262306a36Sopenharmony_cistatic void rtw8852c_bb_macid_ctrl_init(struct rtw89_dev *rtwdev, 159362306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 159462306a36Sopenharmony_ci{ 159562306a36Sopenharmony_ci u32 addr; 159662306a36Sopenharmony_ci 159762306a36Sopenharmony_ci for (addr = R_AX_PWR_MACID_LMT_TABLE0; 159862306a36Sopenharmony_ci addr <= R_AX_PWR_MACID_LMT_TABLE127; addr += 4) 159962306a36Sopenharmony_ci rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, 0); 160062306a36Sopenharmony_ci} 160162306a36Sopenharmony_ci 160262306a36Sopenharmony_cistatic void rtw8852c_bb_sethw(struct rtw89_dev *rtwdev) 160362306a36Sopenharmony_ci{ 160462306a36Sopenharmony_ci struct rtw89_phy_efuse_gain *gain = &rtwdev->efuse_gain; 160562306a36Sopenharmony_ci 160662306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, R_DBCC_80P80_SEL_EVM_RPT, 160762306a36Sopenharmony_ci B_DBCC_80P80_SEL_EVM_RPT_EN); 160862306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, R_DBCC_80P80_SEL_EVM_RPT2, 160962306a36Sopenharmony_ci B_DBCC_80P80_SEL_EVM_RPT2_EN); 161062306a36Sopenharmony_ci 161162306a36Sopenharmony_ci rtw8852c_bb_macid_ctrl_init(rtwdev, RTW89_PHY_0); 161262306a36Sopenharmony_ci rtw8852c_bb_gpio_init(rtwdev); 161362306a36Sopenharmony_ci 161462306a36Sopenharmony_ci /* read these registers after loading BB parameters */ 161562306a36Sopenharmony_ci gain->offset_base[RTW89_PHY_0] = 161662306a36Sopenharmony_ci rtw89_phy_read32_mask(rtwdev, R_RPL_BIAS_COMP, B_RPL_BIAS_COMP_MASK); 161762306a36Sopenharmony_ci gain->offset_base[RTW89_PHY_1] = 161862306a36Sopenharmony_ci rtw89_phy_read32_mask(rtwdev, R_RPL_BIAS_COMP1, B_RPL_BIAS_COMP1_MASK); 161962306a36Sopenharmony_ci} 162062306a36Sopenharmony_ci 162162306a36Sopenharmony_cistatic void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev, 162262306a36Sopenharmony_ci const struct rtw89_chan *chan, 162362306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 162462306a36Sopenharmony_ci{ 162562306a36Sopenharmony_ci static const u32 ru_alloc_msk[2] = {B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY0, 162662306a36Sopenharmony_ci B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY1}; 162762306a36Sopenharmony_ci struct rtw89_hal *hal = &rtwdev->hal; 162862306a36Sopenharmony_ci bool cck_en = chan->band_type == RTW89_BAND_2G; 162962306a36Sopenharmony_ci u8 pri_ch_idx = chan->pri_ch_idx; 163062306a36Sopenharmony_ci u32 mask, reg; 163162306a36Sopenharmony_ci u8 ntx_path; 163262306a36Sopenharmony_ci 163362306a36Sopenharmony_ci if (chan->band_type == RTW89_BAND_2G) 163462306a36Sopenharmony_ci rtw8852c_ctrl_sco_cck(rtwdev, chan->channel, 163562306a36Sopenharmony_ci chan->primary_channel, 163662306a36Sopenharmony_ci chan->band_width); 163762306a36Sopenharmony_ci 163862306a36Sopenharmony_ci rtw8852c_ctrl_ch(rtwdev, chan, phy_idx); 163962306a36Sopenharmony_ci rtw8852c_ctrl_bw(rtwdev, pri_ch_idx, chan->band_width, phy_idx); 164062306a36Sopenharmony_ci if (cck_en) { 164162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_UPD_CLK_ADC, B_ENABLE_CCK, 1); 164262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0); 164362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PD_ARBITER_OFF, 164462306a36Sopenharmony_ci B_PD_ARBITER_OFF, 0x0, phy_idx); 164562306a36Sopenharmony_ci } else { 164662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_UPD_CLK_ADC, B_ENABLE_CCK, 0); 164762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 1); 164862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_PD_ARBITER_OFF, 164962306a36Sopenharmony_ci B_PD_ARBITER_OFF, 0x1, phy_idx); 165062306a36Sopenharmony_ci } 165162306a36Sopenharmony_ci 165262306a36Sopenharmony_ci rtw8852c_spur_elimination(rtwdev, chan, pri_ch_idx, phy_idx); 165362306a36Sopenharmony_ci rtw8852c_ctrl_btg(rtwdev, chan->band_type == RTW89_BAND_2G); 165462306a36Sopenharmony_ci rtw8852c_5m_mask(rtwdev, chan, phy_idx); 165562306a36Sopenharmony_ci 165662306a36Sopenharmony_ci if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && 165762306a36Sopenharmony_ci rtwdev->hal.cv != CHIP_CAV) { 165862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_P80_AT_HIGH_FREQ, 165962306a36Sopenharmony_ci B_P80_AT_HIGH_FREQ, 0x0, phy_idx); 166062306a36Sopenharmony_ci reg = rtw89_mac_reg_by_idx(rtwdev, R_P80_AT_HIGH_FREQ_BB_WRP, phy_idx); 166162306a36Sopenharmony_ci if (chan->primary_channel > chan->channel) { 166262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, 166362306a36Sopenharmony_ci R_P80_AT_HIGH_FREQ_RU_ALLOC, 166462306a36Sopenharmony_ci ru_alloc_msk[phy_idx], 1); 166562306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, reg, 166662306a36Sopenharmony_ci B_P80_AT_HIGH_FREQ_BB_WRP, 1); 166762306a36Sopenharmony_ci } else { 166862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, 166962306a36Sopenharmony_ci R_P80_AT_HIGH_FREQ_RU_ALLOC, 167062306a36Sopenharmony_ci ru_alloc_msk[phy_idx], 0); 167162306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, reg, 167262306a36Sopenharmony_ci B_P80_AT_HIGH_FREQ_BB_WRP, 0); 167362306a36Sopenharmony_ci } 167462306a36Sopenharmony_ci } 167562306a36Sopenharmony_ci 167662306a36Sopenharmony_ci if (chan->band_type == RTW89_BAND_6G && 167762306a36Sopenharmony_ci chan->band_width == RTW89_CHANNEL_WIDTH_160) 167862306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CDD_EVM_CHK_EN, 167962306a36Sopenharmony_ci B_CDD_EVM_CHK_EN, 0, phy_idx); 168062306a36Sopenharmony_ci else 168162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CDD_EVM_CHK_EN, 168262306a36Sopenharmony_ci B_CDD_EVM_CHK_EN, 1, phy_idx); 168362306a36Sopenharmony_ci 168462306a36Sopenharmony_ci if (!rtwdev->dbcc_en) { 168562306a36Sopenharmony_ci mask = B_P0_TXPW_RSTB_TSSI | B_P0_TXPW_RSTB_MANON; 168662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x1); 168762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x3); 168862306a36Sopenharmony_ci mask = B_P1_TXPW_RSTB_TSSI | B_P1_TXPW_RSTB_MANON; 168962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x1); 169062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x3); 169162306a36Sopenharmony_ci } else { 169262306a36Sopenharmony_ci if (phy_idx == RTW89_PHY_0) { 169362306a36Sopenharmony_ci mask = B_P0_TXPW_RSTB_TSSI | B_P0_TXPW_RSTB_MANON; 169462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x1); 169562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x3); 169662306a36Sopenharmony_ci } else { 169762306a36Sopenharmony_ci mask = B_P1_TXPW_RSTB_TSSI | B_P1_TXPW_RSTB_MANON; 169862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x1); 169962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x3); 170062306a36Sopenharmony_ci } 170162306a36Sopenharmony_ci } 170262306a36Sopenharmony_ci 170362306a36Sopenharmony_ci if (chan->band_type == RTW89_BAND_6G) 170462306a36Sopenharmony_ci rtw89_phy_write32_set(rtwdev, R_MUIC, B_MUIC_EN); 170562306a36Sopenharmony_ci else 170662306a36Sopenharmony_ci rtw89_phy_write32_clr(rtwdev, R_MUIC, B_MUIC_EN); 170762306a36Sopenharmony_ci 170862306a36Sopenharmony_ci if (hal->antenna_tx) 170962306a36Sopenharmony_ci ntx_path = hal->antenna_tx; 171062306a36Sopenharmony_ci else 171162306a36Sopenharmony_ci ntx_path = chan->band_type == RTW89_BAND_6G ? RF_B : RF_AB; 171262306a36Sopenharmony_ci 171362306a36Sopenharmony_ci rtw8852c_ctrl_tx_path_tmac(rtwdev, ntx_path, (enum rtw89_mac_idx)phy_idx); 171462306a36Sopenharmony_ci 171562306a36Sopenharmony_ci rtw8852c_bb_reset_all(rtwdev, phy_idx); 171662306a36Sopenharmony_ci} 171762306a36Sopenharmony_ci 171862306a36Sopenharmony_cistatic void rtw8852c_set_channel(struct rtw89_dev *rtwdev, 171962306a36Sopenharmony_ci const struct rtw89_chan *chan, 172062306a36Sopenharmony_ci enum rtw89_mac_idx mac_idx, 172162306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 172262306a36Sopenharmony_ci{ 172362306a36Sopenharmony_ci rtw8852c_set_channel_mac(rtwdev, chan, mac_idx); 172462306a36Sopenharmony_ci rtw8852c_set_channel_bb(rtwdev, chan, phy_idx); 172562306a36Sopenharmony_ci rtw8852c_set_channel_rf(rtwdev, chan, phy_idx); 172662306a36Sopenharmony_ci} 172762306a36Sopenharmony_ci 172862306a36Sopenharmony_cistatic void rtw8852c_dfs_en(struct rtw89_dev *rtwdev, bool en) 172962306a36Sopenharmony_ci{ 173062306a36Sopenharmony_ci if (en) 173162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_UPD_P0, B_UPD_P0_EN, 1); 173262306a36Sopenharmony_ci else 173362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_UPD_P0, B_UPD_P0_EN, 0); 173462306a36Sopenharmony_ci} 173562306a36Sopenharmony_ci 173662306a36Sopenharmony_cistatic void rtw8852c_adc_en(struct rtw89_dev *rtwdev, bool en) 173762306a36Sopenharmony_ci{ 173862306a36Sopenharmony_ci if (en) 173962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_ADC_FIFO, B_ADC_FIFO_RST, 174062306a36Sopenharmony_ci 0x0); 174162306a36Sopenharmony_ci else 174262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_ADC_FIFO, B_ADC_FIFO_RST, 174362306a36Sopenharmony_ci 0xf); 174462306a36Sopenharmony_ci} 174562306a36Sopenharmony_ci 174662306a36Sopenharmony_cistatic void rtw8852c_set_channel_help(struct rtw89_dev *rtwdev, bool enter, 174762306a36Sopenharmony_ci struct rtw89_channel_help_params *p, 174862306a36Sopenharmony_ci const struct rtw89_chan *chan, 174962306a36Sopenharmony_ci enum rtw89_mac_idx mac_idx, 175062306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 175162306a36Sopenharmony_ci{ 175262306a36Sopenharmony_ci if (enter) { 175362306a36Sopenharmony_ci rtw89_chip_stop_sch_tx(rtwdev, mac_idx, &p->tx_en, 175462306a36Sopenharmony_ci RTW89_SCH_TX_SEL_ALL); 175562306a36Sopenharmony_ci rtw89_mac_cfg_ppdu_status(rtwdev, mac_idx, false); 175662306a36Sopenharmony_ci rtw8852c_dfs_en(rtwdev, false); 175762306a36Sopenharmony_ci rtw8852c_tssi_cont_en_phyidx(rtwdev, false, phy_idx); 175862306a36Sopenharmony_ci rtw8852c_adc_en(rtwdev, false); 175962306a36Sopenharmony_ci fsleep(40); 176062306a36Sopenharmony_ci rtw8852c_bb_reset_en(rtwdev, chan->band_type, phy_idx, false); 176162306a36Sopenharmony_ci } else { 176262306a36Sopenharmony_ci rtw89_mac_cfg_ppdu_status(rtwdev, mac_idx, true); 176362306a36Sopenharmony_ci rtw8852c_adc_en(rtwdev, true); 176462306a36Sopenharmony_ci rtw8852c_dfs_en(rtwdev, true); 176562306a36Sopenharmony_ci rtw8852c_tssi_cont_en_phyidx(rtwdev, true, phy_idx); 176662306a36Sopenharmony_ci rtw8852c_bb_reset_en(rtwdev, chan->band_type, phy_idx, true); 176762306a36Sopenharmony_ci rtw89_chip_resume_sch_tx(rtwdev, mac_idx, p->tx_en); 176862306a36Sopenharmony_ci } 176962306a36Sopenharmony_ci} 177062306a36Sopenharmony_ci 177162306a36Sopenharmony_cistatic void rtw8852c_rfk_init(struct rtw89_dev *rtwdev) 177262306a36Sopenharmony_ci{ 177362306a36Sopenharmony_ci struct rtw89_rfk_mcc_info *rfk_mcc = &rtwdev->rfk_mcc; 177462306a36Sopenharmony_ci 177562306a36Sopenharmony_ci rtwdev->is_tssi_mode[RF_PATH_A] = false; 177662306a36Sopenharmony_ci rtwdev->is_tssi_mode[RF_PATH_B] = false; 177762306a36Sopenharmony_ci memset(rfk_mcc, 0, sizeof(*rfk_mcc)); 177862306a36Sopenharmony_ci rtw8852c_lck_init(rtwdev); 177962306a36Sopenharmony_ci 178062306a36Sopenharmony_ci rtw8852c_rck(rtwdev); 178162306a36Sopenharmony_ci rtw8852c_dack(rtwdev); 178262306a36Sopenharmony_ci rtw8852c_rx_dck(rtwdev, RTW89_PHY_0, false); 178362306a36Sopenharmony_ci} 178462306a36Sopenharmony_ci 178562306a36Sopenharmony_cistatic void rtw8852c_rfk_channel(struct rtw89_dev *rtwdev) 178662306a36Sopenharmony_ci{ 178762306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx = RTW89_PHY_0; 178862306a36Sopenharmony_ci 178962306a36Sopenharmony_ci rtw8852c_mcc_get_ch_info(rtwdev, phy_idx); 179062306a36Sopenharmony_ci rtw8852c_rx_dck(rtwdev, phy_idx, false); 179162306a36Sopenharmony_ci rtw8852c_iqk(rtwdev, phy_idx); 179262306a36Sopenharmony_ci rtw8852c_tssi(rtwdev, phy_idx); 179362306a36Sopenharmony_ci rtw8852c_dpk(rtwdev, phy_idx); 179462306a36Sopenharmony_ci rtw89_fw_h2c_rf_ntfy_mcc(rtwdev); 179562306a36Sopenharmony_ci} 179662306a36Sopenharmony_ci 179762306a36Sopenharmony_cistatic void rtw8852c_rfk_band_changed(struct rtw89_dev *rtwdev, 179862306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 179962306a36Sopenharmony_ci{ 180062306a36Sopenharmony_ci rtw8852c_tssi_scan(rtwdev, phy_idx); 180162306a36Sopenharmony_ci} 180262306a36Sopenharmony_ci 180362306a36Sopenharmony_cistatic void rtw8852c_rfk_scan(struct rtw89_dev *rtwdev, bool start) 180462306a36Sopenharmony_ci{ 180562306a36Sopenharmony_ci rtw8852c_wifi_scan_notify(rtwdev, start, RTW89_PHY_0); 180662306a36Sopenharmony_ci} 180762306a36Sopenharmony_ci 180862306a36Sopenharmony_cistatic void rtw8852c_rfk_track(struct rtw89_dev *rtwdev) 180962306a36Sopenharmony_ci{ 181062306a36Sopenharmony_ci rtw8852c_dpk_track(rtwdev); 181162306a36Sopenharmony_ci rtw8852c_lck_track(rtwdev); 181262306a36Sopenharmony_ci rtw8852c_rx_dck_track(rtwdev); 181362306a36Sopenharmony_ci} 181462306a36Sopenharmony_ci 181562306a36Sopenharmony_cistatic u32 rtw8852c_bb_cal_txpwr_ref(struct rtw89_dev *rtwdev, 181662306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx, s16 ref) 181762306a36Sopenharmony_ci{ 181862306a36Sopenharmony_ci s8 ofst_int = 0; 181962306a36Sopenharmony_ci u8 base_cw_0db = 0x27; 182062306a36Sopenharmony_ci u16 tssi_16dbm_cw = 0x12c; 182162306a36Sopenharmony_ci s16 pwr_s10_3 = 0; 182262306a36Sopenharmony_ci s16 rf_pwr_cw = 0; 182362306a36Sopenharmony_ci u16 bb_pwr_cw = 0; 182462306a36Sopenharmony_ci u32 pwr_cw = 0; 182562306a36Sopenharmony_ci u32 tssi_ofst_cw = 0; 182662306a36Sopenharmony_ci 182762306a36Sopenharmony_ci pwr_s10_3 = (ref << 1) + (s16)(ofst_int) + (s16)(base_cw_0db << 3); 182862306a36Sopenharmony_ci bb_pwr_cw = FIELD_GET(GENMASK(2, 0), pwr_s10_3); 182962306a36Sopenharmony_ci rf_pwr_cw = FIELD_GET(GENMASK(8, 3), pwr_s10_3); 183062306a36Sopenharmony_ci rf_pwr_cw = clamp_t(s16, rf_pwr_cw, 15, 63); 183162306a36Sopenharmony_ci pwr_cw = (rf_pwr_cw << 3) | bb_pwr_cw; 183262306a36Sopenharmony_ci 183362306a36Sopenharmony_ci tssi_ofst_cw = (u32)((s16)tssi_16dbm_cw + (ref << 1) - (16 << 3)); 183462306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 183562306a36Sopenharmony_ci "[TXPWR] tssi_ofst_cw=%d rf_cw=0x%x bb_cw=0x%x\n", 183662306a36Sopenharmony_ci tssi_ofst_cw, rf_pwr_cw, bb_pwr_cw); 183762306a36Sopenharmony_ci 183862306a36Sopenharmony_ci return (tssi_ofst_cw << 18) | (pwr_cw << 9) | (ref & GENMASK(8, 0)); 183962306a36Sopenharmony_ci} 184062306a36Sopenharmony_ci 184162306a36Sopenharmony_cistatic 184262306a36Sopenharmony_civoid rtw8852c_set_txpwr_ul_tb_offset(struct rtw89_dev *rtwdev, 184362306a36Sopenharmony_ci s8 pw_ofst, enum rtw89_mac_idx mac_idx) 184462306a36Sopenharmony_ci{ 184562306a36Sopenharmony_ci s8 pw_ofst_2tx; 184662306a36Sopenharmony_ci s8 val_1t; 184762306a36Sopenharmony_ci s8 val_2t; 184862306a36Sopenharmony_ci u32 reg; 184962306a36Sopenharmony_ci u8 i; 185062306a36Sopenharmony_ci 185162306a36Sopenharmony_ci if (pw_ofst < -32 || pw_ofst > 31) { 185262306a36Sopenharmony_ci rtw89_warn(rtwdev, "[ULTB] Err pwr_offset=%d\n", pw_ofst); 185362306a36Sopenharmony_ci return; 185462306a36Sopenharmony_ci } 185562306a36Sopenharmony_ci val_1t = pw_ofst << 2; 185662306a36Sopenharmony_ci pw_ofst_2tx = max(pw_ofst - 3, -32); 185762306a36Sopenharmony_ci val_2t = pw_ofst_2tx << 2; 185862306a36Sopenharmony_ci 185962306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[ULTB] val_1tx=0x%x\n", val_1t); 186062306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[ULTB] val_2tx=0x%x\n", val_2t); 186162306a36Sopenharmony_ci 186262306a36Sopenharmony_ci for (i = 0; i < 4; i++) { 186362306a36Sopenharmony_ci /* 1TX */ 186462306a36Sopenharmony_ci reg = rtw89_mac_reg_by_idx(rtwdev, R_AX_PWR_UL_TB_1T, mac_idx); 186562306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, reg, 186662306a36Sopenharmony_ci B_AX_PWR_UL_TB_1T_V1_MASK << (8 * i), 186762306a36Sopenharmony_ci val_1t); 186862306a36Sopenharmony_ci /* 2TX */ 186962306a36Sopenharmony_ci reg = rtw89_mac_reg_by_idx(rtwdev, R_AX_PWR_UL_TB_2T, mac_idx); 187062306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, reg, 187162306a36Sopenharmony_ci B_AX_PWR_UL_TB_2T_V1_MASK << (8 * i), 187262306a36Sopenharmony_ci val_2t); 187362306a36Sopenharmony_ci } 187462306a36Sopenharmony_ci} 187562306a36Sopenharmony_ci 187662306a36Sopenharmony_cistatic void rtw8852c_set_txpwr_ref(struct rtw89_dev *rtwdev, 187762306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 187862306a36Sopenharmony_ci{ 187962306a36Sopenharmony_ci static const u32 addr[RF_PATH_NUM_8852C] = {0x5800, 0x7800}; 188062306a36Sopenharmony_ci const u32 mask = 0x7FFFFFF; 188162306a36Sopenharmony_ci const u8 ofst_ofdm = 0x4; 188262306a36Sopenharmony_ci const u8 ofst_cck = 0x8; 188362306a36Sopenharmony_ci s16 ref_ofdm = 0; 188462306a36Sopenharmony_ci s16 ref_cck = 0; 188562306a36Sopenharmony_ci u32 val; 188662306a36Sopenharmony_ci u8 i; 188762306a36Sopenharmony_ci 188862306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set txpwr reference\n"); 188962306a36Sopenharmony_ci 189062306a36Sopenharmony_ci rtw89_mac_txpwr_write32_mask(rtwdev, phy_idx, R_AX_PWR_RATE_CTRL, 189162306a36Sopenharmony_ci GENMASK(27, 10), 0x0); 189262306a36Sopenharmony_ci 189362306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set bb ofdm txpwr ref\n"); 189462306a36Sopenharmony_ci val = rtw8852c_bb_cal_txpwr_ref(rtwdev, phy_idx, ref_ofdm); 189562306a36Sopenharmony_ci 189662306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) 189762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, addr[i] + ofst_ofdm, mask, val, 189862306a36Sopenharmony_ci phy_idx); 189962306a36Sopenharmony_ci 190062306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set bb cck txpwr ref\n"); 190162306a36Sopenharmony_ci val = rtw8852c_bb_cal_txpwr_ref(rtwdev, phy_idx, ref_cck); 190262306a36Sopenharmony_ci 190362306a36Sopenharmony_ci for (i = 0; i < RF_PATH_NUM_8852C; i++) 190462306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, addr[i] + ofst_cck, mask, val, 190562306a36Sopenharmony_ci phy_idx); 190662306a36Sopenharmony_ci} 190762306a36Sopenharmony_ci 190862306a36Sopenharmony_cistatic void rtw8852c_bb_set_tx_shape_dfir(struct rtw89_dev *rtwdev, 190962306a36Sopenharmony_ci const struct rtw89_chan *chan, 191062306a36Sopenharmony_ci u8 tx_shape_idx, 191162306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 191262306a36Sopenharmony_ci{ 191362306a36Sopenharmony_ci#define __DFIR_CFG_MASK 0xffffff 191462306a36Sopenharmony_ci#define __DFIR_CFG_NR 8 191562306a36Sopenharmony_ci#define __DECL_DFIR_VAR(_prefix, _name, _val...) \ 191662306a36Sopenharmony_ci static const u32 _prefix ## _ ## _name[] = {_val}; \ 191762306a36Sopenharmony_ci static_assert(ARRAY_SIZE(_prefix ## _ ## _name) == __DFIR_CFG_NR) 191862306a36Sopenharmony_ci#define __DECL_DFIR_PARAM(_name, _val...) __DECL_DFIR_VAR(param, _name, _val) 191962306a36Sopenharmony_ci#define __DECL_DFIR_ADDR(_name, _val...) __DECL_DFIR_VAR(addr, _name, _val) 192062306a36Sopenharmony_ci 192162306a36Sopenharmony_ci __DECL_DFIR_PARAM(flat, 192262306a36Sopenharmony_ci 0x003D23FF, 0x0029B354, 0x000FC1C8, 0x00FDB053, 192362306a36Sopenharmony_ci 0x00F86F9A, 0x00FAEF92, 0x00FE5FCC, 0x00FFDFF5); 192462306a36Sopenharmony_ci __DECL_DFIR_PARAM(sharp, 192562306a36Sopenharmony_ci 0x003D83FF, 0x002C636A, 0x0013F204, 0x00008090, 192662306a36Sopenharmony_ci 0x00F87FB0, 0x00F99F83, 0x00FDBFBA, 0x00003FF5); 192762306a36Sopenharmony_ci __DECL_DFIR_PARAM(sharp_14, 192862306a36Sopenharmony_ci 0x003B13FF, 0x001C42DE, 0x00FDB0AD, 0x00F60F6E, 192962306a36Sopenharmony_ci 0x00FD8F92, 0x0002D011, 0x0001C02C, 0x00FFF00A); 193062306a36Sopenharmony_ci __DECL_DFIR_ADDR(filter, 193162306a36Sopenharmony_ci 0x45BC, 0x45CC, 0x45D0, 0x45D4, 0x45D8, 0x45C0, 193262306a36Sopenharmony_ci 0x45C4, 0x45C8); 193362306a36Sopenharmony_ci u8 ch = chan->channel; 193462306a36Sopenharmony_ci const u32 *param; 193562306a36Sopenharmony_ci int i; 193662306a36Sopenharmony_ci 193762306a36Sopenharmony_ci if (ch > 14) { 193862306a36Sopenharmony_ci rtw89_warn(rtwdev, 193962306a36Sopenharmony_ci "set tx shape dfir by unknown ch: %d on 2G\n", ch); 194062306a36Sopenharmony_ci return; 194162306a36Sopenharmony_ci } 194262306a36Sopenharmony_ci 194362306a36Sopenharmony_ci if (ch == 14) 194462306a36Sopenharmony_ci param = param_sharp_14; 194562306a36Sopenharmony_ci else 194662306a36Sopenharmony_ci param = tx_shape_idx == 0 ? param_flat : param_sharp; 194762306a36Sopenharmony_ci 194862306a36Sopenharmony_ci for (i = 0; i < __DFIR_CFG_NR; i++) { 194962306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 195062306a36Sopenharmony_ci "set tx shape dfir: 0x%x: 0x%x\n", addr_filter[i], 195162306a36Sopenharmony_ci param[i]); 195262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, addr_filter[i], __DFIR_CFG_MASK, 195362306a36Sopenharmony_ci param[i], phy_idx); 195462306a36Sopenharmony_ci } 195562306a36Sopenharmony_ci 195662306a36Sopenharmony_ci#undef __DECL_DFIR_ADDR 195762306a36Sopenharmony_ci#undef __DECL_DFIR_PARAM 195862306a36Sopenharmony_ci#undef __DECL_DFIR_VAR 195962306a36Sopenharmony_ci#undef __DFIR_CFG_NR 196062306a36Sopenharmony_ci#undef __DFIR_CFG_MASK 196162306a36Sopenharmony_ci} 196262306a36Sopenharmony_ci 196362306a36Sopenharmony_cistatic void rtw8852c_set_tx_shape(struct rtw89_dev *rtwdev, 196462306a36Sopenharmony_ci const struct rtw89_chan *chan, 196562306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 196662306a36Sopenharmony_ci{ 196762306a36Sopenharmony_ci u8 band = chan->band_type; 196862306a36Sopenharmony_ci u8 regd = rtw89_regd_get(rtwdev, band); 196962306a36Sopenharmony_ci u8 tx_shape_cck = rtw89_8852c_tx_shape[band][RTW89_RS_CCK][regd]; 197062306a36Sopenharmony_ci u8 tx_shape_ofdm = rtw89_8852c_tx_shape[band][RTW89_RS_OFDM][regd]; 197162306a36Sopenharmony_ci 197262306a36Sopenharmony_ci if (band == RTW89_BAND_2G) 197362306a36Sopenharmony_ci rtw8852c_bb_set_tx_shape_dfir(rtwdev, chan, tx_shape_cck, phy_idx); 197462306a36Sopenharmony_ci 197562306a36Sopenharmony_ci rtw89_phy_tssi_ctrl_set_bandedge_cfg(rtwdev, 197662306a36Sopenharmony_ci (enum rtw89_mac_idx)phy_idx, 197762306a36Sopenharmony_ci tx_shape_ofdm); 197862306a36Sopenharmony_ci} 197962306a36Sopenharmony_ci 198062306a36Sopenharmony_cistatic void rtw8852c_set_txpwr(struct rtw89_dev *rtwdev, 198162306a36Sopenharmony_ci const struct rtw89_chan *chan, 198262306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 198362306a36Sopenharmony_ci{ 198462306a36Sopenharmony_ci rtw89_phy_set_txpwr_byrate(rtwdev, chan, phy_idx); 198562306a36Sopenharmony_ci rtw89_phy_set_txpwr_offset(rtwdev, chan, phy_idx); 198662306a36Sopenharmony_ci rtw8852c_set_tx_shape(rtwdev, chan, phy_idx); 198762306a36Sopenharmony_ci rtw89_phy_set_txpwr_limit(rtwdev, chan, phy_idx); 198862306a36Sopenharmony_ci rtw89_phy_set_txpwr_limit_ru(rtwdev, chan, phy_idx); 198962306a36Sopenharmony_ci} 199062306a36Sopenharmony_ci 199162306a36Sopenharmony_cistatic void rtw8852c_set_txpwr_ctrl(struct rtw89_dev *rtwdev, 199262306a36Sopenharmony_ci enum rtw89_phy_idx phy_idx) 199362306a36Sopenharmony_ci{ 199462306a36Sopenharmony_ci rtw8852c_set_txpwr_ref(rtwdev, phy_idx); 199562306a36Sopenharmony_ci} 199662306a36Sopenharmony_ci 199762306a36Sopenharmony_cistatic void 199862306a36Sopenharmony_cirtw8852c_init_tssi_ctrl(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx) 199962306a36Sopenharmony_ci{ 200062306a36Sopenharmony_ci static const struct rtw89_reg2_def ctrl_ini[] = { 200162306a36Sopenharmony_ci {0xD938, 0x00010100}, 200262306a36Sopenharmony_ci {0xD93C, 0x0500D500}, 200362306a36Sopenharmony_ci {0xD940, 0x00000500}, 200462306a36Sopenharmony_ci {0xD944, 0x00000005}, 200562306a36Sopenharmony_ci {0xD94C, 0x00220000}, 200662306a36Sopenharmony_ci {0xD950, 0x00030000}, 200762306a36Sopenharmony_ci }; 200862306a36Sopenharmony_ci u32 addr; 200962306a36Sopenharmony_ci int i; 201062306a36Sopenharmony_ci 201162306a36Sopenharmony_ci for (addr = R_AX_TSSI_CTRL_HEAD; addr <= R_AX_TSSI_CTRL_TAIL; addr += 4) 201262306a36Sopenharmony_ci rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, 0); 201362306a36Sopenharmony_ci 201462306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(ctrl_ini); i++) 201562306a36Sopenharmony_ci rtw89_mac_txpwr_write32(rtwdev, phy_idx, ctrl_ini[i].addr, 201662306a36Sopenharmony_ci ctrl_ini[i].data); 201762306a36Sopenharmony_ci 201862306a36Sopenharmony_ci rtw89_phy_tssi_ctrl_set_bandedge_cfg(rtwdev, 201962306a36Sopenharmony_ci (enum rtw89_mac_idx)phy_idx, 202062306a36Sopenharmony_ci RTW89_TSSI_BANDEDGE_FLAT); 202162306a36Sopenharmony_ci} 202262306a36Sopenharmony_ci 202362306a36Sopenharmony_cistatic int 202462306a36Sopenharmony_cirtw8852c_init_txpwr_unit(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx) 202562306a36Sopenharmony_ci{ 202662306a36Sopenharmony_ci int ret; 202762306a36Sopenharmony_ci 202862306a36Sopenharmony_ci ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_UL_CTRL2, 0x07763333); 202962306a36Sopenharmony_ci if (ret) 203062306a36Sopenharmony_ci return ret; 203162306a36Sopenharmony_ci 203262306a36Sopenharmony_ci ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_COEXT_CTRL, 0x01ebf000); 203362306a36Sopenharmony_ci if (ret) 203462306a36Sopenharmony_ci return ret; 203562306a36Sopenharmony_ci 203662306a36Sopenharmony_ci ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_UL_CTRL0, 0x0002f8ff); 203762306a36Sopenharmony_ci if (ret) 203862306a36Sopenharmony_ci return ret; 203962306a36Sopenharmony_ci 204062306a36Sopenharmony_ci rtw8852c_set_txpwr_ul_tb_offset(rtwdev, 0, phy_idx == RTW89_PHY_1 ? 204162306a36Sopenharmony_ci RTW89_MAC_1 : 204262306a36Sopenharmony_ci RTW89_MAC_0); 204362306a36Sopenharmony_ci rtw8852c_init_tssi_ctrl(rtwdev, phy_idx); 204462306a36Sopenharmony_ci 204562306a36Sopenharmony_ci return 0; 204662306a36Sopenharmony_ci} 204762306a36Sopenharmony_ci 204862306a36Sopenharmony_cistatic void rtw8852c_bb_cfg_rx_path(struct rtw89_dev *rtwdev, u8 rx_path) 204962306a36Sopenharmony_ci{ 205062306a36Sopenharmony_ci const struct rtw89_chan *chan = rtw89_chan_get(rtwdev, RTW89_SUB_ENTITY_0); 205162306a36Sopenharmony_ci u8 band = chan->band_type; 205262306a36Sopenharmony_ci u32 rst_mask0 = B_P0_TXPW_RSTB_MANON | B_P0_TXPW_RSTB_TSSI; 205362306a36Sopenharmony_ci u32 rst_mask1 = B_P1_TXPW_RSTB_MANON | B_P1_TXPW_RSTB_TSSI; 205462306a36Sopenharmony_ci 205562306a36Sopenharmony_ci if (rtwdev->dbcc_en) { 205662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_ANT_RX_SEG0, 1); 205762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_ANT_RX_SEG0, 2, 205862306a36Sopenharmony_ci RTW89_PHY_1); 205962306a36Sopenharmony_ci 206062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG0, 206162306a36Sopenharmony_ci 1); 206262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG1, 206362306a36Sopenharmony_ci 1); 206462306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG0, 2, 206562306a36Sopenharmony_ci RTW89_PHY_1); 206662306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG1, 2, 206762306a36Sopenharmony_ci RTW89_PHY_1); 206862306a36Sopenharmony_ci 206962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 207062306a36Sopenharmony_ci B_RXHT_MCS_LIMIT, 0); 207162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 207262306a36Sopenharmony_ci B_RXVHT_MCS_LIMIT, 0); 207362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_USER_MAX, 8); 207462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0); 207562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0); 207662306a36Sopenharmony_ci 207762306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RXHT_MCS_LIMIT, 207862306a36Sopenharmony_ci B_RXHT_MCS_LIMIT, 0, RTW89_PHY_1); 207962306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RXVHT_MCS_LIMIT, 208062306a36Sopenharmony_ci B_RXVHT_MCS_LIMIT, 0, RTW89_PHY_1); 208162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHE_USER_MAX, 1, 208262306a36Sopenharmony_ci RTW89_PHY_1); 208362306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0, 208462306a36Sopenharmony_ci RTW89_PHY_1); 208562306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0, 208662306a36Sopenharmony_ci RTW89_PHY_1); 208762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, rst_mask0, 1); 208862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, rst_mask0, 3); 208962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, rst_mask1, 1); 209062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, rst_mask1, 3); 209162306a36Sopenharmony_ci } else { 209262306a36Sopenharmony_ci if (rx_path == RF_PATH_A) { 209362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 209462306a36Sopenharmony_ci B_ANT_RX_SEG0, 1); 209562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 209662306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG0, 1); 209762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 209862306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG1, 1); 209962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 210062306a36Sopenharmony_ci B_RXHT_MCS_LIMIT, 0); 210162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 210262306a36Sopenharmony_ci B_RXVHT_MCS_LIMIT, 0); 210362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 210462306a36Sopenharmony_ci 0); 210562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 210662306a36Sopenharmony_ci 0); 210762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 210862306a36Sopenharmony_ci rst_mask0, 1); 210962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 211062306a36Sopenharmony_ci rst_mask0, 3); 211162306a36Sopenharmony_ci } else if (rx_path == RF_PATH_B) { 211262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 211362306a36Sopenharmony_ci B_ANT_RX_SEG0, 2); 211462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 211562306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG0, 2); 211662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 211762306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG1, 2); 211862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 211962306a36Sopenharmony_ci B_RXHT_MCS_LIMIT, 0); 212062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 212162306a36Sopenharmony_ci B_RXVHT_MCS_LIMIT, 0); 212262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 212362306a36Sopenharmony_ci 0); 212462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 212562306a36Sopenharmony_ci 0); 212662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 212762306a36Sopenharmony_ci rst_mask1, 1); 212862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 212962306a36Sopenharmony_ci rst_mask1, 3); 213062306a36Sopenharmony_ci } else { 213162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 213262306a36Sopenharmony_ci B_ANT_RX_SEG0, 3); 213362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 213462306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG0, 3); 213562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 213662306a36Sopenharmony_ci B_ANT_RX_1RCCA_SEG1, 3); 213762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 213862306a36Sopenharmony_ci B_RXHT_MCS_LIMIT, 1); 213962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 214062306a36Sopenharmony_ci B_RXVHT_MCS_LIMIT, 1); 214162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 214262306a36Sopenharmony_ci 1); 214362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 214462306a36Sopenharmony_ci 1); 214562306a36Sopenharmony_ci rtw8852c_ctrl_btg(rtwdev, band == RTW89_BAND_2G); 214662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 214762306a36Sopenharmony_ci rst_mask0, 1); 214862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 214962306a36Sopenharmony_ci rst_mask0, 3); 215062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 215162306a36Sopenharmony_ci rst_mask1, 1); 215262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 215362306a36Sopenharmony_ci rst_mask1, 3); 215462306a36Sopenharmony_ci } 215562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_USER_MAX, 8); 215662306a36Sopenharmony_ci } 215762306a36Sopenharmony_ci} 215862306a36Sopenharmony_ci 215962306a36Sopenharmony_cistatic void rtw8852c_ctrl_tx_path_tmac(struct rtw89_dev *rtwdev, u8 tx_path, 216062306a36Sopenharmony_ci enum rtw89_mac_idx mac_idx) 216162306a36Sopenharmony_ci{ 216262306a36Sopenharmony_ci struct rtw89_reg2_def path_com[] = { 216362306a36Sopenharmony_ci {R_AX_PATH_COM0, AX_PATH_COM0_DFVAL}, 216462306a36Sopenharmony_ci {R_AX_PATH_COM1, AX_PATH_COM1_DFVAL}, 216562306a36Sopenharmony_ci {R_AX_PATH_COM2, AX_PATH_COM2_DFVAL}, 216662306a36Sopenharmony_ci {R_AX_PATH_COM3, AX_PATH_COM3_DFVAL}, 216762306a36Sopenharmony_ci {R_AX_PATH_COM4, AX_PATH_COM4_DFVAL}, 216862306a36Sopenharmony_ci {R_AX_PATH_COM5, AX_PATH_COM5_DFVAL}, 216962306a36Sopenharmony_ci {R_AX_PATH_COM6, AX_PATH_COM6_DFVAL}, 217062306a36Sopenharmony_ci {R_AX_PATH_COM7, AX_PATH_COM7_DFVAL}, 217162306a36Sopenharmony_ci {R_AX_PATH_COM8, AX_PATH_COM8_DFVAL}, 217262306a36Sopenharmony_ci {R_AX_PATH_COM9, AX_PATH_COM9_DFVAL}, 217362306a36Sopenharmony_ci {R_AX_PATH_COM10, AX_PATH_COM10_DFVAL}, 217462306a36Sopenharmony_ci {R_AX_PATH_COM11, AX_PATH_COM11_DFVAL}, 217562306a36Sopenharmony_ci }; 217662306a36Sopenharmony_ci u32 addr; 217762306a36Sopenharmony_ci u32 reg; 217862306a36Sopenharmony_ci u8 cr_size = ARRAY_SIZE(path_com); 217962306a36Sopenharmony_ci u8 i = 0; 218062306a36Sopenharmony_ci 218162306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_MAC_SEL, B_MAC_SEL_MOD, 0, RTW89_PHY_0); 218262306a36Sopenharmony_ci rtw89_phy_write32_idx(rtwdev, R_MAC_SEL, B_MAC_SEL_MOD, 0, RTW89_PHY_1); 218362306a36Sopenharmony_ci 218462306a36Sopenharmony_ci for (addr = R_AX_MACID_ANT_TABLE; 218562306a36Sopenharmony_ci addr <= R_AX_MACID_ANT_TABLE_LAST; addr += 4) { 218662306a36Sopenharmony_ci reg = rtw89_mac_reg_by_idx(rtwdev, addr, mac_idx); 218762306a36Sopenharmony_ci rtw89_write32(rtwdev, reg, 0); 218862306a36Sopenharmony_ci } 218962306a36Sopenharmony_ci 219062306a36Sopenharmony_ci if (tx_path == RF_A) { 219162306a36Sopenharmony_ci path_com[0].data = AX_PATH_COM0_PATHA; 219262306a36Sopenharmony_ci path_com[1].data = AX_PATH_COM1_PATHA; 219362306a36Sopenharmony_ci path_com[2].data = AX_PATH_COM2_PATHA; 219462306a36Sopenharmony_ci path_com[7].data = AX_PATH_COM7_PATHA; 219562306a36Sopenharmony_ci path_com[8].data = AX_PATH_COM8_PATHA; 219662306a36Sopenharmony_ci } else if (tx_path == RF_B) { 219762306a36Sopenharmony_ci path_com[0].data = AX_PATH_COM0_PATHB; 219862306a36Sopenharmony_ci path_com[1].data = AX_PATH_COM1_PATHB; 219962306a36Sopenharmony_ci path_com[2].data = AX_PATH_COM2_PATHB; 220062306a36Sopenharmony_ci path_com[7].data = AX_PATH_COM7_PATHB; 220162306a36Sopenharmony_ci path_com[8].data = AX_PATH_COM8_PATHB; 220262306a36Sopenharmony_ci } else if (tx_path == RF_AB) { 220362306a36Sopenharmony_ci path_com[0].data = AX_PATH_COM0_PATHAB; 220462306a36Sopenharmony_ci path_com[1].data = AX_PATH_COM1_PATHAB; 220562306a36Sopenharmony_ci path_com[2].data = AX_PATH_COM2_PATHAB; 220662306a36Sopenharmony_ci path_com[7].data = AX_PATH_COM7_PATHAB; 220762306a36Sopenharmony_ci path_com[8].data = AX_PATH_COM8_PATHAB; 220862306a36Sopenharmony_ci } else { 220962306a36Sopenharmony_ci rtw89_warn(rtwdev, "[Invalid Tx Path]Tx Path: %d\n", tx_path); 221062306a36Sopenharmony_ci return; 221162306a36Sopenharmony_ci } 221262306a36Sopenharmony_ci 221362306a36Sopenharmony_ci for (i = 0; i < cr_size; i++) { 221462306a36Sopenharmony_ci rtw89_debug(rtwdev, RTW89_DBG_TSSI, "0x%x = 0x%x\n", 221562306a36Sopenharmony_ci path_com[i].addr, path_com[i].data); 221662306a36Sopenharmony_ci reg = rtw89_mac_reg_by_idx(rtwdev, path_com[i].addr, mac_idx); 221762306a36Sopenharmony_ci rtw89_write32(rtwdev, reg, path_com[i].data); 221862306a36Sopenharmony_ci } 221962306a36Sopenharmony_ci} 222062306a36Sopenharmony_ci 222162306a36Sopenharmony_cistatic void rtw8852c_bb_ctrl_btc_preagc(struct rtw89_dev *rtwdev, bool bt_en) 222262306a36Sopenharmony_ci{ 222362306a36Sopenharmony_ci if (bt_en) { 222462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_FRC_FIR_TYPE_V1, 222562306a36Sopenharmony_ci B_PATH0_FRC_FIR_TYPE_MSK_V1, 0x3); 222662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_FRC_FIR_TYPE_V1, 222762306a36Sopenharmony_ci B_PATH1_FRC_FIR_TYPE_MSK_V1, 0x3); 222862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_RXBB_V1, 222962306a36Sopenharmony_ci B_PATH0_RXBB_MSK_V1, 0xf); 223062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_RXBB_V1, 223162306a36Sopenharmony_ci B_PATH1_RXBB_MSK_V1, 0xf); 223262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_LNA6_OP1DB_V1, 223362306a36Sopenharmony_ci B_PATH0_G_LNA6_OP1DB_V1, 0x80); 223462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 223562306a36Sopenharmony_ci B_PATH1_G_LNA6_OP1DB_V1, 0x80); 223662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_TIA0_LNA6_OP1DB_V1, 223762306a36Sopenharmony_ci B_PATH0_G_TIA0_LNA6_OP1DB_V1, 0x80); 223862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_TIA1_LNA6_OP1DB_V1, 223962306a36Sopenharmony_ci B_PATH0_G_TIA1_LNA6_OP1DB_V1, 0x80); 224062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 224162306a36Sopenharmony_ci B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x80); 224262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA1_LNA6_OP1DB_V1, 224362306a36Sopenharmony_ci B_PATH1_G_TIA1_LNA6_OP1DB_V1, 0x80); 224462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_BACKOFF_V1, 224562306a36Sopenharmony_ci B_PATH0_BT_BACKOFF_V1, 0x780D1E); 224662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_BACKOFF_V1, 224762306a36Sopenharmony_ci B_PATH1_BT_BACKOFF_V1, 0x780D1E); 224862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_BACKOFF_IBADC_V1, 224962306a36Sopenharmony_ci B_P0_BACKOFF_IBADC_V1, 0x34); 225062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_BACKOFF_IBADC_V1, 225162306a36Sopenharmony_ci B_P1_BACKOFF_IBADC_V1, 0x34); 225262306a36Sopenharmony_ci } else { 225362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_FRC_FIR_TYPE_V1, 225462306a36Sopenharmony_ci B_PATH0_FRC_FIR_TYPE_MSK_V1, 0x0); 225562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_FRC_FIR_TYPE_V1, 225662306a36Sopenharmony_ci B_PATH1_FRC_FIR_TYPE_MSK_V1, 0x0); 225762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_RXBB_V1, 225862306a36Sopenharmony_ci B_PATH0_RXBB_MSK_V1, 0x60); 225962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_RXBB_V1, 226062306a36Sopenharmony_ci B_PATH1_RXBB_MSK_V1, 0x60); 226162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_LNA6_OP1DB_V1, 226262306a36Sopenharmony_ci B_PATH0_G_LNA6_OP1DB_V1, 0x1a); 226362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 226462306a36Sopenharmony_ci B_PATH1_G_LNA6_OP1DB_V1, 0x1a); 226562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_TIA0_LNA6_OP1DB_V1, 226662306a36Sopenharmony_ci B_PATH0_G_TIA0_LNA6_OP1DB_V1, 0x2a); 226762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_G_TIA1_LNA6_OP1DB_V1, 226862306a36Sopenharmony_ci B_PATH0_G_TIA1_LNA6_OP1DB_V1, 0x2a); 226962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 227062306a36Sopenharmony_ci B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x2a); 227162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA1_LNA6_OP1DB_V1, 227262306a36Sopenharmony_ci B_PATH1_G_TIA1_LNA6_OP1DB_V1, 0x2a); 227362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_BACKOFF_V1, 227462306a36Sopenharmony_ci B_PATH0_BT_BACKOFF_V1, 0x79E99E); 227562306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_BACKOFF_V1, 227662306a36Sopenharmony_ci B_PATH1_BT_BACKOFF_V1, 0x79E99E); 227762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P0_BACKOFF_IBADC_V1, 227862306a36Sopenharmony_ci B_P0_BACKOFF_IBADC_V1, 0x26); 227962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_P1_BACKOFF_IBADC_V1, 228062306a36Sopenharmony_ci B_P1_BACKOFF_IBADC_V1, 0x26); 228162306a36Sopenharmony_ci } 228262306a36Sopenharmony_ci} 228362306a36Sopenharmony_ci 228462306a36Sopenharmony_cistatic void rtw8852c_bb_cfg_txrx_path(struct rtw89_dev *rtwdev) 228562306a36Sopenharmony_ci{ 228662306a36Sopenharmony_ci struct rtw89_hal *hal = &rtwdev->hal; 228762306a36Sopenharmony_ci 228862306a36Sopenharmony_ci rtw8852c_bb_cfg_rx_path(rtwdev, RF_PATH_AB); 228962306a36Sopenharmony_ci 229062306a36Sopenharmony_ci if (hal->rx_nss == 1) { 229162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, B_RXHT_MCS_LIMIT, 0); 229262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, B_RXVHT_MCS_LIMIT, 0); 229362306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0); 229462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0); 229562306a36Sopenharmony_ci } else { 229662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, B_RXHT_MCS_LIMIT, 1); 229762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, B_RXVHT_MCS_LIMIT, 1); 229862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 1); 229962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 1); 230062306a36Sopenharmony_ci } 230162306a36Sopenharmony_ci} 230262306a36Sopenharmony_ci 230362306a36Sopenharmony_cistatic u8 rtw8852c_get_thermal(struct rtw89_dev *rtwdev, enum rtw89_rf_path rf_path) 230462306a36Sopenharmony_ci{ 230562306a36Sopenharmony_ci rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x1); 230662306a36Sopenharmony_ci rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x0); 230762306a36Sopenharmony_ci rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x1); 230862306a36Sopenharmony_ci 230962306a36Sopenharmony_ci fsleep(200); 231062306a36Sopenharmony_ci 231162306a36Sopenharmony_ci return rtw89_read_rf(rtwdev, rf_path, RR_TM, RR_TM_VAL); 231262306a36Sopenharmony_ci} 231362306a36Sopenharmony_ci 231462306a36Sopenharmony_cistatic void rtw8852c_btc_set_rfe(struct rtw89_dev *rtwdev) 231562306a36Sopenharmony_ci{ 231662306a36Sopenharmony_ci struct rtw89_btc *btc = &rtwdev->btc; 231762306a36Sopenharmony_ci struct rtw89_btc_module *module = &btc->mdinfo; 231862306a36Sopenharmony_ci 231962306a36Sopenharmony_ci module->rfe_type = rtwdev->efuse.rfe_type; 232062306a36Sopenharmony_ci module->cv = rtwdev->hal.cv; 232162306a36Sopenharmony_ci module->bt_solo = 0; 232262306a36Sopenharmony_ci module->switch_type = BTC_SWITCH_INTERNAL; 232362306a36Sopenharmony_ci 232462306a36Sopenharmony_ci if (module->rfe_type > 0) 232562306a36Sopenharmony_ci module->ant.num = (module->rfe_type % 2 ? 2 : 3); 232662306a36Sopenharmony_ci else 232762306a36Sopenharmony_ci module->ant.num = 2; 232862306a36Sopenharmony_ci 232962306a36Sopenharmony_ci module->ant.diversity = 0; 233062306a36Sopenharmony_ci module->ant.isolation = 10; 233162306a36Sopenharmony_ci 233262306a36Sopenharmony_ci if (module->ant.num == 3) { 233362306a36Sopenharmony_ci module->ant.type = BTC_ANT_DEDICATED; 233462306a36Sopenharmony_ci module->bt_pos = BTC_BT_ALONE; 233562306a36Sopenharmony_ci } else { 233662306a36Sopenharmony_ci module->ant.type = BTC_ANT_SHARED; 233762306a36Sopenharmony_ci module->bt_pos = BTC_BT_BTG; 233862306a36Sopenharmony_ci } 233962306a36Sopenharmony_ci} 234062306a36Sopenharmony_ci 234162306a36Sopenharmony_cistatic void rtw8852c_ctrl_btg(struct rtw89_dev *rtwdev, bool btg) 234262306a36Sopenharmony_ci{ 234362306a36Sopenharmony_ci if (btg) { 234462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_SHARE_V1, 234562306a36Sopenharmony_ci B_PATH0_BT_SHARE_V1, 0x1); 234662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BTG_PATH_V1, 234762306a36Sopenharmony_ci B_PATH0_BTG_PATH_V1, 0x0); 234862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 234962306a36Sopenharmony_ci B_PATH1_G_LNA6_OP1DB_V1, 0x20); 235062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 235162306a36Sopenharmony_ci B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x30); 235262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_SHARE_V1, 235362306a36Sopenharmony_ci B_PATH1_BT_SHARE_V1, 0x1); 235462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BTG_PATH_V1, 235562306a36Sopenharmony_ci B_PATH1_BTG_PATH_V1, 0x1); 235662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P1, 0x0); 235762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_BT_SHARE, 0x1); 235862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_BT_SEG0, 0x2); 235962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_BT_DYN_DC_EST_EN, 236062306a36Sopenharmony_ci B_BT_DYN_DC_EST_EN_MSK, 0x1); 236162306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_GNT_BT_WGT_EN, B_GNT_BT_WGT_EN, 236262306a36Sopenharmony_ci 0x1); 236362306a36Sopenharmony_ci } else { 236462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_SHARE_V1, 236562306a36Sopenharmony_ci B_PATH0_BT_SHARE_V1, 0x0); 236662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH0_BTG_PATH_V1, 236762306a36Sopenharmony_ci B_PATH0_BTG_PATH_V1, 0x0); 236862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 236962306a36Sopenharmony_ci B_PATH1_G_LNA6_OP1DB_V1, 0x1a); 237062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 237162306a36Sopenharmony_ci B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x2a); 237262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_SHARE_V1, 237362306a36Sopenharmony_ci B_PATH1_BT_SHARE_V1, 0x0); 237462306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PATH1_BTG_PATH_V1, 237562306a36Sopenharmony_ci B_PATH1_BTG_PATH_V1, 0x0); 237662306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P1, 0xf); 237762306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P2, 0x4); 237862306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_BT_SHARE, 0x0); 237962306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_BT_SEG0, 0x0); 238062306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_BT_DYN_DC_EST_EN, 238162306a36Sopenharmony_ci B_BT_DYN_DC_EST_EN_MSK, 0x0); 238262306a36Sopenharmony_ci rtw89_phy_write32_mask(rtwdev, R_GNT_BT_WGT_EN, B_GNT_BT_WGT_EN, 238362306a36Sopenharmony_ci 0x0); 238462306a36Sopenharmony_ci } 238562306a36Sopenharmony_ci} 238662306a36Sopenharmony_ci 238762306a36Sopenharmony_cistatic 238862306a36Sopenharmony_civoid rtw8852c_set_trx_mask(struct rtw89_dev *rtwdev, u8 path, u8 group, u32 val) 238962306a36Sopenharmony_ci{ 239062306a36Sopenharmony_ci rtw89_write_rf(rtwdev, path, RR_LUTWE, RFREG_MASK, 0x20000); 239162306a36Sopenharmony_ci rtw89_write_rf(rtwdev, path, RR_LUTWA, RFREG_MASK, group); 239262306a36Sopenharmony_ci rtw89_write_rf(rtwdev, path, RR_LUTWD0, RFREG_MASK, val); 239362306a36Sopenharmony_ci rtw89_write_rf(rtwdev, path, RR_LUTWE, RFREG_MASK, 0x0); 239462306a36Sopenharmony_ci} 239562306a36Sopenharmony_ci 239662306a36Sopenharmony_cistatic void rtw8852c_btc_init_cfg(struct rtw89_dev *rtwdev) 239762306a36Sopenharmony_ci{ 239862306a36Sopenharmony_ci struct rtw89_btc *btc = &rtwdev->btc; 239962306a36Sopenharmony_ci struct rtw89_btc_module *module = &btc->mdinfo; 240062306a36Sopenharmony_ci const struct rtw89_chip_info *chip = rtwdev->chip; 240162306a36Sopenharmony_ci const struct rtw89_mac_ax_coex coex_params = { 240262306a36Sopenharmony_ci .pta_mode = RTW89_MAC_AX_COEX_RTK_MODE, 240362306a36Sopenharmony_ci .direction = RTW89_MAC_AX_COEX_INNER, 240462306a36Sopenharmony_ci }; 240562306a36Sopenharmony_ci 240662306a36Sopenharmony_ci /* PTA init */ 240762306a36Sopenharmony_ci rtw89_mac_coex_init_v1(rtwdev, &coex_params); 240862306a36Sopenharmony_ci 240962306a36Sopenharmony_ci /* set WL Tx response = Hi-Pri */ 241062306a36Sopenharmony_ci chip->ops->btc_set_wl_pri(rtwdev, BTC_PRI_MASK_TX_RESP, true); 241162306a36Sopenharmony_ci chip->ops->btc_set_wl_pri(rtwdev, BTC_PRI_MASK_BEACON, true); 241262306a36Sopenharmony_ci 241362306a36Sopenharmony_ci /* set rf gnt debug off */ 241462306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_A, RR_WLSEL, RFREG_MASK, 0x0); 241562306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_WLSEL, RFREG_MASK, 0x0); 241662306a36Sopenharmony_ci 241762306a36Sopenharmony_ci /* set WL Tx thru in TRX mask table if GNT_WL = 0 && BT_S1 = ss group */ 241862306a36Sopenharmony_ci if (module->ant.type == BTC_ANT_SHARED) { 241962306a36Sopenharmony_ci rtw8852c_set_trx_mask(rtwdev, 242062306a36Sopenharmony_ci RF_PATH_A, BTC_BT_SS_GROUP, 0x5ff); 242162306a36Sopenharmony_ci rtw8852c_set_trx_mask(rtwdev, 242262306a36Sopenharmony_ci RF_PATH_B, BTC_BT_SS_GROUP, 0x5ff); 242362306a36Sopenharmony_ci /* set path-A(S0) Tx/Rx no-mask if GNT_WL=0 && BT_S1=tx group */ 242462306a36Sopenharmony_ci rtw8852c_set_trx_mask(rtwdev, 242562306a36Sopenharmony_ci RF_PATH_A, BTC_BT_TX_GROUP, 0x5ff); 242662306a36Sopenharmony_ci } else { /* set WL Tx stb if GNT_WL = 0 && BT_S1 = ss group for 3-ant */ 242762306a36Sopenharmony_ci rtw8852c_set_trx_mask(rtwdev, 242862306a36Sopenharmony_ci RF_PATH_A, BTC_BT_SS_GROUP, 0x5df); 242962306a36Sopenharmony_ci rtw8852c_set_trx_mask(rtwdev, 243062306a36Sopenharmony_ci RF_PATH_B, BTC_BT_SS_GROUP, 0x5df); 243162306a36Sopenharmony_ci } 243262306a36Sopenharmony_ci 243362306a36Sopenharmony_ci /* set PTA break table */ 243462306a36Sopenharmony_ci rtw89_write32(rtwdev, R_AX_BT_BREAK_TABLE, BTC_BREAK_PARAM); 243562306a36Sopenharmony_ci 243662306a36Sopenharmony_ci /* enable BT counter 0xda10[1:0] = 2b'11 */ 243762306a36Sopenharmony_ci rtw89_write32_set(rtwdev, 243862306a36Sopenharmony_ci R_AX_BT_CNT_CFG, B_AX_BT_CNT_EN | 243962306a36Sopenharmony_ci B_AX_BT_CNT_RST_V1); 244062306a36Sopenharmony_ci btc->cx.wl.status.map.init_ok = true; 244162306a36Sopenharmony_ci} 244262306a36Sopenharmony_ci 244362306a36Sopenharmony_cistatic 244462306a36Sopenharmony_civoid rtw8852c_btc_set_wl_pri(struct rtw89_dev *rtwdev, u8 map, bool state) 244562306a36Sopenharmony_ci{ 244662306a36Sopenharmony_ci u32 bitmap = 0; 244762306a36Sopenharmony_ci u32 reg = 0; 244862306a36Sopenharmony_ci 244962306a36Sopenharmony_ci switch (map) { 245062306a36Sopenharmony_ci case BTC_PRI_MASK_TX_RESP: 245162306a36Sopenharmony_ci reg = R_BTC_COEX_WL_REQ; 245262306a36Sopenharmony_ci bitmap = B_BTC_RSP_ACK_HI; 245362306a36Sopenharmony_ci break; 245462306a36Sopenharmony_ci case BTC_PRI_MASK_BEACON: 245562306a36Sopenharmony_ci reg = R_BTC_COEX_WL_REQ; 245662306a36Sopenharmony_ci bitmap = B_BTC_TX_BCN_HI; 245762306a36Sopenharmony_ci break; 245862306a36Sopenharmony_ci default: 245962306a36Sopenharmony_ci return; 246062306a36Sopenharmony_ci } 246162306a36Sopenharmony_ci 246262306a36Sopenharmony_ci if (state) 246362306a36Sopenharmony_ci rtw89_write32_set(rtwdev, reg, bitmap); 246462306a36Sopenharmony_ci else 246562306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, reg, bitmap); 246662306a36Sopenharmony_ci} 246762306a36Sopenharmony_ci 246862306a36Sopenharmony_ciunion rtw8852c_btc_wl_txpwr_ctrl { 246962306a36Sopenharmony_ci u32 txpwr_val; 247062306a36Sopenharmony_ci struct { 247162306a36Sopenharmony_ci union { 247262306a36Sopenharmony_ci u16 ctrl_all_time; 247362306a36Sopenharmony_ci struct { 247462306a36Sopenharmony_ci s16 data:9; 247562306a36Sopenharmony_ci u16 rsvd:6; 247662306a36Sopenharmony_ci u16 flag:1; 247762306a36Sopenharmony_ci } all_time; 247862306a36Sopenharmony_ci }; 247962306a36Sopenharmony_ci union { 248062306a36Sopenharmony_ci u16 ctrl_gnt_bt; 248162306a36Sopenharmony_ci struct { 248262306a36Sopenharmony_ci s16 data:9; 248362306a36Sopenharmony_ci u16 rsvd:7; 248462306a36Sopenharmony_ci } gnt_bt; 248562306a36Sopenharmony_ci }; 248662306a36Sopenharmony_ci }; 248762306a36Sopenharmony_ci} __packed; 248862306a36Sopenharmony_ci 248962306a36Sopenharmony_cistatic void 249062306a36Sopenharmony_cirtw8852c_btc_set_wl_txpwr_ctrl(struct rtw89_dev *rtwdev, u32 txpwr_val) 249162306a36Sopenharmony_ci{ 249262306a36Sopenharmony_ci union rtw8852c_btc_wl_txpwr_ctrl arg = { .txpwr_val = txpwr_val }; 249362306a36Sopenharmony_ci s32 val; 249462306a36Sopenharmony_ci 249562306a36Sopenharmony_ci#define __write_ctrl(_reg, _msk, _val, _en, _cond) \ 249662306a36Sopenharmony_cido { \ 249762306a36Sopenharmony_ci u32 _wrt = FIELD_PREP(_msk, _val); \ 249862306a36Sopenharmony_ci BUILD_BUG_ON((_msk & _en) != 0); \ 249962306a36Sopenharmony_ci if (_cond) \ 250062306a36Sopenharmony_ci _wrt |= _en; \ 250162306a36Sopenharmony_ci else \ 250262306a36Sopenharmony_ci _wrt &= ~_en; \ 250362306a36Sopenharmony_ci rtw89_mac_txpwr_write32_mask(rtwdev, RTW89_PHY_0, _reg, \ 250462306a36Sopenharmony_ci _msk | _en, _wrt); \ 250562306a36Sopenharmony_ci} while (0) 250662306a36Sopenharmony_ci 250762306a36Sopenharmony_ci switch (arg.ctrl_all_time) { 250862306a36Sopenharmony_ci case 0xffff: 250962306a36Sopenharmony_ci val = 0; 251062306a36Sopenharmony_ci break; 251162306a36Sopenharmony_ci default: 251262306a36Sopenharmony_ci val = arg.all_time.data; 251362306a36Sopenharmony_ci break; 251462306a36Sopenharmony_ci } 251562306a36Sopenharmony_ci 251662306a36Sopenharmony_ci __write_ctrl(R_AX_PWR_RATE_CTRL, B_AX_FORCE_PWR_BY_RATE_VALUE_MASK, 251762306a36Sopenharmony_ci val, B_AX_FORCE_PWR_BY_RATE_EN, 251862306a36Sopenharmony_ci arg.ctrl_all_time != 0xffff); 251962306a36Sopenharmony_ci 252062306a36Sopenharmony_ci switch (arg.ctrl_gnt_bt) { 252162306a36Sopenharmony_ci case 0xffff: 252262306a36Sopenharmony_ci val = 0; 252362306a36Sopenharmony_ci break; 252462306a36Sopenharmony_ci default: 252562306a36Sopenharmony_ci val = arg.gnt_bt.data; 252662306a36Sopenharmony_ci break; 252762306a36Sopenharmony_ci } 252862306a36Sopenharmony_ci 252962306a36Sopenharmony_ci __write_ctrl(R_AX_PWR_COEXT_CTRL, B_AX_TXAGC_BT_MASK, val, 253062306a36Sopenharmony_ci B_AX_TXAGC_BT_EN, arg.ctrl_gnt_bt != 0xffff); 253162306a36Sopenharmony_ci 253262306a36Sopenharmony_ci#undef __write_ctrl 253362306a36Sopenharmony_ci} 253462306a36Sopenharmony_ci 253562306a36Sopenharmony_cistatic 253662306a36Sopenharmony_cis8 rtw8852c_btc_get_bt_rssi(struct rtw89_dev *rtwdev, s8 val) 253762306a36Sopenharmony_ci{ 253862306a36Sopenharmony_ci /* +6 for compensate offset */ 253962306a36Sopenharmony_ci return clamp_t(s8, val + 6, -100, 0) + 100; 254062306a36Sopenharmony_ci} 254162306a36Sopenharmony_ci 254262306a36Sopenharmony_cistatic const struct rtw89_btc_rf_trx_para rtw89_btc_8852c_rf_ul[] = { 254362306a36Sopenharmony_ci {255, 0, 0, 7}, /* 0 -> original */ 254462306a36Sopenharmony_ci {255, 2, 0, 7}, /* 1 -> for BT-connected ACI issue && BTG co-rx */ 254562306a36Sopenharmony_ci {255, 0, 0, 7}, /* 2 ->reserved for shared-antenna */ 254662306a36Sopenharmony_ci {255, 0, 0, 7}, /* 3- >reserved for shared-antenna */ 254762306a36Sopenharmony_ci {255, 0, 0, 7}, /* 4 ->reserved for shared-antenna */ 254862306a36Sopenharmony_ci {255, 1, 0, 7}, /* the below id is for non-shared-antenna free-run */ 254962306a36Sopenharmony_ci {6, 1, 0, 7}, 255062306a36Sopenharmony_ci {13, 1, 0, 7}, 255162306a36Sopenharmony_ci {13, 1, 0, 7} 255262306a36Sopenharmony_ci}; 255362306a36Sopenharmony_ci 255462306a36Sopenharmony_cistatic const struct rtw89_btc_rf_trx_para rtw89_btc_8852c_rf_dl[] = { 255562306a36Sopenharmony_ci {255, 0, 0, 7}, /* 0 -> original */ 255662306a36Sopenharmony_ci {255, 2, 0, 7}, /* 1 -> reserved for shared-antenna */ 255762306a36Sopenharmony_ci {255, 0, 0, 7}, /* 2 ->reserved for shared-antenna */ 255862306a36Sopenharmony_ci {255, 0, 0, 7}, /* 3- >reserved for shared-antenna */ 255962306a36Sopenharmony_ci {255, 0, 0, 7}, /* 4 ->reserved for shared-antenna */ 256062306a36Sopenharmony_ci {255, 1, 0, 7}, /* the below id is for non-shared-antenna free-run */ 256162306a36Sopenharmony_ci {255, 1, 0, 7}, 256262306a36Sopenharmony_ci {255, 1, 0, 7}, 256362306a36Sopenharmony_ci {255, 1, 0, 7} 256462306a36Sopenharmony_ci}; 256562306a36Sopenharmony_ci 256662306a36Sopenharmony_cistatic const u8 rtw89_btc_8852c_wl_rssi_thres[BTC_WL_RSSI_THMAX] = {60, 50, 40, 30}; 256762306a36Sopenharmony_cistatic const u8 rtw89_btc_8852c_bt_rssi_thres[BTC_BT_RSSI_THMAX] = {40, 36, 31, 28}; 256862306a36Sopenharmony_ci 256962306a36Sopenharmony_cistatic const struct rtw89_btc_fbtc_mreg rtw89_btc_8852c_mon_reg[] = { 257062306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda00), 257162306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda04), 257262306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda24), 257362306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda30), 257462306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda34), 257562306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda38), 257662306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda44), 257762306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda48), 257862306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xda4c), 257962306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xd200), 258062306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_MAC, 4, 0xd220), 258162306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_BB, 4, 0x980), 258262306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_BB, 4, 0x4aa4), 258362306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_BB, 4, 0x4778), 258462306a36Sopenharmony_ci RTW89_DEF_FBTC_MREG(REG_BB, 4, 0x476c), 258562306a36Sopenharmony_ci}; 258662306a36Sopenharmony_ci 258762306a36Sopenharmony_cistatic 258862306a36Sopenharmony_civoid rtw8852c_btc_update_bt_cnt(struct rtw89_dev *rtwdev) 258962306a36Sopenharmony_ci{ 259062306a36Sopenharmony_ci /* Feature move to firmware */ 259162306a36Sopenharmony_ci} 259262306a36Sopenharmony_ci 259362306a36Sopenharmony_cistatic 259462306a36Sopenharmony_civoid rtw8852c_btc_wl_s1_standby(struct rtw89_dev *rtwdev, bool state) 259562306a36Sopenharmony_ci{ 259662306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x80000); 259762306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x1); 259862306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD1, RFREG_MASK, 0x620); 259962306a36Sopenharmony_ci 260062306a36Sopenharmony_ci /* set WL standby = Rx for GNT_BT_Tx = 1->0 settle issue */ 260162306a36Sopenharmony_ci if (state) 260262306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, 260362306a36Sopenharmony_ci RFREG_MASK, 0x179c); 260462306a36Sopenharmony_ci else 260562306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, 260662306a36Sopenharmony_ci RFREG_MASK, 0x208); 260762306a36Sopenharmony_ci 260862306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x0); 260962306a36Sopenharmony_ci} 261062306a36Sopenharmony_ci 261162306a36Sopenharmony_cistatic void rtw8852c_set_wl_lna2(struct rtw89_dev *rtwdev, u8 level) 261262306a36Sopenharmony_ci{ 261362306a36Sopenharmony_ci /* level=0 Default: TIA 1/0= (LNA2,TIAN6) = (7,1)/(5,1) = 21dB/12dB 261462306a36Sopenharmony_ci * level=1 Fix LNA2=5: TIA 1/0= (LNA2,TIAN6) = (5,0)/(5,1) = 18dB/12dB 261562306a36Sopenharmony_ci * To improve BT ACI in co-rx 261662306a36Sopenharmony_ci */ 261762306a36Sopenharmony_ci 261862306a36Sopenharmony_ci switch (level) { 261962306a36Sopenharmony_ci case 0: /* default */ 262062306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x1000); 262162306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x0); 262262306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x15); 262362306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x1); 262462306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x17); 262562306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x2); 262662306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x15); 262762306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x3); 262862306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x17); 262962306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x0); 263062306a36Sopenharmony_ci break; 263162306a36Sopenharmony_ci case 1: /* Fix LNA2=5 */ 263262306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x1000); 263362306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x0); 263462306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x15); 263562306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x1); 263662306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x5); 263762306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x2); 263862306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x15); 263962306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x3); 264062306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, RFREG_MASK, 0x5); 264162306a36Sopenharmony_ci rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x0); 264262306a36Sopenharmony_ci break; 264362306a36Sopenharmony_ci } 264462306a36Sopenharmony_ci} 264562306a36Sopenharmony_ci 264662306a36Sopenharmony_cistatic void rtw8852c_btc_set_wl_rx_gain(struct rtw89_dev *rtwdev, u32 level) 264762306a36Sopenharmony_ci{ 264862306a36Sopenharmony_ci struct rtw89_btc *btc = &rtwdev->btc; 264962306a36Sopenharmony_ci 265062306a36Sopenharmony_ci switch (level) { 265162306a36Sopenharmony_ci case 0: /* original */ 265262306a36Sopenharmony_ci default: 265362306a36Sopenharmony_ci rtw8852c_bb_ctrl_btc_preagc(rtwdev, false); 265462306a36Sopenharmony_ci btc->dm.wl_lna2 = 0; 265562306a36Sopenharmony_ci break; 265662306a36Sopenharmony_ci case 1: /* for FDD free-run */ 265762306a36Sopenharmony_ci rtw8852c_bb_ctrl_btc_preagc(rtwdev, true); 265862306a36Sopenharmony_ci btc->dm.wl_lna2 = 0; 265962306a36Sopenharmony_ci break; 266062306a36Sopenharmony_ci case 2: /* for BTG Co-Rx*/ 266162306a36Sopenharmony_ci rtw8852c_bb_ctrl_btc_preagc(rtwdev, false); 266262306a36Sopenharmony_ci btc->dm.wl_lna2 = 1; 266362306a36Sopenharmony_ci break; 266462306a36Sopenharmony_ci } 266562306a36Sopenharmony_ci 266662306a36Sopenharmony_ci rtw8852c_set_wl_lna2(rtwdev, btc->dm.wl_lna2); 266762306a36Sopenharmony_ci} 266862306a36Sopenharmony_ci 266962306a36Sopenharmony_cistatic void rtw8852c_fill_freq_with_ppdu(struct rtw89_dev *rtwdev, 267062306a36Sopenharmony_ci struct rtw89_rx_phy_ppdu *phy_ppdu, 267162306a36Sopenharmony_ci struct ieee80211_rx_status *status) 267262306a36Sopenharmony_ci{ 267362306a36Sopenharmony_ci u8 chan_idx = phy_ppdu->chan_idx; 267462306a36Sopenharmony_ci enum nl80211_band band; 267562306a36Sopenharmony_ci u8 ch; 267662306a36Sopenharmony_ci 267762306a36Sopenharmony_ci if (chan_idx == 0) 267862306a36Sopenharmony_ci return; 267962306a36Sopenharmony_ci 268062306a36Sopenharmony_ci rtw89_decode_chan_idx(rtwdev, chan_idx, &ch, &band); 268162306a36Sopenharmony_ci status->freq = ieee80211_channel_to_frequency(ch, band); 268262306a36Sopenharmony_ci status->band = band; 268362306a36Sopenharmony_ci} 268462306a36Sopenharmony_ci 268562306a36Sopenharmony_cistatic void rtw8852c_query_ppdu(struct rtw89_dev *rtwdev, 268662306a36Sopenharmony_ci struct rtw89_rx_phy_ppdu *phy_ppdu, 268762306a36Sopenharmony_ci struct ieee80211_rx_status *status) 268862306a36Sopenharmony_ci{ 268962306a36Sopenharmony_ci u8 path; 269062306a36Sopenharmony_ci u8 *rx_power = phy_ppdu->rssi; 269162306a36Sopenharmony_ci 269262306a36Sopenharmony_ci status->signal = RTW89_RSSI_RAW_TO_DBM(max(rx_power[RF_PATH_A], rx_power[RF_PATH_B])); 269362306a36Sopenharmony_ci for (path = 0; path < rtwdev->chip->rf_path_num; path++) { 269462306a36Sopenharmony_ci status->chains |= BIT(path); 269562306a36Sopenharmony_ci status->chain_signal[path] = RTW89_RSSI_RAW_TO_DBM(rx_power[path]); 269662306a36Sopenharmony_ci } 269762306a36Sopenharmony_ci if (phy_ppdu->valid) 269862306a36Sopenharmony_ci rtw8852c_fill_freq_with_ppdu(rtwdev, phy_ppdu, status); 269962306a36Sopenharmony_ci} 270062306a36Sopenharmony_ci 270162306a36Sopenharmony_cistatic int rtw8852c_mac_enable_bb_rf(struct rtw89_dev *rtwdev) 270262306a36Sopenharmony_ci{ 270362306a36Sopenharmony_ci int ret; 270462306a36Sopenharmony_ci 270562306a36Sopenharmony_ci rtw89_write8_set(rtwdev, R_AX_SYS_FUNC_EN, 270662306a36Sopenharmony_ci B_AX_FEN_BBRSTB | B_AX_FEN_BB_GLB_RSTN); 270762306a36Sopenharmony_ci 270862306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 270962306a36Sopenharmony_ci rtw89_write32_clr(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 271062306a36Sopenharmony_ci rtw89_write32_set(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 271162306a36Sopenharmony_ci 271262306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, R_AX_AFE_OFF_CTRL1, B_AX_S0_LDO_VSEL_F_MASK, 0x1); 271362306a36Sopenharmony_ci rtw89_write32_mask(rtwdev, R_AX_AFE_OFF_CTRL1, B_AX_S1_LDO_VSEL_F_MASK, 0x1); 271462306a36Sopenharmony_ci 271562306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL0, 0x7, FULL_BIT_MASK); 271662306a36Sopenharmony_ci if (ret) 271762306a36Sopenharmony_ci return ret; 271862306a36Sopenharmony_ci 271962306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0x6c, FULL_BIT_MASK); 272062306a36Sopenharmony_ci if (ret) 272162306a36Sopenharmony_ci return ret; 272262306a36Sopenharmony_ci 272362306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S0, 0xc7, FULL_BIT_MASK); 272462306a36Sopenharmony_ci if (ret) 272562306a36Sopenharmony_ci return ret; 272662306a36Sopenharmony_ci 272762306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S1, 0xc7, FULL_BIT_MASK); 272862306a36Sopenharmony_ci if (ret) 272962306a36Sopenharmony_ci return ret; 273062306a36Sopenharmony_ci 273162306a36Sopenharmony_ci ret = rtw89_mac_write_xtal_si(rtwdev, XTAL3, 0xd, FULL_BIT_MASK); 273262306a36Sopenharmony_ci if (ret) 273362306a36Sopenharmony_ci return ret; 273462306a36Sopenharmony_ci 273562306a36Sopenharmony_ci return 0; 273662306a36Sopenharmony_ci} 273762306a36Sopenharmony_ci 273862306a36Sopenharmony_cistatic int rtw8852c_mac_disable_bb_rf(struct rtw89_dev *rtwdev) 273962306a36Sopenharmony_ci{ 274062306a36Sopenharmony_ci rtw89_write8_clr(rtwdev, R_AX_SYS_FUNC_EN, 274162306a36Sopenharmony_ci B_AX_FEN_BBRSTB | B_AX_FEN_BB_GLB_RSTN); 274262306a36Sopenharmony_ci 274362306a36Sopenharmony_ci return 0; 274462306a36Sopenharmony_ci} 274562306a36Sopenharmony_ci 274662306a36Sopenharmony_ci#ifdef CONFIG_PM 274762306a36Sopenharmony_cistatic const struct wiphy_wowlan_support rtw_wowlan_stub_8852c = { 274862306a36Sopenharmony_ci .flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT, 274962306a36Sopenharmony_ci .n_patterns = RTW89_MAX_PATTERN_NUM, 275062306a36Sopenharmony_ci .pattern_max_len = RTW89_MAX_PATTERN_SIZE, 275162306a36Sopenharmony_ci .pattern_min_len = 1, 275262306a36Sopenharmony_ci}; 275362306a36Sopenharmony_ci#endif 275462306a36Sopenharmony_ci 275562306a36Sopenharmony_cistatic const struct rtw89_chip_ops rtw8852c_chip_ops = { 275662306a36Sopenharmony_ci .enable_bb_rf = rtw8852c_mac_enable_bb_rf, 275762306a36Sopenharmony_ci .disable_bb_rf = rtw8852c_mac_disable_bb_rf, 275862306a36Sopenharmony_ci .bb_reset = rtw8852c_bb_reset, 275962306a36Sopenharmony_ci .bb_sethw = rtw8852c_bb_sethw, 276062306a36Sopenharmony_ci .read_rf = rtw89_phy_read_rf_v1, 276162306a36Sopenharmony_ci .write_rf = rtw89_phy_write_rf_v1, 276262306a36Sopenharmony_ci .set_channel = rtw8852c_set_channel, 276362306a36Sopenharmony_ci .set_channel_help = rtw8852c_set_channel_help, 276462306a36Sopenharmony_ci .read_efuse = rtw8852c_read_efuse, 276562306a36Sopenharmony_ci .read_phycap = rtw8852c_read_phycap, 276662306a36Sopenharmony_ci .fem_setup = NULL, 276762306a36Sopenharmony_ci .rfe_gpio = NULL, 276862306a36Sopenharmony_ci .rfk_init = rtw8852c_rfk_init, 276962306a36Sopenharmony_ci .rfk_channel = rtw8852c_rfk_channel, 277062306a36Sopenharmony_ci .rfk_band_changed = rtw8852c_rfk_band_changed, 277162306a36Sopenharmony_ci .rfk_scan = rtw8852c_rfk_scan, 277262306a36Sopenharmony_ci .rfk_track = rtw8852c_rfk_track, 277362306a36Sopenharmony_ci .power_trim = rtw8852c_power_trim, 277462306a36Sopenharmony_ci .set_txpwr = rtw8852c_set_txpwr, 277562306a36Sopenharmony_ci .set_txpwr_ctrl = rtw8852c_set_txpwr_ctrl, 277662306a36Sopenharmony_ci .init_txpwr_unit = rtw8852c_init_txpwr_unit, 277762306a36Sopenharmony_ci .get_thermal = rtw8852c_get_thermal, 277862306a36Sopenharmony_ci .ctrl_btg = rtw8852c_ctrl_btg, 277962306a36Sopenharmony_ci .query_ppdu = rtw8852c_query_ppdu, 278062306a36Sopenharmony_ci .bb_ctrl_btc_preagc = rtw8852c_bb_ctrl_btc_preagc, 278162306a36Sopenharmony_ci .cfg_txrx_path = rtw8852c_bb_cfg_txrx_path, 278262306a36Sopenharmony_ci .set_txpwr_ul_tb_offset = rtw8852c_set_txpwr_ul_tb_offset, 278362306a36Sopenharmony_ci .pwr_on_func = rtw8852c_pwr_on_func, 278462306a36Sopenharmony_ci .pwr_off_func = rtw8852c_pwr_off_func, 278562306a36Sopenharmony_ci .query_rxdesc = rtw89_core_query_rxdesc, 278662306a36Sopenharmony_ci .fill_txdesc = rtw89_core_fill_txdesc_v1, 278762306a36Sopenharmony_ci .fill_txdesc_fwcmd = rtw89_core_fill_txdesc_fwcmd_v1, 278862306a36Sopenharmony_ci .cfg_ctrl_path = rtw89_mac_cfg_ctrl_path_v1, 278962306a36Sopenharmony_ci .mac_cfg_gnt = rtw89_mac_cfg_gnt_v1, 279062306a36Sopenharmony_ci .stop_sch_tx = rtw89_mac_stop_sch_tx_v1, 279162306a36Sopenharmony_ci .resume_sch_tx = rtw89_mac_resume_sch_tx_v1, 279262306a36Sopenharmony_ci .h2c_dctl_sec_cam = rtw89_fw_h2c_dctl_sec_cam_v1, 279362306a36Sopenharmony_ci 279462306a36Sopenharmony_ci .btc_set_rfe = rtw8852c_btc_set_rfe, 279562306a36Sopenharmony_ci .btc_init_cfg = rtw8852c_btc_init_cfg, 279662306a36Sopenharmony_ci .btc_set_wl_pri = rtw8852c_btc_set_wl_pri, 279762306a36Sopenharmony_ci .btc_set_wl_txpwr_ctrl = rtw8852c_btc_set_wl_txpwr_ctrl, 279862306a36Sopenharmony_ci .btc_get_bt_rssi = rtw8852c_btc_get_bt_rssi, 279962306a36Sopenharmony_ci .btc_update_bt_cnt = rtw8852c_btc_update_bt_cnt, 280062306a36Sopenharmony_ci .btc_wl_s1_standby = rtw8852c_btc_wl_s1_standby, 280162306a36Sopenharmony_ci .btc_set_wl_rx_gain = rtw8852c_btc_set_wl_rx_gain, 280262306a36Sopenharmony_ci .btc_set_policy = rtw89_btc_set_policy_v1, 280362306a36Sopenharmony_ci}; 280462306a36Sopenharmony_ci 280562306a36Sopenharmony_ciconst struct rtw89_chip_info rtw8852c_chip_info = { 280662306a36Sopenharmony_ci .chip_id = RTL8852C, 280762306a36Sopenharmony_ci .chip_gen = RTW89_CHIP_AX, 280862306a36Sopenharmony_ci .ops = &rtw8852c_chip_ops, 280962306a36Sopenharmony_ci .mac_def = &rtw89_mac_gen_ax, 281062306a36Sopenharmony_ci .phy_def = &rtw89_phy_gen_ax, 281162306a36Sopenharmony_ci .fw_basename = RTW8852C_FW_BASENAME, 281262306a36Sopenharmony_ci .fw_format_max = RTW8852C_FW_FORMAT_MAX, 281362306a36Sopenharmony_ci .try_ce_fw = false, 281462306a36Sopenharmony_ci .needed_fw_elms = 0, 281562306a36Sopenharmony_ci .fifo_size = 458752, 281662306a36Sopenharmony_ci .small_fifo_size = false, 281762306a36Sopenharmony_ci .dle_scc_rsvd_size = 0, 281862306a36Sopenharmony_ci .max_amsdu_limit = 8000, 281962306a36Sopenharmony_ci .dis_2g_40m_ul_ofdma = false, 282062306a36Sopenharmony_ci .rsvd_ple_ofst = 0x6f800, 282162306a36Sopenharmony_ci .hfc_param_ini = rtw8852c_hfc_param_ini_pcie, 282262306a36Sopenharmony_ci .dle_mem = rtw8852c_dle_mem_pcie, 282362306a36Sopenharmony_ci .wde_qempty_acq_num = 16, 282462306a36Sopenharmony_ci .wde_qempty_mgq_sel = 16, 282562306a36Sopenharmony_ci .rf_base_addr = {0xe000, 0xf000}, 282662306a36Sopenharmony_ci .pwr_on_seq = NULL, 282762306a36Sopenharmony_ci .pwr_off_seq = NULL, 282862306a36Sopenharmony_ci .bb_table = &rtw89_8852c_phy_bb_table, 282962306a36Sopenharmony_ci .bb_gain_table = &rtw89_8852c_phy_bb_gain_table, 283062306a36Sopenharmony_ci .rf_table = {&rtw89_8852c_phy_radiob_table, 283162306a36Sopenharmony_ci &rtw89_8852c_phy_radioa_table,}, 283262306a36Sopenharmony_ci .nctl_table = &rtw89_8852c_phy_nctl_table, 283362306a36Sopenharmony_ci .nctl_post_table = NULL, 283462306a36Sopenharmony_ci .byr_table = &rtw89_8852c_byr_table, 283562306a36Sopenharmony_ci .dflt_parms = &rtw89_8852c_dflt_parms, 283662306a36Sopenharmony_ci .rfe_parms_conf = NULL, 283762306a36Sopenharmony_ci .txpwr_factor_rf = 2, 283862306a36Sopenharmony_ci .txpwr_factor_mac = 1, 283962306a36Sopenharmony_ci .dig_table = NULL, 284062306a36Sopenharmony_ci .dig_regs = &rtw8852c_dig_regs, 284162306a36Sopenharmony_ci .tssi_dbw_table = &rtw89_8852c_tssi_dbw_table, 284262306a36Sopenharmony_ci .support_chanctx_num = 1, 284362306a36Sopenharmony_ci .support_bands = BIT(NL80211_BAND_2GHZ) | 284462306a36Sopenharmony_ci BIT(NL80211_BAND_5GHZ) | 284562306a36Sopenharmony_ci BIT(NL80211_BAND_6GHZ), 284662306a36Sopenharmony_ci .support_bw160 = true, 284762306a36Sopenharmony_ci .support_unii4 = true, 284862306a36Sopenharmony_ci .support_ul_tb_ctrl = false, 284962306a36Sopenharmony_ci .hw_sec_hdr = true, 285062306a36Sopenharmony_ci .rf_path_num = 2, 285162306a36Sopenharmony_ci .tx_nss = 2, 285262306a36Sopenharmony_ci .rx_nss = 2, 285362306a36Sopenharmony_ci .acam_num = 128, 285462306a36Sopenharmony_ci .bcam_num = 20, 285562306a36Sopenharmony_ci .scam_num = 128, 285662306a36Sopenharmony_ci .bacam_num = 8, 285762306a36Sopenharmony_ci .bacam_dynamic_num = 8, 285862306a36Sopenharmony_ci .bacam_ver = RTW89_BACAM_V0_EXT, 285962306a36Sopenharmony_ci .sec_ctrl_efuse_size = 4, 286062306a36Sopenharmony_ci .physical_efuse_size = 1216, 286162306a36Sopenharmony_ci .logical_efuse_size = 2048, 286262306a36Sopenharmony_ci .limit_efuse_size = 1280, 286362306a36Sopenharmony_ci .dav_phy_efuse_size = 96, 286462306a36Sopenharmony_ci .dav_log_efuse_size = 16, 286562306a36Sopenharmony_ci .phycap_addr = 0x590, 286662306a36Sopenharmony_ci .phycap_size = 0x60, 286762306a36Sopenharmony_ci .para_ver = 0x1, 286862306a36Sopenharmony_ci .wlcx_desired = 0x06000000, 286962306a36Sopenharmony_ci .btcx_desired = 0x7, 287062306a36Sopenharmony_ci .scbd = 0x1, 287162306a36Sopenharmony_ci .mailbox = 0x1, 287262306a36Sopenharmony_ci 287362306a36Sopenharmony_ci .afh_guard_ch = 6, 287462306a36Sopenharmony_ci .wl_rssi_thres = rtw89_btc_8852c_wl_rssi_thres, 287562306a36Sopenharmony_ci .bt_rssi_thres = rtw89_btc_8852c_bt_rssi_thres, 287662306a36Sopenharmony_ci .rssi_tol = 2, 287762306a36Sopenharmony_ci .mon_reg_num = ARRAY_SIZE(rtw89_btc_8852c_mon_reg), 287862306a36Sopenharmony_ci .mon_reg = rtw89_btc_8852c_mon_reg, 287962306a36Sopenharmony_ci .rf_para_ulink_num = ARRAY_SIZE(rtw89_btc_8852c_rf_ul), 288062306a36Sopenharmony_ci .rf_para_ulink = rtw89_btc_8852c_rf_ul, 288162306a36Sopenharmony_ci .rf_para_dlink_num = ARRAY_SIZE(rtw89_btc_8852c_rf_dl), 288262306a36Sopenharmony_ci .rf_para_dlink = rtw89_btc_8852c_rf_dl, 288362306a36Sopenharmony_ci .ps_mode_supported = BIT(RTW89_PS_MODE_RFOFF) | 288462306a36Sopenharmony_ci BIT(RTW89_PS_MODE_CLK_GATED) | 288562306a36Sopenharmony_ci BIT(RTW89_PS_MODE_PWR_GATED), 288662306a36Sopenharmony_ci .low_power_hci_modes = BIT(RTW89_PS_MODE_CLK_GATED) | 288762306a36Sopenharmony_ci BIT(RTW89_PS_MODE_PWR_GATED), 288862306a36Sopenharmony_ci .h2c_cctl_func_id = H2C_FUNC_MAC_CCTLINFO_UD_V1, 288962306a36Sopenharmony_ci .hci_func_en_addr = R_AX_HCI_FUNC_EN_V1, 289062306a36Sopenharmony_ci .h2c_desc_size = sizeof(struct rtw89_rxdesc_short), 289162306a36Sopenharmony_ci .txwd_body_size = sizeof(struct rtw89_txwd_body_v1), 289262306a36Sopenharmony_ci .h2c_ctrl_reg = R_AX_H2CREG_CTRL_V1, 289362306a36Sopenharmony_ci .h2c_counter_reg = {R_AX_UDM1 + 1, B_AX_UDM1_HALMAC_H2C_DEQ_CNT_MASK >> 8}, 289462306a36Sopenharmony_ci .h2c_regs = rtw8852c_h2c_regs, 289562306a36Sopenharmony_ci .c2h_ctrl_reg = R_AX_C2HREG_CTRL_V1, 289662306a36Sopenharmony_ci .c2h_counter_reg = {R_AX_UDM1 + 1, B_AX_UDM1_HALMAC_C2H_ENQ_CNT_MASK >> 8}, 289762306a36Sopenharmony_ci .c2h_regs = rtw8852c_c2h_regs, 289862306a36Sopenharmony_ci .page_regs = &rtw8852c_page_regs, 289962306a36Sopenharmony_ci .cfo_src_fd = false, 290062306a36Sopenharmony_ci .cfo_hw_comp = false, 290162306a36Sopenharmony_ci .dcfo_comp = &rtw8852c_dcfo_comp, 290262306a36Sopenharmony_ci .dcfo_comp_sft = 12, 290362306a36Sopenharmony_ci .imr_info = &rtw8852c_imr_info, 290462306a36Sopenharmony_ci .rrsr_cfgs = &rtw8852c_rrsr_cfgs, 290562306a36Sopenharmony_ci .bss_clr_map_reg = R_BSS_CLR_MAP, 290662306a36Sopenharmony_ci .dma_ch_mask = 0, 290762306a36Sopenharmony_ci .edcca_lvl_reg = R_SEG0R_EDCCA_LVL, 290862306a36Sopenharmony_ci#ifdef CONFIG_PM 290962306a36Sopenharmony_ci .wowlan_stub = &rtw_wowlan_stub_8852c, 291062306a36Sopenharmony_ci#endif 291162306a36Sopenharmony_ci .xtal_info = NULL, 291262306a36Sopenharmony_ci}; 291362306a36Sopenharmony_ciEXPORT_SYMBOL(rtw8852c_chip_info); 291462306a36Sopenharmony_ci 291562306a36Sopenharmony_ciMODULE_FIRMWARE(RTW8852C_MODULE_FIRMWARE); 291662306a36Sopenharmony_ciMODULE_AUTHOR("Realtek Corporation"); 291762306a36Sopenharmony_ciMODULE_DESCRIPTION("Realtek 802.11ax wireless 8852C driver"); 291862306a36Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL"); 2919