1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 2 /* Copyright(c) 2019-2022 Realtek Corporation 3 */ 4 5 #include "coex.h" 6 #include "debug.h" 7 #include "fw.h" 8 #include "mac.h" 9 #include "phy.h" 10 #include "reg.h" 11 #include "rtw8852c.h" 12 #include "rtw8852c_rfk.h" 13 #include "rtw8852c_table.h" 14 #include "util.h" 15 16 static const struct rtw89_hfc_ch_cfg rtw8852c_hfc_chcfg_pcie[] = { 17 {13, 1614, grp_0}, /* ACH 0 */ 18 {13, 1614, grp_0}, /* ACH 1 */ 19 {13, 1614, grp_0}, /* ACH 2 */ 20 {13, 1614, grp_0}, /* ACH 3 */ 21 {13, 1614, grp_1}, /* ACH 4 */ 22 {13, 1614, grp_1}, /* ACH 5 */ 23 {13, 1614, grp_1}, /* ACH 6 */ 24 {13, 1614, grp_1}, /* ACH 7 */ 25 {13, 1614, grp_0}, /* B0MGQ */ 26 {13, 1614, grp_0}, /* B0HIQ */ 27 {13, 1614, grp_1}, /* B1MGQ */ 28 {13, 1614, grp_1}, /* B1HIQ */ 29 {40, 0, 0} /* FWCMDQ */ 30 }; 31 32 static const struct rtw89_hfc_pub_cfg rtw8852c_hfc_pubcfg_pcie = { 33 1614, /* Group 0 */ 34 1614, /* Group 1 */ 35 3228, /* Public Max */ 36 0 /* WP threshold */ 37 }; 38 39 static const struct rtw89_hfc_param_ini rtw8852c_hfc_param_ini_pcie[] = { 40 [RTW89_QTA_SCC] = {rtw8852c_hfc_chcfg_pcie, &rtw8852c_hfc_pubcfg_pcie, 41 &rtw89_mac_size.hfc_preccfg_pcie, RTW89_HCIFC_POH}, 42 [RTW89_QTA_DLFW] = {NULL, NULL, &rtw89_mac_size.hfc_preccfg_pcie, 43 RTW89_HCIFC_POH}, 44 [RTW89_QTA_INVALID] = {NULL}, 45 }; 46 47 static const struct rtw89_dle_mem rtw8852c_dle_mem_pcie[] = { 48 [RTW89_QTA_SCC] = {RTW89_QTA_SCC, &rtw89_mac_size.wde_size19, 49 &rtw89_mac_size.ple_size19, &rtw89_mac_size.wde_qt18, 50 &rtw89_mac_size.wde_qt18, &rtw89_mac_size.ple_qt46, 51 &rtw89_mac_size.ple_qt47}, 52 [RTW89_QTA_DLFW] = {RTW89_QTA_DLFW, &rtw89_mac_size.wde_size18, 53 &rtw89_mac_size.ple_size18, &rtw89_mac_size.wde_qt17, 54 &rtw89_mac_size.wde_qt17, &rtw89_mac_size.ple_qt44, 55 &rtw89_mac_size.ple_qt45}, 56 [RTW89_QTA_INVALID] = {RTW89_QTA_INVALID, NULL, NULL, NULL, NULL, NULL, 57 NULL}, 58 }; 59 60 static const u32 rtw8852c_h2c_regs[RTW89_H2CREG_MAX] = { 61 R_AX_H2CREG_DATA0_V1, R_AX_H2CREG_DATA1_V1, R_AX_H2CREG_DATA2_V1, 62 R_AX_H2CREG_DATA3_V1 63 }; 64 65 static const u32 rtw8852c_c2h_regs[RTW89_H2CREG_MAX] = { 66 R_AX_C2HREG_DATA0_V1, R_AX_C2HREG_DATA1_V1, R_AX_C2HREG_DATA2_V1, 67 R_AX_C2HREG_DATA3_V1 68 }; 69 70 static const struct rtw89_page_regs rtw8852c_page_regs = { 71 .hci_fc_ctrl = R_AX_HCI_FC_CTRL_V1, 72 .ch_page_ctrl = R_AX_CH_PAGE_CTRL_V1, 73 .ach_page_ctrl = R_AX_ACH0_PAGE_CTRL_V1, 74 .ach_page_info = R_AX_ACH0_PAGE_INFO_V1, 75 .pub_page_info3 = R_AX_PUB_PAGE_INFO3_V1, 76 .pub_page_ctrl1 = R_AX_PUB_PAGE_CTRL1_V1, 77 .pub_page_ctrl2 = R_AX_PUB_PAGE_CTRL2_V1, 78 .pub_page_info1 = R_AX_PUB_PAGE_INFO1_V1, 79 .pub_page_info2 = R_AX_PUB_PAGE_INFO2_V1, 80 .wp_page_ctrl1 = R_AX_WP_PAGE_CTRL1_V1, 81 .wp_page_ctrl2 = R_AX_WP_PAGE_CTRL2_V1, 82 .wp_page_info1 = R_AX_WP_PAGE_INFO1_V1, 83 }; 84 85 static const struct rtw89_reg_def rtw8852c_dcfo_comp = { 86 R_DCFO_COMP_S0_V1, B_DCFO_COMP_S0_V1_MSK 87 }; 88 89 static const struct rtw89_imr_info rtw8852c_imr_info = { 90 .wdrls_imr_set = B_AX_WDRLS_IMR_SET_V1, 91 .wsec_imr_reg = R_AX_SEC_ERROR_FLAG_IMR, 92 .wsec_imr_set = B_AX_TX_HANG_IMR | B_AX_RX_HANG_IMR, 93 .mpdu_tx_imr_set = B_AX_MPDU_TX_IMR_SET_V1, 94 .mpdu_rx_imr_set = B_AX_MPDU_RX_IMR_SET_V1, 95 .sta_sch_imr_set = B_AX_STA_SCHEDULER_IMR_SET, 96 .txpktctl_imr_b0_reg = R_AX_TXPKTCTL_B0_ERRFLAG_IMR, 97 .txpktctl_imr_b0_clr = B_AX_TXPKTCTL_IMR_B0_CLR_V1, 98 .txpktctl_imr_b0_set = B_AX_TXPKTCTL_IMR_B0_SET_V1, 99 .txpktctl_imr_b1_reg = R_AX_TXPKTCTL_B1_ERRFLAG_IMR, 100 .txpktctl_imr_b1_clr = B_AX_TXPKTCTL_IMR_B1_CLR_V1, 101 .txpktctl_imr_b1_set = B_AX_TXPKTCTL_IMR_B1_SET_V1, 102 .wde_imr_clr = B_AX_WDE_IMR_CLR_V1, 103 .wde_imr_set = B_AX_WDE_IMR_SET_V1, 104 .ple_imr_clr = B_AX_PLE_IMR_CLR_V1, 105 .ple_imr_set = B_AX_PLE_IMR_SET_V1, 106 .host_disp_imr_clr = B_AX_HOST_DISP_IMR_CLR_V1, 107 .host_disp_imr_set = B_AX_HOST_DISP_IMR_SET_V1, 108 .cpu_disp_imr_clr = B_AX_CPU_DISP_IMR_CLR_V1, 109 .cpu_disp_imr_set = B_AX_CPU_DISP_IMR_SET_V1, 110 .other_disp_imr_clr = B_AX_OTHER_DISP_IMR_CLR_V1, 111 .other_disp_imr_set = B_AX_OTHER_DISP_IMR_SET_V1, 112 .bbrpt_chinfo_err_imr_reg = R_AX_BBRPT_CHINFO_ERR_IMR, 113 .bbrpt_err_imr_set = R_AX_BBRPT_CHINFO_IMR_SET_V1, 114 .bbrpt_dfs_err_imr_reg = R_AX_BBRPT_DFS_ERR_IMR, 115 .ptcl_imr_clr = B_AX_PTCL_IMR_CLR_V1, 116 .ptcl_imr_set = B_AX_PTCL_IMR_SET_V1, 117 .cdma_imr_0_reg = R_AX_RX_ERR_FLAG_IMR, 118 .cdma_imr_0_clr = B_AX_RX_ERR_IMR_CLR_V1, 119 .cdma_imr_0_set = B_AX_RX_ERR_IMR_SET_V1, 120 .cdma_imr_1_reg = R_AX_TX_ERR_FLAG_IMR, 121 .cdma_imr_1_clr = B_AX_TX_ERR_IMR_CLR_V1, 122 .cdma_imr_1_set = B_AX_TX_ERR_IMR_SET_V1, 123 .phy_intf_imr_reg = R_AX_PHYINFO_ERR_IMR_V1, 124 .phy_intf_imr_clr = B_AX_PHYINFO_IMR_CLR_V1, 125 .phy_intf_imr_set = B_AX_PHYINFO_IMR_SET_V1, 126 .rmac_imr_reg = R_AX_RX_ERR_IMR, 127 .rmac_imr_clr = B_AX_RMAC_IMR_CLR_V1, 128 .rmac_imr_set = B_AX_RMAC_IMR_SET_V1, 129 .tmac_imr_reg = R_AX_TRXPTCL_ERROR_INDICA_MASK, 130 .tmac_imr_clr = B_AX_TMAC_IMR_CLR_V1, 131 .tmac_imr_set = B_AX_TMAC_IMR_SET_V1, 132 }; 133 134 static void rtw8852c_ctrl_btg(struct rtw89_dev *rtwdev, bool btg); 135 136 static int rtw8852c_pwr_on_func(struct rtw89_dev *rtwdev) 137 { 138 u32 val32; 139 u32 ret; 140 141 val32 = rtw89_read32_mask(rtwdev, R_AX_SYS_STATUS1, B_AX_PAD_HCI_SEL_V2_MASK); 142 if (val32 == MAC_AX_HCI_SEL_PCIE_USB) 143 rtw89_write32_set(rtwdev, R_AX_LDO_AON_CTRL0, B_AX_PD_REGU_L); 144 145 rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_AFSM_WLSUS_EN | 146 B_AX_AFSM_PCIE_SUS_EN); 147 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_DIS_WLBT_PDNSUSEN_SOPC); 148 rtw89_write32_set(rtwdev, R_AX_WLLPS_CTRL, B_AX_DIS_WLBT_LPSEN_LOPC); 149 rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APDM_HPDN); 150 rtw89_write32_clr(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_SWLPS); 151 152 ret = read_poll_timeout(rtw89_read32, val32, val32 & B_AX_RDY_SYSPWR, 153 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 154 if (ret) 155 return ret; 156 157 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_EN_WLON); 158 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFN_ONMAC); 159 160 ret = read_poll_timeout(rtw89_read32, val32, !(val32 & B_AX_APFN_ONMAC), 161 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 162 if (ret) 163 return ret; 164 165 rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 166 rtw89_write8_clr(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 167 rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 168 rtw89_write8_clr(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 169 170 rtw89_write8_set(rtwdev, R_AX_PLATFORM_ENABLE, B_AX_PLATFORM_EN); 171 rtw89_write32_clr(rtwdev, R_AX_SYS_SDIO_CTRL, B_AX_PCIE_CALIB_EN_V1); 172 173 rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, B_AX_CMAC1_FEN); 174 rtw89_write32_set(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, B_AX_R_SYM_ISO_CMAC12PP); 175 rtw89_write32_clr(rtwdev, R_AX_AFE_CTRL1, B_AX_R_SYM_WLCMAC1_P4_PC_EN | 176 B_AX_R_SYM_WLCMAC1_P3_PC_EN | 177 B_AX_R_SYM_WLCMAC1_P2_PC_EN | 178 B_AX_R_SYM_WLCMAC1_P1_PC_EN | 179 B_AX_R_SYM_WLCMAC1_PC_EN); 180 rtw89_write32_set(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_PTA_1P3); 181 182 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 183 XTAL_SI_GND_SHDN_WL, XTAL_SI_GND_SHDN_WL); 184 if (ret) 185 return ret; 186 187 rtw89_write32_set(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_RFC_1P3); 188 189 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 190 XTAL_SI_SHDN_WL, XTAL_SI_SHDN_WL); 191 if (ret) 192 return ret; 193 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_OFF_WEI, 194 XTAL_SI_OFF_WEI); 195 if (ret) 196 return ret; 197 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_OFF_EI, 198 XTAL_SI_OFF_EI); 199 if (ret) 200 return ret; 201 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_RFC2RF); 202 if (ret) 203 return ret; 204 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_PON_WEI, 205 XTAL_SI_PON_WEI); 206 if (ret) 207 return ret; 208 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_PON_EI, 209 XTAL_SI_PON_EI); 210 if (ret) 211 return ret; 212 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_SRAM2RFC); 213 if (ret) 214 return ret; 215 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_XMD_2, 0, XTAL_SI_LDO_LPS); 216 if (ret) 217 return ret; 218 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_XMD_4, 0, XTAL_SI_LPS_CAP); 219 if (ret) 220 return ret; 221 222 rtw89_write32_set(rtwdev, R_AX_PMC_DBG_CTRL2, B_AX_SYSON_DIS_PMCR_AX_WRMSK); 223 rtw89_write32_set(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_ISO_EB2CORE); 224 rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_PWC_EV2EF_B15); 225 226 fsleep(1000); 227 228 rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL, B_AX_PWC_EV2EF_B14); 229 rtw89_write32_clr(rtwdev, R_AX_PMC_DBG_CTRL2, B_AX_SYSON_DIS_PMCR_AX_WRMSK); 230 rtw89_write32_set(rtwdev, R_AX_GPIO0_15_EECS_EESK_LED1_PULL_LOW_EN, 231 B_AX_EECS_PULL_LOW_EN | B_AX_EESK_PULL_LOW_EN | 232 B_AX_LED1_PULL_LOW_EN); 233 234 rtw89_write32_set(rtwdev, R_AX_DMAC_FUNC_EN, 235 B_AX_MAC_FUNC_EN | B_AX_DMAC_FUNC_EN | B_AX_MPDU_PROC_EN | 236 B_AX_WD_RLS_EN | B_AX_DLE_WDE_EN | B_AX_TXPKT_CTRL_EN | 237 B_AX_STA_SCH_EN | B_AX_DLE_PLE_EN | B_AX_PKT_BUF_EN | 238 B_AX_DMAC_TBL_EN | B_AX_PKT_IN_EN | B_AX_DLE_CPUIO_EN | 239 B_AX_DISPATCHER_EN | B_AX_BBRPT_EN | B_AX_MAC_SEC_EN | 240 B_AX_MAC_UN_EN | B_AX_H_AXIDMA_EN); 241 242 rtw89_write32_set(rtwdev, R_AX_CMAC_FUNC_EN, 243 B_AX_CMAC_EN | B_AX_CMAC_TXEN | B_AX_CMAC_RXEN | 244 B_AX_FORCE_CMACREG_GCKEN | B_AX_PHYINTF_EN | 245 B_AX_CMAC_DMA_EN | B_AX_PTCLTOP_EN | B_AX_SCHEDULER_EN | 246 B_AX_TMAC_EN | B_AX_RMAC_EN); 247 248 return 0; 249 } 250 251 static int rtw8852c_pwr_off_func(struct rtw89_dev *rtwdev) 252 { 253 u32 val32; 254 u32 ret; 255 256 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_RFC2RF, 257 XTAL_SI_RFC2RF); 258 if (ret) 259 return ret; 260 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_OFF_EI); 261 if (ret) 262 return ret; 263 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_OFF_WEI); 264 if (ret) 265 return ret; 266 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S0, 0, XTAL_SI_RF00); 267 if (ret) 268 return ret; 269 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S1, 0, XTAL_SI_RF10); 270 if (ret) 271 return ret; 272 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, XTAL_SI_SRAM2RFC, 273 XTAL_SI_SRAM2RFC); 274 if (ret) 275 return ret; 276 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_PON_EI); 277 if (ret) 278 return ret; 279 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_PON_WEI); 280 if (ret) 281 return ret; 282 283 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_EN_WLON); 284 rtw89_write8_clr(rtwdev, R_AX_SYS_FUNC_EN, B_AX_FEN_BB_GLB_RSTN | B_AX_FEN_BBRSTB); 285 rtw89_write32_clr(rtwdev, R_AX_SYS_ISO_CTRL_EXTEND, 286 B_AX_R_SYM_FEN_WLBBGLB_1 | B_AX_R_SYM_FEN_WLBBFUN_1); 287 rtw89_write32_clr(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_RFC_1P3); 288 289 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_SHDN_WL); 290 if (ret) 291 return ret; 292 293 rtw89_write32_clr(rtwdev, R_AX_SYS_ADIE_PAD_PWR_CTRL, B_AX_SYM_PADPDN_WL_PTA_1P3); 294 295 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0, XTAL_SI_GND_SHDN_WL); 296 if (ret) 297 return ret; 298 299 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_OFFMAC); 300 301 ret = read_poll_timeout(rtw89_read32, val32, !(val32 & B_AX_APFM_OFFMAC), 302 1000, 20000, false, rtwdev, R_AX_SYS_PW_CTRL); 303 if (ret) 304 return ret; 305 306 rtw89_write32(rtwdev, R_AX_WLLPS_CTRL, 0x0001A0B0); 307 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_XTAL_OFF_A_DIE); 308 rtw89_write32_set(rtwdev, R_AX_SYS_PW_CTRL, B_AX_APFM_SWLPS); 309 310 return 0; 311 } 312 313 static void rtw8852c_e_efuse_parsing(struct rtw89_efuse *efuse, 314 struct rtw8852c_efuse *map) 315 { 316 ether_addr_copy(efuse->addr, map->e.mac_addr); 317 efuse->rfe_type = map->rfe_type; 318 efuse->xtal_cap = map->xtal_k; 319 } 320 321 static void rtw8852c_efuse_parsing_tssi(struct rtw89_dev *rtwdev, 322 struct rtw8852c_efuse *map) 323 { 324 struct rtw89_tssi_info *tssi = &rtwdev->tssi; 325 struct rtw8852c_tssi_offset *ofst[] = {&map->path_a_tssi, &map->path_b_tssi}; 326 u8 *bw40_1s_tssi_6g_ofst[] = {map->bw40_1s_tssi_6g_a, map->bw40_1s_tssi_6g_b}; 327 u8 i, j; 328 329 tssi->thermal[RF_PATH_A] = map->path_a_therm; 330 tssi->thermal[RF_PATH_B] = map->path_b_therm; 331 332 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 333 memcpy(tssi->tssi_cck[i], ofst[i]->cck_tssi, 334 sizeof(ofst[i]->cck_tssi)); 335 336 for (j = 0; j < TSSI_CCK_CH_GROUP_NUM; j++) 337 rtw89_debug(rtwdev, RTW89_DBG_TSSI, 338 "[TSSI][EFUSE] path=%d cck[%d]=0x%x\n", 339 i, j, tssi->tssi_cck[i][j]); 340 341 memcpy(tssi->tssi_mcs[i], ofst[i]->bw40_tssi, 342 sizeof(ofst[i]->bw40_tssi)); 343 memcpy(tssi->tssi_mcs[i] + TSSI_MCS_2G_CH_GROUP_NUM, 344 ofst[i]->bw40_1s_tssi_5g, sizeof(ofst[i]->bw40_1s_tssi_5g)); 345 memcpy(tssi->tssi_6g_mcs[i], bw40_1s_tssi_6g_ofst[i], 346 sizeof(tssi->tssi_6g_mcs[i])); 347 348 for (j = 0; j < TSSI_MCS_CH_GROUP_NUM; j++) 349 rtw89_debug(rtwdev, RTW89_DBG_TSSI, 350 "[TSSI][EFUSE] path=%d mcs[%d]=0x%x\n", 351 i, j, tssi->tssi_mcs[i][j]); 352 } 353 } 354 355 static bool _decode_efuse_gain(u8 data, s8 *high, s8 *low) 356 { 357 if (high) 358 *high = sign_extend32(FIELD_GET(GENMASK(7, 4), data), 3); 359 if (low) 360 *low = sign_extend32(FIELD_GET(GENMASK(3, 0), data), 3); 361 362 return data != 0xff; 363 } 364 365 static void rtw8852c_efuse_parsing_gain_offset(struct rtw89_dev *rtwdev, 366 struct rtw8852c_efuse *map) 367 { 368 struct rtw89_phy_efuse_gain *gain = &rtwdev->efuse_gain; 369 bool valid = false; 370 371 valid |= _decode_efuse_gain(map->rx_gain_2g_cck, 372 &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_2G_CCK], 373 &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_2G_CCK]); 374 valid |= _decode_efuse_gain(map->rx_gain_2g_ofdm, 375 &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_2G_OFDM], 376 &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_2G_OFDM]); 377 valid |= _decode_efuse_gain(map->rx_gain_5g_low, 378 &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_LOW], 379 &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_LOW]); 380 valid |= _decode_efuse_gain(map->rx_gain_5g_mid, 381 &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_MID], 382 &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_MID]); 383 valid |= _decode_efuse_gain(map->rx_gain_5g_high, 384 &gain->offset[RF_PATH_A][RTW89_GAIN_OFFSET_5G_HIGH], 385 &gain->offset[RF_PATH_B][RTW89_GAIN_OFFSET_5G_HIGH]); 386 387 gain->offset_valid = valid; 388 } 389 390 static int rtw8852c_read_efuse(struct rtw89_dev *rtwdev, u8 *log_map) 391 { 392 struct rtw89_efuse *efuse = &rtwdev->efuse; 393 struct rtw8852c_efuse *map; 394 395 map = (struct rtw8852c_efuse *)log_map; 396 397 efuse->country_code[0] = map->country_code[0]; 398 efuse->country_code[1] = map->country_code[1]; 399 rtw8852c_efuse_parsing_tssi(rtwdev, map); 400 rtw8852c_efuse_parsing_gain_offset(rtwdev, map); 401 402 switch (rtwdev->hci.type) { 403 case RTW89_HCI_TYPE_PCIE: 404 rtw8852c_e_efuse_parsing(efuse, map); 405 break; 406 default: 407 return -ENOTSUPP; 408 } 409 410 rtw89_info(rtwdev, "chip rfe_type is %d\n", efuse->rfe_type); 411 412 return 0; 413 } 414 415 static void rtw8852c_phycap_parsing_tssi(struct rtw89_dev *rtwdev, u8 *phycap_map) 416 { 417 struct rtw89_tssi_info *tssi = &rtwdev->tssi; 418 static const u32 tssi_trim_addr[RF_PATH_NUM_8852C] = {0x5D6, 0x5AB}; 419 static const u32 tssi_trim_addr_6g[RF_PATH_NUM_8852C] = {0x5CE, 0x5A3}; 420 u32 addr = rtwdev->chip->phycap_addr; 421 bool pg = false; 422 u32 ofst; 423 u8 i, j; 424 425 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 426 for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM; j++) { 427 /* addrs are in decreasing order */ 428 ofst = tssi_trim_addr[i] - addr - j; 429 tssi->tssi_trim[i][j] = phycap_map[ofst]; 430 431 if (phycap_map[ofst] != 0xff) 432 pg = true; 433 } 434 435 for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM_6G; j++) { 436 /* addrs are in decreasing order */ 437 ofst = tssi_trim_addr_6g[i] - addr - j; 438 tssi->tssi_trim_6g[i][j] = phycap_map[ofst]; 439 440 if (phycap_map[ofst] != 0xff) 441 pg = true; 442 } 443 } 444 445 if (!pg) { 446 memset(tssi->tssi_trim, 0, sizeof(tssi->tssi_trim)); 447 memset(tssi->tssi_trim_6g, 0, sizeof(tssi->tssi_trim_6g)); 448 rtw89_debug(rtwdev, RTW89_DBG_TSSI, 449 "[TSSI][TRIM] no PG, set all trim info to 0\n"); 450 } 451 452 for (i = 0; i < RF_PATH_NUM_8852C; i++) 453 for (j = 0; j < TSSI_TRIM_CH_GROUP_NUM; j++) 454 rtw89_debug(rtwdev, RTW89_DBG_TSSI, 455 "[TSSI] path=%d idx=%d trim=0x%x addr=0x%x\n", 456 i, j, tssi->tssi_trim[i][j], 457 tssi_trim_addr[i] - j); 458 } 459 460 static void rtw8852c_phycap_parsing_thermal_trim(struct rtw89_dev *rtwdev, 461 u8 *phycap_map) 462 { 463 struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 464 static const u32 thm_trim_addr[RF_PATH_NUM_8852C] = {0x5DF, 0x5DC}; 465 u32 addr = rtwdev->chip->phycap_addr; 466 u8 i; 467 468 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 469 info->thermal_trim[i] = phycap_map[thm_trim_addr[i] - addr]; 470 471 rtw89_debug(rtwdev, RTW89_DBG_RFK, 472 "[THERMAL][TRIM] path=%d thermal_trim=0x%x\n", 473 i, info->thermal_trim[i]); 474 475 if (info->thermal_trim[i] != 0xff) 476 info->pg_thermal_trim = true; 477 } 478 } 479 480 static void rtw8852c_thermal_trim(struct rtw89_dev *rtwdev) 481 { 482 #define __thm_setting(raw) \ 483 ({ \ 484 u8 __v = (raw); \ 485 ((__v & 0x1) << 3) | ((__v & 0x1f) >> 1); \ 486 }) 487 struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 488 u8 i, val; 489 490 if (!info->pg_thermal_trim) { 491 rtw89_debug(rtwdev, RTW89_DBG_RFK, 492 "[THERMAL][TRIM] no PG, do nothing\n"); 493 494 return; 495 } 496 497 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 498 val = __thm_setting(info->thermal_trim[i]); 499 rtw89_write_rf(rtwdev, i, RR_TM2, RR_TM2_OFF, val); 500 501 rtw89_debug(rtwdev, RTW89_DBG_RFK, 502 "[THERMAL][TRIM] path=%d thermal_setting=0x%x\n", 503 i, val); 504 } 505 #undef __thm_setting 506 } 507 508 static void rtw8852c_phycap_parsing_pa_bias_trim(struct rtw89_dev *rtwdev, 509 u8 *phycap_map) 510 { 511 struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 512 static const u32 pabias_trim_addr[RF_PATH_NUM_8852C] = {0x5DE, 0x5DB}; 513 u32 addr = rtwdev->chip->phycap_addr; 514 u8 i; 515 516 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 517 info->pa_bias_trim[i] = phycap_map[pabias_trim_addr[i] - addr]; 518 519 rtw89_debug(rtwdev, RTW89_DBG_RFK, 520 "[PA_BIAS][TRIM] path=%d pa_bias_trim=0x%x\n", 521 i, info->pa_bias_trim[i]); 522 523 if (info->pa_bias_trim[i] != 0xff) 524 info->pg_pa_bias_trim = true; 525 } 526 } 527 528 static void rtw8852c_pa_bias_trim(struct rtw89_dev *rtwdev) 529 { 530 struct rtw89_power_trim_info *info = &rtwdev->pwr_trim; 531 u8 pabias_2g, pabias_5g; 532 u8 i; 533 534 if (!info->pg_pa_bias_trim) { 535 rtw89_debug(rtwdev, RTW89_DBG_RFK, 536 "[PA_BIAS][TRIM] no PG, do nothing\n"); 537 538 return; 539 } 540 541 for (i = 0; i < RF_PATH_NUM_8852C; i++) { 542 pabias_2g = FIELD_GET(GENMASK(3, 0), info->pa_bias_trim[i]); 543 pabias_5g = FIELD_GET(GENMASK(7, 4), info->pa_bias_trim[i]); 544 545 rtw89_debug(rtwdev, RTW89_DBG_RFK, 546 "[PA_BIAS][TRIM] path=%d 2G=0x%x 5G=0x%x\n", 547 i, pabias_2g, pabias_5g); 548 549 rtw89_write_rf(rtwdev, i, RR_BIASA, RR_BIASA_TXG, pabias_2g); 550 rtw89_write_rf(rtwdev, i, RR_BIASA, RR_BIASA_TXA, pabias_5g); 551 } 552 } 553 554 static int rtw8852c_read_phycap(struct rtw89_dev *rtwdev, u8 *phycap_map) 555 { 556 rtw8852c_phycap_parsing_tssi(rtwdev, phycap_map); 557 rtw8852c_phycap_parsing_thermal_trim(rtwdev, phycap_map); 558 rtw8852c_phycap_parsing_pa_bias_trim(rtwdev, phycap_map); 559 560 return 0; 561 } 562 563 static void rtw8852c_power_trim(struct rtw89_dev *rtwdev) 564 { 565 rtw8852c_thermal_trim(rtwdev); 566 rtw8852c_pa_bias_trim(rtwdev); 567 } 568 569 static void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev, 570 struct rtw89_channel_params *param, 571 u8 mac_idx) 572 { 573 u32 rf_mod = rtw89_mac_reg_by_idx(R_AX_WMAC_RFMOD, mac_idx); 574 u32 sub_carr = rtw89_mac_reg_by_idx(R_AX_TX_SUB_CARRIER_VALUE, 575 mac_idx); 576 u32 chk_rate = rtw89_mac_reg_by_idx(R_AX_TXRATE_CHK, mac_idx); 577 u8 txsc20 = 0, txsc40 = 0, txsc80 = 0; 578 u8 rf_mod_val = 0, chk_rate_mask = 0; 579 u32 txsc; 580 581 switch (param->bandwidth) { 582 case RTW89_CHANNEL_WIDTH_160: 583 txsc80 = rtw89_phy_get_txsc(rtwdev, param, 584 RTW89_CHANNEL_WIDTH_80); 585 fallthrough; 586 case RTW89_CHANNEL_WIDTH_80: 587 txsc40 = rtw89_phy_get_txsc(rtwdev, param, 588 RTW89_CHANNEL_WIDTH_40); 589 fallthrough; 590 case RTW89_CHANNEL_WIDTH_40: 591 txsc20 = rtw89_phy_get_txsc(rtwdev, param, 592 RTW89_CHANNEL_WIDTH_20); 593 break; 594 default: 595 break; 596 } 597 598 switch (param->bandwidth) { 599 case RTW89_CHANNEL_WIDTH_160: 600 rf_mod_val = AX_WMAC_RFMOD_160M; 601 txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20) | 602 FIELD_PREP(B_AX_TXSC_40M_MASK, txsc40) | 603 FIELD_PREP(B_AX_TXSC_80M_MASK, txsc80); 604 break; 605 case RTW89_CHANNEL_WIDTH_80: 606 rf_mod_val = AX_WMAC_RFMOD_80M; 607 txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20) | 608 FIELD_PREP(B_AX_TXSC_40M_MASK, txsc40); 609 break; 610 case RTW89_CHANNEL_WIDTH_40: 611 rf_mod_val = AX_WMAC_RFMOD_40M; 612 txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20); 613 break; 614 case RTW89_CHANNEL_WIDTH_20: 615 default: 616 rf_mod_val = AX_WMAC_RFMOD_20M; 617 txsc = 0; 618 break; 619 } 620 rtw89_write8_mask(rtwdev, rf_mod, B_AX_WMAC_RFMOD_MASK, rf_mod_val); 621 rtw89_write32(rtwdev, sub_carr, txsc); 622 623 switch (param->band_type) { 624 case RTW89_BAND_2G: 625 chk_rate_mask = B_AX_BAND_MODE; 626 break; 627 case RTW89_BAND_5G: 628 case RTW89_BAND_6G: 629 chk_rate_mask = B_AX_CHECK_CCK_EN | B_AX_RTS_LIMIT_IN_OFDM6; 630 break; 631 default: 632 rtw89_warn(rtwdev, "Invalid band_type:%d\n", param->band_type); 633 return; 634 } 635 rtw89_write8_clr(rtwdev, chk_rate, B_AX_BAND_MODE | B_AX_CHECK_CCK_EN | 636 B_AX_RTS_LIMIT_IN_OFDM6); 637 rtw89_write8_set(rtwdev, chk_rate, chk_rate_mask); 638 } 639 640 static const u32 rtw8852c_sco_barker_threshold[14] = { 641 0x1fe4f, 0x1ff5e, 0x2006c, 0x2017b, 0x2028a, 0x20399, 0x204a8, 0x205b6, 642 0x206c5, 0x207d4, 0x208e3, 0x209f2, 0x20b00, 0x20d8a 643 }; 644 645 static const u32 rtw8852c_sco_cck_threshold[14] = { 646 0x2bdac, 0x2bf21, 0x2c095, 0x2c209, 0x2c37e, 0x2c4f2, 0x2c666, 0x2c7db, 647 0x2c94f, 0x2cac3, 0x2cc38, 0x2cdac, 0x2cf21, 0x2d29e 648 }; 649 650 static int rtw8852c_ctrl_sco_cck(struct rtw89_dev *rtwdev, u8 central_ch, 651 u8 primary_ch, enum rtw89_bandwidth bw) 652 { 653 u8 ch_element; 654 655 if (bw == RTW89_CHANNEL_WIDTH_20) { 656 ch_element = central_ch - 1; 657 } else if (bw == RTW89_CHANNEL_WIDTH_40) { 658 if (primary_ch == 1) 659 ch_element = central_ch - 1 + 2; 660 else 661 ch_element = central_ch - 1 - 2; 662 } else { 663 rtw89_warn(rtwdev, "Invalid BW:%d for CCK\n", bw); 664 return -EINVAL; 665 } 666 rtw89_phy_write32_mask(rtwdev, R_BK_FC0_INV_V1, B_BK_FC0_INV_MSK_V1, 667 rtw8852c_sco_barker_threshold[ch_element]); 668 rtw89_phy_write32_mask(rtwdev, R_CCK_FC0_INV_V1, B_CCK_FC0_INV_MSK_V1, 669 rtw8852c_sco_cck_threshold[ch_element]); 670 671 return 0; 672 } 673 674 struct rtw8852c_bb_gain { 675 u32 gain_g[BB_PATH_NUM_8852C]; 676 u32 gain_a[BB_PATH_NUM_8852C]; 677 u32 gain_mask; 678 }; 679 680 static const struct rtw8852c_bb_gain bb_gain_lna[LNA_GAIN_NUM] = { 681 { .gain_g = {0x4678, 0x475C}, .gain_a = {0x45DC, 0x4740}, 682 .gain_mask = 0x00ff0000 }, 683 { .gain_g = {0x4678, 0x475C}, .gain_a = {0x45DC, 0x4740}, 684 .gain_mask = 0xff000000 }, 685 { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 686 .gain_mask = 0x000000ff }, 687 { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 688 .gain_mask = 0x0000ff00 }, 689 { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 690 .gain_mask = 0x00ff0000 }, 691 { .gain_g = {0x467C, 0x4760}, .gain_a = {0x4660, 0x4744}, 692 .gain_mask = 0xff000000 }, 693 { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 694 .gain_mask = 0x000000ff }, 695 }; 696 697 static const struct rtw8852c_bb_gain bb_gain_tia[TIA_GAIN_NUM] = { 698 { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 699 .gain_mask = 0x00ff0000 }, 700 { .gain_g = {0x4680, 0x4764}, .gain_a = {0x4664, 0x4748}, 701 .gain_mask = 0xff000000 }, 702 }; 703 704 struct rtw8852c_bb_gain_bypass { 705 u32 gain_g[BB_PATH_NUM_8852C]; 706 u32 gain_a[BB_PATH_NUM_8852C]; 707 u32 gain_mask_g; 708 u32 gain_mask_a; 709 }; 710 711 static 712 const struct rtw8852c_bb_gain_bypass bb_gain_bypass_lna[LNA_GAIN_NUM] = { 713 { .gain_g = {0x4BB8, 0x4C7C}, .gain_a = {0x4BB4, 0x4C78}, 714 .gain_mask_g = 0xff000000, .gain_mask_a = 0xff}, 715 { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 716 .gain_mask_g = 0xff, .gain_mask_a = 0xff00}, 717 { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 718 .gain_mask_g = 0xff00, .gain_mask_a = 0xff0000}, 719 { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB4, 0x4C78}, 720 .gain_mask_g = 0xff0000, .gain_mask_a = 0xff000000}, 721 { .gain_g = {0x4BBC, 0x4C80}, .gain_a = {0x4BB8, 0x4C7C}, 722 .gain_mask_g = 0xff000000, .gain_mask_a = 0xff}, 723 { .gain_g = {0x4BC0, 0x4C84}, .gain_a = {0x4BB8, 0x4C7C}, 724 .gain_mask_g = 0xff, .gain_mask_a = 0xff00}, 725 { .gain_g = {0x4BC0, 0x4C84}, .gain_a = {0x4BB8, 0x4C7C}, 726 .gain_mask_g = 0xff00, .gain_mask_a = 0xff0000}, 727 }; 728 729 struct rtw8852c_bb_gain_op1db { 730 struct { 731 u32 lna[BB_PATH_NUM_8852C]; 732 u32 tia_lna[BB_PATH_NUM_8852C]; 733 u32 mask; 734 } reg[LNA_GAIN_NUM]; 735 u32 reg_tia0_lna6[BB_PATH_NUM_8852C]; 736 u32 mask_tia0_lna6; 737 }; 738 739 static const struct rtw8852c_bb_gain_op1db bb_gain_op1db_a = { 740 .reg = { 741 { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 742 .mask = 0xff}, 743 { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 744 .mask = 0xff00}, 745 { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 746 .mask = 0xff0000}, 747 { .lna = {0x4668, 0x474c}, .tia_lna = {0x4670, 0x4754}, 748 .mask = 0xff000000}, 749 { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 750 .mask = 0xff}, 751 { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 752 .mask = 0xff00}, 753 { .lna = {0x466c, 0x4750}, .tia_lna = {0x4674, 0x4758}, 754 .mask = 0xff0000}, 755 }, 756 .reg_tia0_lna6 = {0x4674, 0x4758}, 757 .mask_tia0_lna6 = 0xff000000, 758 }; 759 760 static enum rtw89_phy_bb_gain_band 761 rtw8852c_mapping_gain_band(enum rtw89_subband subband) 762 { 763 switch (subband) { 764 default: 765 case RTW89_CH_2G: 766 return RTW89_BB_GAIN_BAND_2G; 767 case RTW89_CH_5G_BAND_1: 768 return RTW89_BB_GAIN_BAND_5G_L; 769 case RTW89_CH_5G_BAND_3: 770 return RTW89_BB_GAIN_BAND_5G_M; 771 case RTW89_CH_5G_BAND_4: 772 return RTW89_BB_GAIN_BAND_5G_H; 773 case RTW89_CH_6G_BAND_IDX0: 774 case RTW89_CH_6G_BAND_IDX1: 775 return RTW89_BB_GAIN_BAND_6G_L; 776 case RTW89_CH_6G_BAND_IDX2: 777 case RTW89_CH_6G_BAND_IDX3: 778 return RTW89_BB_GAIN_BAND_6G_M; 779 case RTW89_CH_6G_BAND_IDX4: 780 case RTW89_CH_6G_BAND_IDX5: 781 return RTW89_BB_GAIN_BAND_6G_H; 782 case RTW89_CH_6G_BAND_IDX6: 783 case RTW89_CH_6G_BAND_IDX7: 784 return RTW89_BB_GAIN_BAND_6G_UH; 785 } 786 } 787 788 static void rtw8852c_set_gain_error(struct rtw89_dev *rtwdev, 789 enum rtw89_subband subband, 790 enum rtw89_rf_path path) 791 { 792 const struct rtw89_phy_bb_gain_info *gain = &rtwdev->bb_gain; 793 u8 gain_band = rtw8852c_mapping_gain_band(subband); 794 s32 val; 795 u32 reg; 796 u32 mask; 797 int i; 798 799 for (i = 0; i < LNA_GAIN_NUM; i++) { 800 if (subband == RTW89_CH_2G) 801 reg = bb_gain_lna[i].gain_g[path]; 802 else 803 reg = bb_gain_lna[i].gain_a[path]; 804 805 mask = bb_gain_lna[i].gain_mask; 806 val = gain->lna_gain[gain_band][path][i]; 807 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 808 809 if (subband == RTW89_CH_2G) { 810 reg = bb_gain_bypass_lna[i].gain_g[path]; 811 mask = bb_gain_bypass_lna[i].gain_mask_g; 812 } else { 813 reg = bb_gain_bypass_lna[i].gain_a[path]; 814 mask = bb_gain_bypass_lna[i].gain_mask_a; 815 } 816 817 val = gain->lna_gain_bypass[gain_band][path][i]; 818 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 819 820 if (subband != RTW89_CH_2G) { 821 reg = bb_gain_op1db_a.reg[i].lna[path]; 822 mask = bb_gain_op1db_a.reg[i].mask; 823 val = gain->lna_op1db[gain_band][path][i]; 824 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 825 826 reg = bb_gain_op1db_a.reg[i].tia_lna[path]; 827 mask = bb_gain_op1db_a.reg[i].mask; 828 val = gain->tia_lna_op1db[gain_band][path][i]; 829 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 830 } 831 } 832 833 if (subband != RTW89_CH_2G) { 834 reg = bb_gain_op1db_a.reg_tia0_lna6[path]; 835 mask = bb_gain_op1db_a.mask_tia0_lna6; 836 val = gain->tia_lna_op1db[gain_band][path][7]; 837 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 838 } 839 840 for (i = 0; i < TIA_GAIN_NUM; i++) { 841 if (subband == RTW89_CH_2G) 842 reg = bb_gain_tia[i].gain_g[path]; 843 else 844 reg = bb_gain_tia[i].gain_a[path]; 845 846 mask = bb_gain_tia[i].gain_mask; 847 val = gain->tia_gain[gain_band][path][i]; 848 rtw89_phy_write32_mask(rtwdev, reg, mask, val); 849 } 850 } 851 852 static 853 const u8 rtw8852c_ch_base_table[16] = {1, 0xff, 854 36, 100, 132, 149, 0xff, 855 1, 33, 65, 97, 129, 161, 193, 225, 0xff}; 856 #define RTW8852C_CH_BASE_IDX_2G 0 857 #define RTW8852C_CH_BASE_IDX_5G_FIRST 2 858 #define RTW8852C_CH_BASE_IDX_5G_LAST 5 859 #define RTW8852C_CH_BASE_IDX_6G_FIRST 7 860 #define RTW8852C_CH_BASE_IDX_6G_LAST 14 861 862 #define RTW8852C_CH_BASE_IDX_MASK GENMASK(7, 4) 863 #define RTW8852C_CH_OFFSET_MASK GENMASK(3, 0) 864 865 static u8 rtw8852c_encode_chan_idx(struct rtw89_dev *rtwdev, u8 central_ch, u8 band) 866 { 867 u8 chan_idx; 868 u8 last, first; 869 u8 idx; 870 871 switch (band) { 872 case RTW89_BAND_2G: 873 chan_idx = FIELD_PREP(RTW8852C_CH_BASE_IDX_MASK, RTW8852C_CH_BASE_IDX_2G) | 874 FIELD_PREP(RTW8852C_CH_OFFSET_MASK, central_ch); 875 return chan_idx; 876 case RTW89_BAND_5G: 877 first = RTW8852C_CH_BASE_IDX_5G_FIRST; 878 last = RTW8852C_CH_BASE_IDX_5G_LAST; 879 break; 880 case RTW89_BAND_6G: 881 first = RTW8852C_CH_BASE_IDX_6G_FIRST; 882 last = RTW8852C_CH_BASE_IDX_6G_LAST; 883 break; 884 default: 885 rtw89_warn(rtwdev, "Unsupported band %d\n", band); 886 return 0; 887 } 888 889 for (idx = last; idx >= first; idx--) 890 if (central_ch >= rtw8852c_ch_base_table[idx]) 891 break; 892 893 if (idx < first) { 894 rtw89_warn(rtwdev, "Unknown band %d channel %d\n", band, central_ch); 895 return 0; 896 } 897 898 chan_idx = FIELD_PREP(RTW8852C_CH_BASE_IDX_MASK, idx) | 899 FIELD_PREP(RTW8852C_CH_OFFSET_MASK, 900 (central_ch - rtw8852c_ch_base_table[idx]) >> 1); 901 return chan_idx; 902 } 903 904 static void rtw8852c_decode_chan_idx(struct rtw89_dev *rtwdev, u8 chan_idx, 905 u8 *ch, enum nl80211_band *band) 906 { 907 u8 idx, offset; 908 909 idx = FIELD_GET(RTW8852C_CH_BASE_IDX_MASK, chan_idx); 910 offset = FIELD_GET(RTW8852C_CH_OFFSET_MASK, chan_idx); 911 912 if (idx == RTW8852C_CH_BASE_IDX_2G) { 913 *band = NL80211_BAND_2GHZ; 914 *ch = offset; 915 return; 916 } 917 918 *band = idx <= RTW8852C_CH_BASE_IDX_5G_LAST ? NL80211_BAND_5GHZ : NL80211_BAND_6GHZ; 919 *ch = rtw8852c_ch_base_table[idx] + (offset << 1); 920 } 921 922 static void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev, 923 const struct rtw89_channel_params *param, 924 enum rtw89_phy_idx phy_idx, 925 enum rtw89_rf_path path) 926 { 927 static const u32 rssi_ofst_addr[2] = {R_PATH0_G_TIA0_LNA6_OP1DB_V1, 928 R_PATH1_G_TIA0_LNA6_OP1DB_V1}; 929 static const u32 rpl_mask[2] = {B_RPL_PATHA_MASK, B_RPL_PATHB_MASK}; 930 static const u32 rpl_tb_mask[2] = {B_RSSI_M_PATHA_MASK, B_RSSI_M_PATHB_MASK}; 931 struct rtw89_phy_efuse_gain *efuse_gain = &rtwdev->efuse_gain; 932 enum rtw89_gain_offset gain_band; 933 s32 offset_q0, offset_base_q4; 934 s32 tmp = 0; 935 936 if (!efuse_gain->offset_valid) 937 return; 938 939 if (rtwdev->dbcc_en && path == RF_PATH_B) 940 phy_idx = RTW89_PHY_1; 941 942 if (param->band_type == RTW89_BAND_2G) { 943 offset_q0 = efuse_gain->offset[path][RTW89_GAIN_OFFSET_2G_CCK]; 944 offset_base_q4 = efuse_gain->offset_base[phy_idx]; 945 946 tmp = clamp_t(s32, (-offset_q0 << 3) + (offset_base_q4 >> 1), 947 S8_MIN >> 1, S8_MAX >> 1); 948 rtw89_phy_write32_mask(rtwdev, R_RPL_OFST, B_RPL_OFST_MASK, tmp & 0x7f); 949 } 950 951 switch (param->subband_type) { 952 default: 953 case RTW89_CH_2G: 954 gain_band = RTW89_GAIN_OFFSET_2G_OFDM; 955 break; 956 case RTW89_CH_5G_BAND_1: 957 gain_band = RTW89_GAIN_OFFSET_5G_LOW; 958 break; 959 case RTW89_CH_5G_BAND_3: 960 gain_band = RTW89_GAIN_OFFSET_5G_MID; 961 break; 962 case RTW89_CH_5G_BAND_4: 963 gain_band = RTW89_GAIN_OFFSET_5G_HIGH; 964 break; 965 } 966 967 offset_q0 = -efuse_gain->offset[path][gain_band]; 968 offset_base_q4 = efuse_gain->offset_base[phy_idx]; 969 970 tmp = (offset_q0 << 2) + (offset_base_q4 >> 2); 971 tmp = clamp_t(s32, -tmp, S8_MIN, S8_MAX); 972 rtw89_phy_write32_mask(rtwdev, rssi_ofst_addr[path], B_PATH0_R_G_OFST_MASK, tmp & 0xff); 973 974 tmp = clamp_t(s32, offset_q0 << 4, S8_MIN, S8_MAX); 975 rtw89_phy_write32_idx(rtwdev, R_RPL_PATHAB, rpl_mask[path], tmp & 0xff, phy_idx); 976 rtw89_phy_write32_idx(rtwdev, R_RSSI_M_PATHAB, rpl_tb_mask[path], tmp & 0xff, phy_idx); 977 } 978 979 static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev, 980 const struct rtw89_channel_params *param, 981 enum rtw89_phy_idx phy_idx) 982 { 983 u8 sco; 984 u16 central_freq = param->center_freq; 985 u8 central_ch = param->center_chan; 986 u8 band = param->band_type; 987 u8 subband = param->subband_type; 988 bool is_2g = band == RTW89_BAND_2G; 989 u8 chan_idx; 990 991 if (!central_freq) { 992 rtw89_warn(rtwdev, "Invalid central_freq\n"); 993 return; 994 } 995 996 if (phy_idx == RTW89_PHY_0) { 997 /* Path A */ 998 rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_A); 999 rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_A); 1000 1001 if (is_2g) 1002 rtw89_phy_write32_idx(rtwdev, R_PATH0_BAND_SEL_V1, 1003 B_PATH0_BAND_SEL_MSK_V1, 1, 1004 phy_idx); 1005 else 1006 rtw89_phy_write32_idx(rtwdev, R_PATH0_BAND_SEL_V1, 1007 B_PATH0_BAND_SEL_MSK_V1, 0, 1008 phy_idx); 1009 /* Path B */ 1010 if (!rtwdev->dbcc_en) { 1011 rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B); 1012 rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_B); 1013 1014 if (is_2g) 1015 rtw89_phy_write32_idx(rtwdev, 1016 R_PATH1_BAND_SEL_V1, 1017 B_PATH1_BAND_SEL_MSK_V1, 1018 1, phy_idx); 1019 else 1020 rtw89_phy_write32_idx(rtwdev, 1021 R_PATH1_BAND_SEL_V1, 1022 B_PATH1_BAND_SEL_MSK_V1, 1023 0, phy_idx); 1024 rtw89_phy_write32_clr(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 1025 } else { 1026 if (is_2g) 1027 rtw89_phy_write32_clr(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 1028 else 1029 rtw89_phy_write32_set(rtwdev, R_2P4G_BAND, B_2P4G_BAND_SEL); 1030 } 1031 /* SCO compensate FC setting */ 1032 rtw89_phy_write32_idx(rtwdev, R_FC0_V1, B_FC0_MSK_V1, 1033 central_freq, phy_idx); 1034 /* round_up((1/fc0)*pow(2,18)) */ 1035 sco = DIV_ROUND_CLOSEST(1 << 18, central_freq); 1036 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_INV, sco, 1037 phy_idx); 1038 } else { 1039 /* Path B */ 1040 rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B); 1041 rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_B); 1042 1043 if (is_2g) 1044 rtw89_phy_write32_idx(rtwdev, R_PATH1_BAND_SEL_V1, 1045 B_PATH1_BAND_SEL_MSK_V1, 1046 1, phy_idx); 1047 else 1048 rtw89_phy_write32_idx(rtwdev, R_PATH1_BAND_SEL_V1, 1049 B_PATH1_BAND_SEL_MSK_V1, 1050 0, phy_idx); 1051 /* SCO compensate FC setting */ 1052 rtw89_phy_write32_idx(rtwdev, R_FC0_V1, B_FC0_MSK_V1, 1053 central_freq, phy_idx); 1054 /* round_up((1/fc0)*pow(2,18)) */ 1055 sco = DIV_ROUND_CLOSEST(1 << 18, central_freq); 1056 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_INV, sco, 1057 phy_idx); 1058 } 1059 /* CCK parameters */ 1060 if (band == RTW89_BAND_2G) { 1061 if (central_ch == 14) { 1062 rtw89_phy_write32_mask(rtwdev, R_PCOEFF0_V1, 1063 B_PCOEFF01_MSK_V1, 0x3b13ff); 1064 rtw89_phy_write32_mask(rtwdev, R_PCOEFF2_V1, 1065 B_PCOEFF23_MSK_V1, 0x1c42de); 1066 rtw89_phy_write32_mask(rtwdev, R_PCOEFF4_V1, 1067 B_PCOEFF45_MSK_V1, 0xfdb0ad); 1068 rtw89_phy_write32_mask(rtwdev, R_PCOEFF6_V1, 1069 B_PCOEFF67_MSK_V1, 0xf60f6e); 1070 rtw89_phy_write32_mask(rtwdev, R_PCOEFF8_V1, 1071 B_PCOEFF89_MSK_V1, 0xfd8f92); 1072 rtw89_phy_write32_mask(rtwdev, R_PCOEFFA_V1, 1073 B_PCOEFFAB_MSK_V1, 0x2d011); 1074 rtw89_phy_write32_mask(rtwdev, R_PCOEFFC_V1, 1075 B_PCOEFFCD_MSK_V1, 0x1c02c); 1076 rtw89_phy_write32_mask(rtwdev, R_PCOEFFE_V1, 1077 B_PCOEFFEF_MSK_V1, 0xfff00a); 1078 } else { 1079 rtw89_phy_write32_mask(rtwdev, R_PCOEFF0_V1, 1080 B_PCOEFF01_MSK_V1, 0x3d23ff); 1081 rtw89_phy_write32_mask(rtwdev, R_PCOEFF2_V1, 1082 B_PCOEFF23_MSK_V1, 0x29b354); 1083 rtw89_phy_write32_mask(rtwdev, R_PCOEFF4_V1, 1084 B_PCOEFF45_MSK_V1, 0xfc1c8); 1085 rtw89_phy_write32_mask(rtwdev, R_PCOEFF6_V1, 1086 B_PCOEFF67_MSK_V1, 0xfdb053); 1087 rtw89_phy_write32_mask(rtwdev, R_PCOEFF8_V1, 1088 B_PCOEFF89_MSK_V1, 0xf86f9a); 1089 rtw89_phy_write32_mask(rtwdev, R_PCOEFFA_V1, 1090 B_PCOEFFAB_MSK_V1, 0xfaef92); 1091 rtw89_phy_write32_mask(rtwdev, R_PCOEFFC_V1, 1092 B_PCOEFFCD_MSK_V1, 0xfe5fcc); 1093 rtw89_phy_write32_mask(rtwdev, R_PCOEFFE_V1, 1094 B_PCOEFFEF_MSK_V1, 0xffdff5); 1095 } 1096 } 1097 1098 chan_idx = rtw8852c_encode_chan_idx(rtwdev, param->primary_chan, band); 1099 rtw89_phy_write32_idx(rtwdev, R_MAC_PIN_SEL, B_CH_IDX_SEG0, chan_idx, phy_idx); 1100 } 1101 1102 static void rtw8852c_bw_setting(struct rtw89_dev *rtwdev, u8 bw, u8 path) 1103 { 1104 static const u32 adc_sel[2] = {0xC0EC, 0xC1EC}; 1105 static const u32 wbadc_sel[2] = {0xC0E4, 0xC1E4}; 1106 1107 switch (bw) { 1108 case RTW89_CHANNEL_WIDTH_5: 1109 rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x1); 1110 rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x0); 1111 break; 1112 case RTW89_CHANNEL_WIDTH_10: 1113 rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x2); 1114 rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x1); 1115 break; 1116 case RTW89_CHANNEL_WIDTH_20: 1117 case RTW89_CHANNEL_WIDTH_40: 1118 case RTW89_CHANNEL_WIDTH_80: 1119 case RTW89_CHANNEL_WIDTH_160: 1120 rtw89_phy_write32_mask(rtwdev, adc_sel[path], 0x6000, 0x0); 1121 rtw89_phy_write32_mask(rtwdev, wbadc_sel[path], 0x30, 0x2); 1122 break; 1123 default: 1124 rtw89_warn(rtwdev, "Fail to set ADC\n"); 1125 } 1126 } 1127 1128 static void rtw8852c_edcca_per20_bitmap_sifs(struct rtw89_dev *rtwdev, u8 bw, 1129 enum rtw89_phy_idx phy_idx) 1130 { 1131 if (bw == RTW89_CHANNEL_WIDTH_20) { 1132 rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A1, B_SNDCCA_A1_EN, 0xff, phy_idx); 1133 rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A2, B_SNDCCA_A2_VAL, 0, phy_idx); 1134 } else { 1135 rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A1, B_SNDCCA_A1_EN, 0, phy_idx); 1136 rtw89_phy_write32_idx(rtwdev, R_SNDCCA_A2, B_SNDCCA_A2_VAL, 0, phy_idx); 1137 } 1138 } 1139 1140 static void 1141 rtw8852c_ctrl_bw(struct rtw89_dev *rtwdev, u8 pri_ch, u8 bw, 1142 enum rtw89_phy_idx phy_idx) 1143 { 1144 u8 mod_sbw = 0; 1145 1146 switch (bw) { 1147 case RTW89_CHANNEL_WIDTH_5: 1148 case RTW89_CHANNEL_WIDTH_10: 1149 case RTW89_CHANNEL_WIDTH_20: 1150 if (bw == RTW89_CHANNEL_WIDTH_5) 1151 mod_sbw = 0x1; 1152 else if (bw == RTW89_CHANNEL_WIDTH_10) 1153 mod_sbw = 0x2; 1154 else if (bw == RTW89_CHANNEL_WIDTH_20) 1155 mod_sbw = 0x0; 1156 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x0, 1157 phy_idx); 1158 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 1159 mod_sbw, phy_idx); 1160 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 0x0, 1161 phy_idx); 1162 rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 1163 B_PATH0_SAMPL_DLY_T_MSK_V1, 0x3); 1164 rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 1165 B_PATH1_SAMPL_DLY_T_MSK_V1, 0x3); 1166 rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 1167 B_PATH0_BW_SEL_MSK_V1, 0xf); 1168 rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 1169 B_PATH1_BW_SEL_MSK_V1, 0xf); 1170 break; 1171 case RTW89_CHANNEL_WIDTH_40: 1172 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x1, 1173 phy_idx); 1174 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 1175 phy_idx); 1176 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 1177 pri_ch, 1178 phy_idx); 1179 rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 1180 B_PATH0_SAMPL_DLY_T_MSK_V1, 0x3); 1181 rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 1182 B_PATH1_SAMPL_DLY_T_MSK_V1, 0x3); 1183 rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 1184 B_PATH0_BW_SEL_MSK_V1, 0xf); 1185 rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 1186 B_PATH1_BW_SEL_MSK_V1, 0xf); 1187 break; 1188 case RTW89_CHANNEL_WIDTH_80: 1189 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x2, 1190 phy_idx); 1191 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 1192 phy_idx); 1193 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 1194 pri_ch, 1195 phy_idx); 1196 rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 1197 B_PATH0_SAMPL_DLY_T_MSK_V1, 0x2); 1198 rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 1199 B_PATH1_SAMPL_DLY_T_MSK_V1, 0x2); 1200 rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 1201 B_PATH0_BW_SEL_MSK_V1, 0xd); 1202 rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 1203 B_PATH1_BW_SEL_MSK_V1, 0xd); 1204 break; 1205 case RTW89_CHANNEL_WIDTH_160: 1206 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_FC0_BW_SET, 0x3, 1207 phy_idx); 1208 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_SBW, 0x0, 1209 phy_idx); 1210 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_CHBW_MOD_PRICH, 1211 pri_ch, 1212 phy_idx); 1213 rtw89_phy_write32_mask(rtwdev, R_PATH0_SAMPL_DLY_T_V1, 1214 B_PATH0_SAMPL_DLY_T_MSK_V1, 0x1); 1215 rtw89_phy_write32_mask(rtwdev, R_PATH1_SAMPL_DLY_T_V1, 1216 B_PATH1_SAMPL_DLY_T_MSK_V1, 0x1); 1217 rtw89_phy_write32_mask(rtwdev, R_PATH0_BW_SEL_V1, 1218 B_PATH0_BW_SEL_MSK_V1, 0xb); 1219 rtw89_phy_write32_mask(rtwdev, R_PATH1_BW_SEL_V1, 1220 B_PATH1_BW_SEL_MSK_V1, 0xb); 1221 break; 1222 default: 1223 rtw89_warn(rtwdev, "Fail to switch bw (bw:%d, pri ch:%d)\n", bw, 1224 pri_ch); 1225 } 1226 1227 if (bw == RTW89_CHANNEL_WIDTH_40) { 1228 rtw89_phy_write32_idx(rtwdev, R_RX_BW40_2XFFT_EN_V1, 1229 B_RX_BW40_2XFFT_EN_MSK_V1, 0x1, phy_idx); 1230 rtw89_phy_write32_idx(rtwdev, R_T2F_GI_COMB, B_T2F_GI_COMB_EN, 1, phy_idx); 1231 } else { 1232 rtw89_phy_write32_idx(rtwdev, R_RX_BW40_2XFFT_EN_V1, 1233 B_RX_BW40_2XFFT_EN_MSK_V1, 0x0, phy_idx); 1234 rtw89_phy_write32_idx(rtwdev, R_T2F_GI_COMB, B_T2F_GI_COMB_EN, 0, phy_idx); 1235 } 1236 1237 if (phy_idx == RTW89_PHY_0) { 1238 rtw8852c_bw_setting(rtwdev, bw, RF_PATH_A); 1239 if (!rtwdev->dbcc_en) 1240 rtw8852c_bw_setting(rtwdev, bw, RF_PATH_B); 1241 } else { 1242 rtw8852c_bw_setting(rtwdev, bw, RF_PATH_B); 1243 } 1244 1245 rtw8852c_edcca_per20_bitmap_sifs(rtwdev, bw, phy_idx); 1246 } 1247 1248 static u32 rtw8852c_spur_freq(struct rtw89_dev *rtwdev, 1249 struct rtw89_channel_params *param) 1250 { 1251 u8 center_chan = param->center_chan; 1252 u8 bw = param->bandwidth; 1253 1254 switch (param->band_type) { 1255 case RTW89_BAND_2G: 1256 if (bw == RTW89_CHANNEL_WIDTH_20) { 1257 if (center_chan >= 5 && center_chan <= 8) 1258 return 2440; 1259 if (center_chan == 13) 1260 return 2480; 1261 } else if (bw == RTW89_CHANNEL_WIDTH_40) { 1262 if (center_chan >= 3 && center_chan <= 10) 1263 return 2440; 1264 } 1265 break; 1266 case RTW89_BAND_5G: 1267 if (center_chan == 151 || center_chan == 153 || 1268 center_chan == 155 || center_chan == 163) 1269 return 5760; 1270 break; 1271 case RTW89_BAND_6G: 1272 if (center_chan == 195 || center_chan == 197 || 1273 center_chan == 199 || center_chan == 207) 1274 return 6920; 1275 break; 1276 default: 1277 break; 1278 } 1279 1280 return 0; 1281 } 1282 1283 #define CARRIER_SPACING_312_5 312500 /* 312.5 kHz */ 1284 #define CARRIER_SPACING_78_125 78125 /* 78.125 kHz */ 1285 #define MAX_TONE_NUM 2048 1286 1287 static void rtw8852c_set_csi_tone_idx(struct rtw89_dev *rtwdev, 1288 struct rtw89_channel_params *param, 1289 enum rtw89_phy_idx phy_idx) 1290 { 1291 u32 spur_freq; 1292 s32 freq_diff, csi_idx, csi_tone_idx; 1293 1294 spur_freq = rtw8852c_spur_freq(rtwdev, param); 1295 if (spur_freq == 0) { 1296 rtw89_phy_write32_idx(rtwdev, R_SEG0CSI_EN, B_SEG0CSI_EN, 0, phy_idx); 1297 return; 1298 } 1299 1300 freq_diff = (spur_freq - param->center_freq) * 1000000; 1301 csi_idx = s32_div_u32_round_closest(freq_diff, CARRIER_SPACING_78_125); 1302 s32_div_u32_round_down(csi_idx, MAX_TONE_NUM, &csi_tone_idx); 1303 1304 rtw89_phy_write32_idx(rtwdev, R_SEG0CSI, B_SEG0CSI_IDX, csi_tone_idx, phy_idx); 1305 rtw89_phy_write32_idx(rtwdev, R_SEG0CSI_EN, B_SEG0CSI_EN, 1, phy_idx); 1306 } 1307 1308 static const struct rtw89_nbi_reg_def rtw8852c_nbi_reg_def[] = { 1309 [RF_PATH_A] = { 1310 .notch1_idx = {0x4C14, 0xFF}, 1311 .notch1_frac_idx = {0x4C14, 0xC00}, 1312 .notch1_en = {0x4C14, 0x1000}, 1313 .notch2_idx = {0x4C20, 0xFF}, 1314 .notch2_frac_idx = {0x4C20, 0xC00}, 1315 .notch2_en = {0x4C20, 0x1000}, 1316 }, 1317 [RF_PATH_B] = { 1318 .notch1_idx = {0x4CD8, 0xFF}, 1319 .notch1_frac_idx = {0x4CD8, 0xC00}, 1320 .notch1_en = {0x4CD8, 0x1000}, 1321 .notch2_idx = {0x4CE4, 0xFF}, 1322 .notch2_frac_idx = {0x4CE4, 0xC00}, 1323 .notch2_en = {0x4CE4, 0x1000}, 1324 }, 1325 }; 1326 1327 static void rtw8852c_set_nbi_tone_idx(struct rtw89_dev *rtwdev, 1328 struct rtw89_channel_params *param, 1329 enum rtw89_rf_path path) 1330 { 1331 const struct rtw89_nbi_reg_def *nbi = &rtw8852c_nbi_reg_def[path]; 1332 u32 spur_freq, fc; 1333 s32 freq_diff; 1334 s32 nbi_idx, nbi_tone_idx; 1335 s32 nbi_frac_idx, nbi_frac_tone_idx; 1336 bool notch2_chk = false; 1337 1338 spur_freq = rtw8852c_spur_freq(rtwdev, param); 1339 if (spur_freq == 0) { 1340 rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 1341 rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 1342 return; 1343 } 1344 1345 fc = param->center_freq; 1346 if (param->bandwidth == RTW89_CHANNEL_WIDTH_160) { 1347 fc = (spur_freq > fc) ? fc + 40 : fc - 40; 1348 if ((fc > spur_freq && param->center_chan < param->primary_chan) || 1349 (fc < spur_freq && param->center_chan > param->primary_chan)) 1350 notch2_chk = true; 1351 } 1352 1353 freq_diff = (spur_freq - fc) * 1000000; 1354 nbi_idx = s32_div_u32_round_down(freq_diff, CARRIER_SPACING_312_5, &nbi_frac_idx); 1355 1356 if (param->bandwidth == RTW89_CHANNEL_WIDTH_20) { 1357 s32_div_u32_round_down(nbi_idx + 32, 64, &nbi_tone_idx); 1358 } else { 1359 u16 tone_para = (param->bandwidth == RTW89_CHANNEL_WIDTH_40) ? 128 : 256; 1360 1361 s32_div_u32_round_down(nbi_idx, tone_para, &nbi_tone_idx); 1362 } 1363 nbi_frac_tone_idx = s32_div_u32_round_closest(nbi_frac_idx, CARRIER_SPACING_78_125); 1364 1365 if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 && notch2_chk) { 1366 rtw89_phy_write32_mask(rtwdev, nbi->notch2_idx.addr, 1367 nbi->notch2_idx.mask, nbi_tone_idx); 1368 rtw89_phy_write32_mask(rtwdev, nbi->notch2_frac_idx.addr, 1369 nbi->notch2_frac_idx.mask, nbi_frac_tone_idx); 1370 rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 0); 1371 rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 1); 1372 rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 1373 } else { 1374 rtw89_phy_write32_mask(rtwdev, nbi->notch1_idx.addr, 1375 nbi->notch1_idx.mask, nbi_tone_idx); 1376 rtw89_phy_write32_mask(rtwdev, nbi->notch1_frac_idx.addr, 1377 nbi->notch1_frac_idx.mask, nbi_frac_tone_idx); 1378 rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0); 1379 rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 1); 1380 rtw89_phy_write32_mask(rtwdev, nbi->notch2_en.addr, nbi->notch2_en.mask, 0); 1381 } 1382 } 1383 1384 static void rtw8852c_spur_elimination(struct rtw89_dev *rtwdev, 1385 struct rtw89_channel_params *param, 1386 enum rtw89_phy_idx phy_idx) 1387 { 1388 rtw8852c_set_csi_tone_idx(rtwdev, param, phy_idx); 1389 1390 if (phy_idx == RTW89_PHY_0) { 1391 rtw8852c_set_nbi_tone_idx(rtwdev, param, RF_PATH_A); 1392 if (!rtwdev->dbcc_en) 1393 rtw8852c_set_nbi_tone_idx(rtwdev, param, RF_PATH_B); 1394 } else { 1395 rtw8852c_set_nbi_tone_idx(rtwdev, param, RF_PATH_B); 1396 } 1397 } 1398 1399 static void rtw8852c_5m_mask(struct rtw89_dev *rtwdev, 1400 struct rtw89_channel_params *param, 1401 enum rtw89_phy_idx phy_idx) 1402 { 1403 u8 pri_ch = param->primary_chan; 1404 bool mask_5m_low; 1405 bool mask_5m_en; 1406 1407 switch (param->bandwidth) { 1408 case RTW89_CHANNEL_WIDTH_40: 1409 mask_5m_en = true; 1410 mask_5m_low = pri_ch == 2; 1411 break; 1412 case RTW89_CHANNEL_WIDTH_80: 1413 mask_5m_en = ((pri_ch == 3) || (pri_ch == 4)); 1414 mask_5m_low = pri_ch == 4; 1415 break; 1416 default: 1417 mask_5m_en = false; 1418 mask_5m_low = false; 1419 break; 1420 } 1421 1422 if (!mask_5m_en) { 1423 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x0); 1424 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x0); 1425 rtw89_phy_write32_idx(rtwdev, R_ASSIGN_SBD_OPT, 1426 B_ASSIGN_SBD_OPT_EN, 0x0, phy_idx); 1427 } else { 1428 if (mask_5m_low) { 1429 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_TH, 0x4); 1430 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x1); 1431 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB2, 0x0); 1432 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB0, 0x1); 1433 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_TH, 0x4); 1434 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x1); 1435 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB2, 0x0); 1436 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB0, 0x1); 1437 } else { 1438 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_TH, 0x4); 1439 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_EN, 0x1); 1440 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB2, 0x1); 1441 rtw89_phy_write32_mask(rtwdev, R_PATH0_5MDET, B_PATH0_5MDET_SB0, 0x0); 1442 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_TH, 0x4); 1443 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_EN, 0x1); 1444 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB2, 0x1); 1445 rtw89_phy_write32_mask(rtwdev, R_PATH1_5MDET, B_PATH1_5MDET_SB0, 0x0); 1446 } 1447 rtw89_phy_write32_idx(rtwdev, R_ASSIGN_SBD_OPT, B_ASSIGN_SBD_OPT_EN, 0x1, phy_idx); 1448 } 1449 } 1450 1451 static void rtw8852c_bb_reset_all(struct rtw89_dev *rtwdev, 1452 enum rtw89_phy_idx phy_idx) 1453 { 1454 /*HW SI reset*/ 1455 rtw89_phy_write32_mask(rtwdev, R_S0_HW_SI_DIS, B_S0_HW_SI_DIS_W_R_TRIG, 1456 0x7); 1457 rtw89_phy_write32_mask(rtwdev, R_S1_HW_SI_DIS, B_S1_HW_SI_DIS_W_R_TRIG, 1458 0x7); 1459 1460 udelay(1); 1461 1462 rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 1463 phy_idx); 1464 rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 0, 1465 phy_idx); 1466 /*HW SI reset*/ 1467 rtw89_phy_write32_mask(rtwdev, R_S0_HW_SI_DIS, B_S0_HW_SI_DIS_W_R_TRIG, 1468 0x0); 1469 rtw89_phy_write32_mask(rtwdev, R_S1_HW_SI_DIS, B_S1_HW_SI_DIS_W_R_TRIG, 1470 0x0); 1471 1472 rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 1473 phy_idx); 1474 } 1475 1476 static void rtw8852c_bb_reset_en(struct rtw89_dev *rtwdev, 1477 enum rtw89_phy_idx phy_idx, bool en) 1478 { 1479 struct rtw89_hal *hal = &rtwdev->hal; 1480 1481 if (en) { 1482 rtw89_phy_write32_idx(rtwdev, R_S0_HW_SI_DIS, 1483 B_S0_HW_SI_DIS_W_R_TRIG, 0x0, phy_idx); 1484 rtw89_phy_write32_idx(rtwdev, R_S1_HW_SI_DIS, 1485 B_S1_HW_SI_DIS_W_R_TRIG, 0x0, phy_idx); 1486 rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 1, 1487 phy_idx); 1488 if (hal->current_band_type == RTW89_BAND_2G) 1489 rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0x0); 1490 rtw89_phy_write32_mask(rtwdev, R_PD_CTRL, B_PD_HIT_DIS, 0x0); 1491 } else { 1492 rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0x1); 1493 rtw89_phy_write32_mask(rtwdev, R_PD_CTRL, B_PD_HIT_DIS, 0x1); 1494 rtw89_phy_write32_idx(rtwdev, R_S0_HW_SI_DIS, 1495 B_S0_HW_SI_DIS_W_R_TRIG, 0x7, phy_idx); 1496 rtw89_phy_write32_idx(rtwdev, R_S1_HW_SI_DIS, 1497 B_S1_HW_SI_DIS_W_R_TRIG, 0x7, phy_idx); 1498 fsleep(1); 1499 rtw89_phy_write32_idx(rtwdev, R_RSTB_ASYNC, B_RSTB_ASYNC_ALL, 0, 1500 phy_idx); 1501 } 1502 } 1503 1504 static void rtw8852c_bb_reset(struct rtw89_dev *rtwdev, 1505 enum rtw89_phy_idx phy_idx) 1506 { 1507 rtw8852c_bb_reset_all(rtwdev, phy_idx); 1508 } 1509 1510 static 1511 void rtw8852c_bb_gpio_trsw(struct rtw89_dev *rtwdev, enum rtw89_rf_path path, 1512 u8 tx_path_en, u8 trsw_tx, 1513 u8 trsw_rx, u8 trsw, u8 trsw_b) 1514 { 1515 static const u32 path_cr_bases[] = {0x5868, 0x7868}; 1516 u32 mask_ofst = 16; 1517 u32 cr; 1518 u32 val; 1519 1520 if (path >= ARRAY_SIZE(path_cr_bases)) 1521 return; 1522 1523 cr = path_cr_bases[path]; 1524 1525 mask_ofst += (tx_path_en * 4 + trsw_tx * 2 + trsw_rx) * 2; 1526 val = FIELD_PREP(B_P0_TRSW_A, trsw) | FIELD_PREP(B_P0_TRSW_B, trsw_b); 1527 1528 rtw89_phy_write32_mask(rtwdev, cr, (B_P0_TRSW_A | B_P0_TRSW_B) << mask_ofst, val); 1529 } 1530 1531 enum rtw8852c_rfe_src { 1532 PAPE_RFM, 1533 TRSW_RFM, 1534 LNAON_RFM, 1535 }; 1536 1537 static 1538 void rtw8852c_bb_gpio_rfm(struct rtw89_dev *rtwdev, enum rtw89_rf_path path, 1539 enum rtw8852c_rfe_src src, u8 dis_tx_gnt_wl, 1540 u8 active_tx_opt, u8 act_bt_en, u8 rfm_output_val) 1541 { 1542 static const u32 path_cr_bases[] = {0x5894, 0x7894}; 1543 static const u32 masks[] = {0, 8, 16}; 1544 u32 mask, mask_ofst; 1545 u32 cr; 1546 u32 val; 1547 1548 if (src >= ARRAY_SIZE(masks) || path >= ARRAY_SIZE(path_cr_bases)) 1549 return; 1550 1551 mask_ofst = masks[src]; 1552 cr = path_cr_bases[path]; 1553 1554 val = FIELD_PREP(B_P0_RFM_DIS_WL, dis_tx_gnt_wl) | 1555 FIELD_PREP(B_P0_RFM_TX_OPT, active_tx_opt) | 1556 FIELD_PREP(B_P0_RFM_BT_EN, act_bt_en) | 1557 FIELD_PREP(B_P0_RFM_OUT, rfm_output_val); 1558 mask = 0xff << mask_ofst; 1559 1560 rtw89_phy_write32_mask(rtwdev, cr, mask, val); 1561 } 1562 1563 static void rtw8852c_bb_gpio_init(struct rtw89_dev *rtwdev) 1564 { 1565 static const u32 cr_bases[] = {0x5800, 0x7800}; 1566 u32 addr; 1567 u8 i; 1568 1569 for (i = 0; i < ARRAY_SIZE(cr_bases); i++) { 1570 addr = cr_bases[i]; 1571 rtw89_phy_write32_set(rtwdev, (addr | 0x68), B_P0_TRSW_A); 1572 rtw89_phy_write32_clr(rtwdev, (addr | 0x68), B_P0_TRSW_X); 1573 rtw89_phy_write32_clr(rtwdev, (addr | 0x68), B_P0_TRSW_SO_A2); 1574 rtw89_phy_write32(rtwdev, (addr | 0x80), 0x77777777); 1575 rtw89_phy_write32(rtwdev, (addr | 0x84), 0x77777777); 1576 } 1577 1578 rtw89_phy_write32(rtwdev, R_RFE_E_A2, 0xffffffff); 1579 rtw89_phy_write32(rtwdev, R_RFE_O_SEL_A2, 0); 1580 rtw89_phy_write32(rtwdev, R_RFE_SEL0_A2, 0); 1581 rtw89_phy_write32(rtwdev, R_RFE_SEL32_A2, 0); 1582 1583 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 0, 0, 0, 1); 1584 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 0, 1, 1, 0); 1585 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 1, 0, 1, 0); 1586 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 0, 1, 1, 1, 0); 1587 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 0, 0, 0, 1); 1588 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 0, 1, 1, 0); 1589 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 1, 0, 1, 0); 1590 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_A, 1, 1, 1, 1, 0); 1591 1592 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 0, 0, 0, 1); 1593 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 0, 1, 1, 0); 1594 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 1, 0, 1, 0); 1595 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 0, 1, 1, 1, 0); 1596 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 0, 0, 0, 1); 1597 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 0, 1, 1, 0); 1598 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 1, 0, 1, 0); 1599 rtw8852c_bb_gpio_trsw(rtwdev, RF_PATH_B, 1, 1, 1, 1, 0); 1600 1601 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, PAPE_RFM, 0, 0, 0, 0x0); 1602 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, TRSW_RFM, 0, 0, 0, 0x4); 1603 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_A, LNAON_RFM, 0, 0, 0, 0x8); 1604 1605 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, PAPE_RFM, 0, 0, 0, 0x0); 1606 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, TRSW_RFM, 0, 0, 0, 0x4); 1607 rtw8852c_bb_gpio_rfm(rtwdev, RF_PATH_B, LNAON_RFM, 0, 0, 0, 0x8); 1608 } 1609 1610 static void rtw8852c_bb_macid_ctrl_init(struct rtw89_dev *rtwdev, 1611 enum rtw89_phy_idx phy_idx) 1612 { 1613 u32 addr; 1614 1615 for (addr = R_AX_PWR_MACID_LMT_TABLE0; 1616 addr <= R_AX_PWR_MACID_LMT_TABLE127; addr += 4) 1617 rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, 0); 1618 } 1619 1620 static void rtw8852c_bb_sethw(struct rtw89_dev *rtwdev) 1621 { 1622 struct rtw89_phy_efuse_gain *gain = &rtwdev->efuse_gain; 1623 1624 rtw89_phy_write32_set(rtwdev, R_DBCC_80P80_SEL_EVM_RPT, 1625 B_DBCC_80P80_SEL_EVM_RPT_EN); 1626 rtw89_phy_write32_set(rtwdev, R_DBCC_80P80_SEL_EVM_RPT2, 1627 B_DBCC_80P80_SEL_EVM_RPT2_EN); 1628 1629 rtw8852c_bb_macid_ctrl_init(rtwdev, RTW89_PHY_0); 1630 rtw8852c_bb_gpio_init(rtwdev); 1631 1632 /* read these registers after loading BB parameters */ 1633 gain->offset_base[RTW89_PHY_0] = 1634 rtw89_phy_read32_mask(rtwdev, R_RPL_BIAS_COMP, B_RPL_BIAS_COMP_MASK); 1635 gain->offset_base[RTW89_PHY_1] = 1636 rtw89_phy_read32_mask(rtwdev, R_RPL_BIAS_COMP1, B_RPL_BIAS_COMP1_MASK); 1637 } 1638 1639 static void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev, 1640 struct rtw89_channel_params *param, 1641 enum rtw89_phy_idx phy_idx) 1642 { 1643 bool cck_en = param->band_type == RTW89_BAND_2G; 1644 u8 pri_ch_idx = param->pri_ch_idx; 1645 u32 mask, reg; 1646 u32 ru_alloc_msk[2] = {B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY0, 1647 B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY1}; 1648 1649 if (param->band_type == RTW89_BAND_2G) 1650 rtw8852c_ctrl_sco_cck(rtwdev, param->center_chan, 1651 param->primary_chan, param->bandwidth); 1652 1653 rtw8852c_ctrl_ch(rtwdev, param, phy_idx); 1654 rtw8852c_ctrl_bw(rtwdev, pri_ch_idx, param->bandwidth, phy_idx); 1655 if (cck_en) { 1656 rtw89_phy_write32_mask(rtwdev, R_UPD_CLK_ADC, B_ENABLE_CCK, 1); 1657 rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0); 1658 rtw89_phy_write32_idx(rtwdev, R_PD_ARBITER_OFF, 1659 B_PD_ARBITER_OFF, 0x0, phy_idx); 1660 } else { 1661 rtw89_phy_write32_mask(rtwdev, R_UPD_CLK_ADC, B_ENABLE_CCK, 0); 1662 rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 1); 1663 rtw89_phy_write32_idx(rtwdev, R_PD_ARBITER_OFF, 1664 B_PD_ARBITER_OFF, 0x1, phy_idx); 1665 } 1666 1667 rtw8852c_spur_elimination(rtwdev, param, phy_idx); 1668 rtw8852c_ctrl_btg(rtwdev, param->band_type == RTW89_BAND_2G); 1669 rtw8852c_5m_mask(rtwdev, param, phy_idx); 1670 1671 if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 && 1672 rtwdev->hal.cv != CHIP_CAV) { 1673 rtw89_phy_write32_idx(rtwdev, R_P80_AT_HIGH_FREQ, 1674 B_P80_AT_HIGH_FREQ, 0x0, phy_idx); 1675 reg = rtw89_mac_reg_by_idx(R_P80_AT_HIGH_FREQ_BB_WRP, 1676 phy_idx); 1677 if (param->primary_chan > param->center_chan) { 1678 rtw89_phy_write32_mask(rtwdev, 1679 R_P80_AT_HIGH_FREQ_RU_ALLOC, 1680 ru_alloc_msk[phy_idx], 1); 1681 rtw89_write32_mask(rtwdev, reg, 1682 B_P80_AT_HIGH_FREQ_BB_WRP, 1); 1683 } else { 1684 rtw89_phy_write32_mask(rtwdev, 1685 R_P80_AT_HIGH_FREQ_RU_ALLOC, 1686 ru_alloc_msk[phy_idx], 0); 1687 rtw89_write32_mask(rtwdev, reg, 1688 B_P80_AT_HIGH_FREQ_BB_WRP, 0); 1689 } 1690 } 1691 1692 if (param->band_type == RTW89_BAND_6G && 1693 param->bandwidth == RTW89_CHANNEL_WIDTH_160) 1694 rtw89_phy_write32_idx(rtwdev, R_CDD_EVM_CHK_EN, 1695 B_CDD_EVM_CHK_EN, 0, phy_idx); 1696 else 1697 rtw89_phy_write32_idx(rtwdev, R_CDD_EVM_CHK_EN, 1698 B_CDD_EVM_CHK_EN, 1, phy_idx); 1699 1700 if (!rtwdev->dbcc_en) { 1701 mask = B_P0_TXPW_RSTB_TSSI | B_P0_TXPW_RSTB_MANON; 1702 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x1); 1703 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x3); 1704 mask = B_P1_TXPW_RSTB_TSSI | B_P1_TXPW_RSTB_MANON; 1705 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x1); 1706 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x3); 1707 } else { 1708 if (phy_idx == RTW89_PHY_0) { 1709 mask = B_P0_TXPW_RSTB_TSSI | B_P0_TXPW_RSTB_MANON; 1710 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x1); 1711 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, mask, 0x3); 1712 } else { 1713 mask = B_P1_TXPW_RSTB_TSSI | B_P1_TXPW_RSTB_MANON; 1714 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x1); 1715 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, mask, 0x3); 1716 } 1717 } 1718 1719 rtw8852c_bb_reset_all(rtwdev, phy_idx); 1720 } 1721 1722 static void rtw8852c_set_channel(struct rtw89_dev *rtwdev, 1723 struct rtw89_channel_params *params) 1724 { 1725 rtw8852c_set_channel_mac(rtwdev, params, RTW89_MAC_0); 1726 rtw8852c_set_channel_bb(rtwdev, params, RTW89_PHY_0); 1727 rtw8852c_set_channel_rf(rtwdev, params, RTW89_PHY_0); 1728 } 1729 1730 static void rtw8852c_dfs_en(struct rtw89_dev *rtwdev, bool en) 1731 { 1732 if (en) 1733 rtw89_phy_write32_mask(rtwdev, R_UPD_P0, B_UPD_P0_EN, 1); 1734 else 1735 rtw89_phy_write32_mask(rtwdev, R_UPD_P0, B_UPD_P0_EN, 0); 1736 } 1737 1738 static void rtw8852c_adc_en(struct rtw89_dev *rtwdev, bool en) 1739 { 1740 if (en) 1741 rtw89_phy_write32_mask(rtwdev, R_ADC_FIFO, B_ADC_FIFO_RST, 1742 0x0); 1743 else 1744 rtw89_phy_write32_mask(rtwdev, R_ADC_FIFO, B_ADC_FIFO_RST, 1745 0xf); 1746 } 1747 1748 static void rtw8852c_set_channel_help(struct rtw89_dev *rtwdev, bool enter, 1749 struct rtw89_channel_help_params *p) 1750 { 1751 u8 phy_idx = RTW89_PHY_0; 1752 1753 if (enter) { 1754 rtw89_chip_stop_sch_tx(rtwdev, RTW89_MAC_0, &p->tx_en, RTW89_SCH_TX_SEL_ALL); 1755 rtw89_mac_cfg_ppdu_status(rtwdev, RTW89_MAC_0, false); 1756 rtw8852c_dfs_en(rtwdev, false); 1757 rtw8852c_adc_en(rtwdev, false); 1758 fsleep(40); 1759 rtw8852c_bb_reset_en(rtwdev, phy_idx, false); 1760 } else { 1761 rtw89_mac_cfg_ppdu_status(rtwdev, RTW89_MAC_0, true); 1762 rtw8852c_adc_en(rtwdev, true); 1763 rtw8852c_dfs_en(rtwdev, true); 1764 rtw8852c_bb_reset_en(rtwdev, phy_idx, true); 1765 rtw89_chip_resume_sch_tx(rtwdev, RTW89_MAC_0, p->tx_en); 1766 } 1767 } 1768 1769 static void rtw8852c_rfk_init(struct rtw89_dev *rtwdev) 1770 { 1771 struct rtw89_mcc_info *mcc_info = &rtwdev->mcc; 1772 1773 memset(mcc_info, 0, sizeof(*mcc_info)); 1774 } 1775 1776 static void rtw8852c_rfk_channel(struct rtw89_dev *rtwdev) 1777 { 1778 rtw89_fw_h2c_rf_ntfy_mcc(rtwdev); 1779 } 1780 1781 static u32 rtw8852c_bb_cal_txpwr_ref(struct rtw89_dev *rtwdev, 1782 enum rtw89_phy_idx phy_idx, s16 ref) 1783 { 1784 s8 ofst_int = 0; 1785 u8 base_cw_0db = 0x27; 1786 u16 tssi_16dbm_cw = 0x12c; 1787 s16 pwr_s10_3 = 0; 1788 s16 rf_pwr_cw = 0; 1789 u16 bb_pwr_cw = 0; 1790 u32 pwr_cw = 0; 1791 u32 tssi_ofst_cw = 0; 1792 1793 pwr_s10_3 = (ref << 1) + (s16)(ofst_int) + (s16)(base_cw_0db << 3); 1794 bb_pwr_cw = FIELD_GET(GENMASK(2, 0), pwr_s10_3); 1795 rf_pwr_cw = FIELD_GET(GENMASK(8, 3), pwr_s10_3); 1796 rf_pwr_cw = clamp_t(s16, rf_pwr_cw, 15, 63); 1797 pwr_cw = (rf_pwr_cw << 3) | bb_pwr_cw; 1798 1799 tssi_ofst_cw = (u32)((s16)tssi_16dbm_cw + (ref << 1) - (16 << 3)); 1800 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 1801 "[TXPWR] tssi_ofst_cw=%d rf_cw=0x%x bb_cw=0x%x\n", 1802 tssi_ofst_cw, rf_pwr_cw, bb_pwr_cw); 1803 1804 return (tssi_ofst_cw << 18) | (pwr_cw << 9) | (ref & GENMASK(8, 0)); 1805 } 1806 1807 static 1808 void rtw8852c_set_txpwr_ul_tb_offset(struct rtw89_dev *rtwdev, 1809 s8 pw_ofst, enum rtw89_mac_idx mac_idx) 1810 { 1811 s8 pw_ofst_2tx; 1812 s8 val_1t; 1813 s8 val_2t; 1814 u32 reg; 1815 u8 i; 1816 1817 if (pw_ofst < -32 || pw_ofst > 31) { 1818 rtw89_warn(rtwdev, "[ULTB] Err pwr_offset=%d\n", pw_ofst); 1819 return; 1820 } 1821 val_1t = pw_ofst << 2; 1822 pw_ofst_2tx = max(pw_ofst - 3, -32); 1823 val_2t = pw_ofst_2tx << 2; 1824 1825 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[ULTB] val_1tx=0x%x\n", val_1t); 1826 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[ULTB] val_2tx=0x%x\n", val_2t); 1827 1828 for (i = 0; i < 4; i++) { 1829 /* 1TX */ 1830 reg = rtw89_mac_reg_by_idx(R_AX_PWR_UL_TB_1T, mac_idx); 1831 rtw89_write32_mask(rtwdev, reg, 1832 B_AX_PWR_UL_TB_1T_V1_MASK << (8 * i), 1833 val_1t); 1834 /* 2TX */ 1835 reg = rtw89_mac_reg_by_idx(R_AX_PWR_UL_TB_2T, mac_idx); 1836 rtw89_write32_mask(rtwdev, reg, 1837 B_AX_PWR_UL_TB_2T_V1_MASK << (8 * i), 1838 val_2t); 1839 } 1840 } 1841 1842 static void rtw8852c_set_txpwr_ref(struct rtw89_dev *rtwdev, 1843 enum rtw89_phy_idx phy_idx) 1844 { 1845 static const u32 addr[RF_PATH_NUM_8852C] = {0x5800, 0x7800}; 1846 const u32 mask = 0x7FFFFFF; 1847 const u8 ofst_ofdm = 0x4; 1848 const u8 ofst_cck = 0x8; 1849 s16 ref_ofdm = 0; 1850 s16 ref_cck = 0; 1851 u32 val; 1852 u8 i; 1853 1854 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set txpwr reference\n"); 1855 1856 rtw89_mac_txpwr_write32_mask(rtwdev, phy_idx, R_AX_PWR_RATE_CTRL, 1857 GENMASK(27, 10), 0x0); 1858 1859 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set bb ofdm txpwr ref\n"); 1860 val = rtw8852c_bb_cal_txpwr_ref(rtwdev, phy_idx, ref_ofdm); 1861 1862 for (i = 0; i < RF_PATH_NUM_8852C; i++) 1863 rtw89_phy_write32_idx(rtwdev, addr[i] + ofst_ofdm, mask, val, 1864 phy_idx); 1865 1866 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set bb cck txpwr ref\n"); 1867 val = rtw8852c_bb_cal_txpwr_ref(rtwdev, phy_idx, ref_cck); 1868 1869 for (i = 0; i < RF_PATH_NUM_8852C; i++) 1870 rtw89_phy_write32_idx(rtwdev, addr[i] + ofst_cck, mask, val, 1871 phy_idx); 1872 } 1873 1874 static void rtw8852c_set_txpwr_byrate(struct rtw89_dev *rtwdev, 1875 enum rtw89_phy_idx phy_idx) 1876 { 1877 u8 ch = rtwdev->hal.current_channel; 1878 static const u8 rs[] = { 1879 RTW89_RS_CCK, 1880 RTW89_RS_OFDM, 1881 RTW89_RS_MCS, 1882 RTW89_RS_HEDCM, 1883 }; 1884 s8 tmp; 1885 u8 i, j; 1886 u32 val, shf, addr = R_AX_PWR_BY_RATE; 1887 struct rtw89_rate_desc cur; 1888 1889 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 1890 "[TXPWR] set txpwr byrate with ch=%d\n", ch); 1891 1892 for (cur.nss = 0; cur.nss <= RTW89_NSS_2; cur.nss++) { 1893 for (i = 0; i < ARRAY_SIZE(rs); i++) { 1894 if (cur.nss >= rtw89_rs_nss_max[rs[i]]) 1895 continue; 1896 1897 val = 0; 1898 cur.rs = rs[i]; 1899 1900 for (j = 0; j < rtw89_rs_idx_max[rs[i]]; j++) { 1901 cur.idx = j; 1902 shf = (j % 4) * 8; 1903 tmp = rtw89_phy_read_txpwr_byrate(rtwdev, &cur); 1904 val |= (tmp << shf); 1905 1906 if ((j + 1) % 4) 1907 continue; 1908 1909 rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, val); 1910 val = 0; 1911 addr += 4; 1912 } 1913 } 1914 } 1915 } 1916 1917 static void rtw8852c_set_txpwr_offset(struct rtw89_dev *rtwdev, 1918 enum rtw89_phy_idx phy_idx) 1919 { 1920 struct rtw89_rate_desc desc = { 1921 .nss = RTW89_NSS_1, 1922 .rs = RTW89_RS_OFFSET, 1923 }; 1924 u32 val = 0; 1925 s8 v; 1926 1927 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, "[TXPWR] set txpwr offset\n"); 1928 1929 for (desc.idx = 0; desc.idx < RTW89_RATE_OFFSET_MAX; desc.idx++) { 1930 v = rtw89_phy_read_txpwr_byrate(rtwdev, &desc); 1931 val |= ((v & 0xf) << (4 * desc.idx)); 1932 } 1933 1934 rtw89_mac_txpwr_write32_mask(rtwdev, phy_idx, R_AX_PWR_RATE_OFST_CTRL, 1935 GENMASK(19, 0), val); 1936 } 1937 1938 static void rtw8852c_bb_set_tx_shape_dfir(struct rtw89_dev *rtwdev, 1939 u8 tx_shape_idx, 1940 enum rtw89_phy_idx phy_idx) 1941 { 1942 #define __DFIR_CFG_MASK 0xffffff 1943 #define __DFIR_CFG_NR 8 1944 #define __DECL_DFIR_VAR(_prefix, _name, _val...) \ 1945 static const u32 _prefix ## _ ## _name[] = {_val}; \ 1946 static_assert(ARRAY_SIZE(_prefix ## _ ## _name) == __DFIR_CFG_NR) 1947 #define __DECL_DFIR_PARAM(_name, _val...) __DECL_DFIR_VAR(param, _name, _val) 1948 #define __DECL_DFIR_ADDR(_name, _val...) __DECL_DFIR_VAR(addr, _name, _val) 1949 1950 __DECL_DFIR_PARAM(flat, 1951 0x003D23FF, 0x0029B354, 0x000FC1C8, 0x00FDB053, 1952 0x00F86F9A, 0x00FAEF92, 0x00FE5FCC, 0x00FFDFF5); 1953 __DECL_DFIR_PARAM(sharp, 1954 0x003D83FF, 0x002C636A, 0x0013F204, 0x00008090, 1955 0x00F87FB0, 0x00F99F83, 0x00FDBFBA, 0x00003FF5); 1956 __DECL_DFIR_PARAM(sharp_14, 1957 0x003B13FF, 0x001C42DE, 0x00FDB0AD, 0x00F60F6E, 1958 0x00FD8F92, 0x0002D011, 0x0001C02C, 0x00FFF00A); 1959 __DECL_DFIR_ADDR(filter, 1960 0x45BC, 0x45CC, 0x45D0, 0x45D4, 0x45D8, 0x45C0, 1961 0x45C4, 0x45C8); 1962 u8 ch = rtwdev->hal.current_channel; 1963 const u32 *param; 1964 int i; 1965 1966 if (ch > 14) { 1967 rtw89_warn(rtwdev, 1968 "set tx shape dfir by unknown ch: %d on 2G\n", ch); 1969 return; 1970 } 1971 1972 if (ch == 14) 1973 param = param_sharp_14; 1974 else 1975 param = tx_shape_idx == 0 ? param_flat : param_sharp; 1976 1977 for (i = 0; i < __DFIR_CFG_NR; i++) { 1978 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 1979 "set tx shape dfir: 0x%x: 0x%x\n", addr_filter[i], 1980 param[i]); 1981 rtw89_phy_write32_idx(rtwdev, addr_filter[i], __DFIR_CFG_MASK, 1982 param[i], phy_idx); 1983 } 1984 1985 #undef __DECL_DFIR_ADDR 1986 #undef __DECL_DFIR_PARAM 1987 #undef __DECL_DFIR_VAR 1988 #undef __DFIR_CFG_NR 1989 #undef __DFIR_CFG_MASK 1990 } 1991 1992 static void rtw8852c_set_tx_shape(struct rtw89_dev *rtwdev, 1993 enum rtw89_phy_idx phy_idx) 1994 { 1995 u8 band = rtwdev->hal.current_band_type; 1996 u8 regd = rtw89_regd_get(rtwdev, band); 1997 u8 tx_shape_cck = rtw89_8852c_tx_shape[band][RTW89_RS_CCK][regd]; 1998 u8 tx_shape_ofdm = rtw89_8852c_tx_shape[band][RTW89_RS_OFDM][regd]; 1999 2000 if (band == RTW89_BAND_2G) 2001 rtw8852c_bb_set_tx_shape_dfir(rtwdev, tx_shape_cck, phy_idx); 2002 2003 rtw89_phy_tssi_ctrl_set_bandedge_cfg(rtwdev, 2004 (enum rtw89_mac_idx)phy_idx, 2005 tx_shape_ofdm); 2006 } 2007 2008 static void rtw8852c_set_txpwr_limit(struct rtw89_dev *rtwdev, 2009 enum rtw89_phy_idx phy_idx) 2010 { 2011 #define __MAC_TXPWR_LMT_PAGE_SIZE 40 2012 u8 ch = rtwdev->hal.current_channel; 2013 u8 bw = rtwdev->hal.current_band_width; 2014 struct rtw89_txpwr_limit lmt[NTX_NUM_8852C]; 2015 u32 addr, val; 2016 const s8 *ptr; 2017 u8 i, j, k; 2018 2019 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 2020 "[TXPWR] set txpwr limit with ch=%d bw=%d\n", ch, bw); 2021 2022 for (i = 0; i < NTX_NUM_8852C; i++) { 2023 rtw89_phy_fill_txpwr_limit(rtwdev, &lmt[i], i); 2024 2025 for (j = 0; j < __MAC_TXPWR_LMT_PAGE_SIZE; j += 4) { 2026 addr = R_AX_PWR_LMT + j + __MAC_TXPWR_LMT_PAGE_SIZE * i; 2027 ptr = (s8 *)&lmt[i] + j; 2028 val = 0; 2029 2030 for (k = 0; k < 4; k++) 2031 val |= (ptr[k] << (8 * k)); 2032 2033 rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, val); 2034 } 2035 } 2036 #undef __MAC_TXPWR_LMT_PAGE_SIZE 2037 } 2038 2039 static void rtw8852c_set_txpwr_limit_ru(struct rtw89_dev *rtwdev, 2040 enum rtw89_phy_idx phy_idx) 2041 { 2042 #define __MAC_TXPWR_LMT_RU_PAGE_SIZE 24 2043 u8 ch = rtwdev->hal.current_channel; 2044 u8 bw = rtwdev->hal.current_band_width; 2045 struct rtw89_txpwr_limit_ru lmt_ru[NTX_NUM_8852C]; 2046 u32 addr, val; 2047 const s8 *ptr; 2048 u8 i, j, k; 2049 2050 rtw89_debug(rtwdev, RTW89_DBG_TXPWR, 2051 "[TXPWR] set txpwr limit ru with ch=%d bw=%d\n", ch, bw); 2052 2053 for (i = 0; i < NTX_NUM_8852C; i++) { 2054 rtw89_phy_fill_txpwr_limit_ru(rtwdev, &lmt_ru[i], i); 2055 2056 for (j = 0; j < __MAC_TXPWR_LMT_RU_PAGE_SIZE; j += 4) { 2057 addr = R_AX_PWR_RU_LMT + j + 2058 __MAC_TXPWR_LMT_RU_PAGE_SIZE * i; 2059 ptr = (s8 *)&lmt_ru[i] + j; 2060 val = 0; 2061 2062 for (k = 0; k < 4; k++) 2063 val |= (ptr[k] << (8 * k)); 2064 2065 rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, val); 2066 } 2067 } 2068 2069 #undef __MAC_TXPWR_LMT_RU_PAGE_SIZE 2070 } 2071 2072 static void rtw8852c_set_txpwr(struct rtw89_dev *rtwdev) 2073 { 2074 rtw8852c_set_txpwr_byrate(rtwdev, RTW89_PHY_0); 2075 rtw8852c_set_txpwr_offset(rtwdev, RTW89_PHY_0); 2076 rtw8852c_set_tx_shape(rtwdev, RTW89_PHY_0); 2077 rtw8852c_set_txpwr_limit(rtwdev, RTW89_PHY_0); 2078 rtw8852c_set_txpwr_limit_ru(rtwdev, RTW89_PHY_0); 2079 } 2080 2081 static void rtw8852c_set_txpwr_ctrl(struct rtw89_dev *rtwdev) 2082 { 2083 rtw8852c_set_txpwr_ref(rtwdev, RTW89_PHY_0); 2084 } 2085 2086 static void 2087 rtw8852c_init_tssi_ctrl(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx) 2088 { 2089 static const struct rtw89_reg2_def ctrl_ini[] = { 2090 {0xD938, 0x00010100}, 2091 {0xD93C, 0x0500D500}, 2092 {0xD940, 0x00000500}, 2093 {0xD944, 0x00000005}, 2094 {0xD94C, 0x00220000}, 2095 {0xD950, 0x00030000}, 2096 }; 2097 u32 addr; 2098 int i; 2099 2100 for (addr = R_AX_TSSI_CTRL_HEAD; addr <= R_AX_TSSI_CTRL_TAIL; addr += 4) 2101 rtw89_mac_txpwr_write32(rtwdev, phy_idx, addr, 0); 2102 2103 for (i = 0; i < ARRAY_SIZE(ctrl_ini); i++) 2104 rtw89_mac_txpwr_write32(rtwdev, phy_idx, ctrl_ini[i].addr, 2105 ctrl_ini[i].data); 2106 2107 rtw89_phy_tssi_ctrl_set_bandedge_cfg(rtwdev, 2108 (enum rtw89_mac_idx)phy_idx, 2109 RTW89_TSSI_BANDEDGE_FLAT); 2110 } 2111 2112 static int 2113 rtw8852c_init_txpwr_unit(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx) 2114 { 2115 int ret; 2116 2117 ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_UL_CTRL2, 0x07763333); 2118 if (ret) 2119 return ret; 2120 2121 ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_COEXT_CTRL, 0x01ebf000); 2122 if (ret) 2123 return ret; 2124 2125 ret = rtw89_mac_txpwr_write32(rtwdev, phy_idx, R_AX_PWR_UL_CTRL0, 0x0002f8ff); 2126 if (ret) 2127 return ret; 2128 2129 rtw8852c_set_txpwr_ul_tb_offset(rtwdev, 0, phy_idx == RTW89_PHY_1 ? 2130 RTW89_MAC_1 : 2131 RTW89_MAC_0); 2132 rtw8852c_init_tssi_ctrl(rtwdev, phy_idx); 2133 2134 return 0; 2135 } 2136 2137 static void rtw8852c_bb_cfg_rx_path(struct rtw89_dev *rtwdev, u8 rx_path) 2138 { 2139 struct rtw89_hal *hal = &rtwdev->hal; 2140 u32 rst_mask0 = B_P0_TXPW_RSTB_MANON | B_P0_TXPW_RSTB_TSSI; 2141 u32 rst_mask1 = B_P1_TXPW_RSTB_MANON | B_P1_TXPW_RSTB_TSSI; 2142 2143 if (rtwdev->dbcc_en) { 2144 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_ANT_RX_SEG0, 1); 2145 rtw89_phy_write32_idx(rtwdev, R_CHBW_MOD, B_ANT_RX_SEG0, 2, 2146 RTW89_PHY_1); 2147 2148 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG0, 2149 1); 2150 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG1, 2151 1); 2152 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG0, 2, 2153 RTW89_PHY_1); 2154 rtw89_phy_write32_idx(rtwdev, R_FC0_BW, B_ANT_RX_1RCCA_SEG1, 2, 2155 RTW89_PHY_1); 2156 2157 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 2158 B_RXHT_MCS_LIMIT, 0); 2159 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 2160 B_RXVHT_MCS_LIMIT, 0); 2161 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_USER_MAX, 8); 2162 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0); 2163 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0); 2164 2165 rtw89_phy_write32_idx(rtwdev, R_RXHT_MCS_LIMIT, 2166 B_RXHT_MCS_LIMIT, 0, RTW89_PHY_1); 2167 rtw89_phy_write32_idx(rtwdev, R_RXVHT_MCS_LIMIT, 2168 B_RXVHT_MCS_LIMIT, 0, RTW89_PHY_1); 2169 rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHE_USER_MAX, 1, 2170 RTW89_PHY_1); 2171 rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0, 2172 RTW89_PHY_1); 2173 rtw89_phy_write32_idx(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0, 2174 RTW89_PHY_1); 2175 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, rst_mask0, 1); 2176 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, rst_mask0, 3); 2177 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, rst_mask1, 1); 2178 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, rst_mask1, 3); 2179 } else { 2180 if (rx_path == RF_PATH_A) { 2181 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 2182 B_ANT_RX_SEG0, 1); 2183 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2184 B_ANT_RX_1RCCA_SEG0, 1); 2185 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2186 B_ANT_RX_1RCCA_SEG1, 1); 2187 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 2188 B_RXHT_MCS_LIMIT, 0); 2189 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 2190 B_RXVHT_MCS_LIMIT, 0); 2191 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 2192 0); 2193 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 2194 0); 2195 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 2196 rst_mask0, 1); 2197 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 2198 rst_mask0, 3); 2199 } else if (rx_path == RF_PATH_B) { 2200 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 2201 B_ANT_RX_SEG0, 2); 2202 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2203 B_ANT_RX_1RCCA_SEG0, 2); 2204 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2205 B_ANT_RX_1RCCA_SEG1, 2); 2206 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 2207 B_RXHT_MCS_LIMIT, 0); 2208 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 2209 B_RXVHT_MCS_LIMIT, 0); 2210 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 2211 0); 2212 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 2213 0); 2214 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 2215 rst_mask1, 1); 2216 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 2217 rst_mask1, 3); 2218 } else { 2219 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, 2220 B_ANT_RX_SEG0, 3); 2221 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2222 B_ANT_RX_1RCCA_SEG0, 3); 2223 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, 2224 B_ANT_RX_1RCCA_SEG1, 3); 2225 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, 2226 B_RXHT_MCS_LIMIT, 1); 2227 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, 2228 B_RXVHT_MCS_LIMIT, 1); 2229 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 2230 1); 2231 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 2232 1); 2233 rtw8852c_ctrl_btg(rtwdev, hal->current_band_type == RTW89_BAND_2G); 2234 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 2235 rst_mask0, 1); 2236 rtw89_phy_write32_mask(rtwdev, R_P0_TXPW_RSTB, 2237 rst_mask0, 3); 2238 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 2239 rst_mask1, 1); 2240 rtw89_phy_write32_mask(rtwdev, R_P1_TXPW_RSTB, 2241 rst_mask1, 3); 2242 } 2243 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_USER_MAX, 8); 2244 } 2245 } 2246 2247 static void rtw8852c_ctrl_tx_path_tmac(struct rtw89_dev *rtwdev, u8 tx_path, 2248 enum rtw89_mac_idx mac_idx) 2249 { 2250 struct rtw89_reg2_def path_com[] = { 2251 {R_AX_PATH_COM0, AX_PATH_COM0_DFVAL}, 2252 {R_AX_PATH_COM1, AX_PATH_COM1_DFVAL}, 2253 {R_AX_PATH_COM2, AX_PATH_COM2_DFVAL}, 2254 {R_AX_PATH_COM3, AX_PATH_COM3_DFVAL}, 2255 {R_AX_PATH_COM4, AX_PATH_COM4_DFVAL}, 2256 {R_AX_PATH_COM5, AX_PATH_COM5_DFVAL}, 2257 {R_AX_PATH_COM6, AX_PATH_COM6_DFVAL}, 2258 {R_AX_PATH_COM7, AX_PATH_COM7_DFVAL}, 2259 {R_AX_PATH_COM8, AX_PATH_COM8_DFVAL}, 2260 {R_AX_PATH_COM9, AX_PATH_COM9_DFVAL}, 2261 {R_AX_PATH_COM10, AX_PATH_COM10_DFVAL}, 2262 {R_AX_PATH_COM11, AX_PATH_COM11_DFVAL}, 2263 }; 2264 u32 addr; 2265 u32 reg; 2266 u8 cr_size = ARRAY_SIZE(path_com); 2267 u8 i = 0; 2268 2269 rtw89_phy_write32_idx(rtwdev, R_MAC_SEL, B_MAC_SEL_MOD, 0, RTW89_PHY_0); 2270 rtw89_phy_write32_idx(rtwdev, R_MAC_SEL, B_MAC_SEL_MOD, 0, RTW89_PHY_1); 2271 2272 for (addr = R_AX_MACID_ANT_TABLE; 2273 addr <= R_AX_MACID_ANT_TABLE_LAST; addr += 4) { 2274 reg = rtw89_mac_reg_by_idx(addr, mac_idx); 2275 rtw89_write32(rtwdev, reg, 0); 2276 } 2277 2278 if (tx_path == RF_PATH_A) { 2279 path_com[0].data = AX_PATH_COM0_PATHA; 2280 path_com[1].data = AX_PATH_COM1_PATHA; 2281 path_com[2].data = AX_PATH_COM2_PATHA; 2282 path_com[7].data = AX_PATH_COM7_PATHA; 2283 path_com[8].data = AX_PATH_COM8_PATHA; 2284 } else if (tx_path == RF_PATH_B) { 2285 path_com[0].data = AX_PATH_COM0_PATHB; 2286 path_com[1].data = AX_PATH_COM1_PATHB; 2287 path_com[2].data = AX_PATH_COM2_PATHB; 2288 path_com[7].data = AX_PATH_COM7_PATHB; 2289 path_com[8].data = AX_PATH_COM8_PATHB; 2290 } else if (tx_path == RF_PATH_AB) { 2291 path_com[0].data = AX_PATH_COM0_PATHAB; 2292 path_com[1].data = AX_PATH_COM1_PATHAB; 2293 path_com[2].data = AX_PATH_COM2_PATHAB; 2294 path_com[7].data = AX_PATH_COM7_PATHAB; 2295 path_com[8].data = AX_PATH_COM8_PATHAB; 2296 } else { 2297 rtw89_warn(rtwdev, "[Invalid Tx Path]Tx Path: %d\n", tx_path); 2298 return; 2299 } 2300 2301 for (i = 0; i < cr_size; i++) { 2302 rtw89_debug(rtwdev, RTW89_DBG_TSSI, "0x%x = 0x%x\n", 2303 path_com[i].addr, path_com[i].data); 2304 reg = rtw89_mac_reg_by_idx(path_com[i].addr, mac_idx); 2305 rtw89_write32(rtwdev, reg, path_com[i].data); 2306 } 2307 } 2308 2309 static void rtw8852c_bb_cfg_txrx_path(struct rtw89_dev *rtwdev) 2310 { 2311 struct rtw89_hal *hal = &rtwdev->hal; 2312 2313 rtw8852c_bb_cfg_rx_path(rtwdev, RF_PATH_AB); 2314 2315 if (hal->rx_nss == 1) { 2316 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, B_RXHT_MCS_LIMIT, 0); 2317 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, B_RXVHT_MCS_LIMIT, 0); 2318 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 0); 2319 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 0); 2320 } else { 2321 rtw89_phy_write32_mask(rtwdev, R_RXHT_MCS_LIMIT, B_RXHT_MCS_LIMIT, 1); 2322 rtw89_phy_write32_mask(rtwdev, R_RXVHT_MCS_LIMIT, B_RXVHT_MCS_LIMIT, 1); 2323 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHE_MAX_NSS, 1); 2324 rtw89_phy_write32_mask(rtwdev, R_RXHE, B_RXHETB_MAX_NSS, 1); 2325 } 2326 2327 rtw8852c_ctrl_tx_path_tmac(rtwdev, RF_PATH_AB, RTW89_MAC_0); 2328 } 2329 2330 static u8 rtw8852c_get_thermal(struct rtw89_dev *rtwdev, enum rtw89_rf_path rf_path) 2331 { 2332 rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x1); 2333 rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x0); 2334 rtw89_write_rf(rtwdev, rf_path, RR_TM, RR_TM_TRI, 0x1); 2335 2336 fsleep(200); 2337 2338 return rtw89_read_rf(rtwdev, rf_path, RR_TM, RR_TM_VAL); 2339 } 2340 2341 static void rtw8852c_btc_set_rfe(struct rtw89_dev *rtwdev) 2342 { 2343 struct rtw89_btc *btc = &rtwdev->btc; 2344 struct rtw89_btc_module *module = &btc->mdinfo; 2345 2346 module->rfe_type = rtwdev->efuse.rfe_type; 2347 module->cv = rtwdev->hal.cv; 2348 module->bt_solo = 0; 2349 module->switch_type = BTC_SWITCH_INTERNAL; 2350 2351 if (module->rfe_type > 0) 2352 module->ant.num = (module->rfe_type % 2 ? 2 : 3); 2353 else 2354 module->ant.num = 2; 2355 2356 module->ant.diversity = 0; 2357 module->ant.isolation = 10; 2358 2359 if (module->ant.num == 3) { 2360 module->ant.type = BTC_ANT_DEDICATED; 2361 module->bt_pos = BTC_BT_ALONE; 2362 } else { 2363 module->ant.type = BTC_ANT_SHARED; 2364 module->bt_pos = BTC_BT_BTG; 2365 } 2366 } 2367 2368 static void rtw8852c_ctrl_btg(struct rtw89_dev *rtwdev, bool btg) 2369 { 2370 if (btg) { 2371 rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_SHARE_V1, 2372 B_PATH0_BT_SHARE_V1, 0x1); 2373 rtw89_phy_write32_mask(rtwdev, R_PATH0_BTG_PATH_V1, 2374 B_PATH0_BTG_PATH_V1, 0x0); 2375 rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 2376 B_PATH1_G_LNA6_OP1DB_V1, 0x20); 2377 rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 2378 B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x30); 2379 rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_SHARE_V1, 2380 B_PATH1_BT_SHARE_V1, 0x1); 2381 rtw89_phy_write32_mask(rtwdev, R_PATH1_BTG_PATH_V1, 2382 B_PATH1_BTG_PATH_V1, 0x1); 2383 rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P1, 0x0); 2384 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_BT_SHARE, 0x1); 2385 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_BT_SEG0, 0x2); 2386 rtw89_phy_write32_mask(rtwdev, R_BT_DYN_DC_EST_EN, 2387 B_BT_DYN_DC_EST_EN_MSK, 0x1); 2388 rtw89_phy_write32_mask(rtwdev, R_GNT_BT_WGT_EN, B_GNT_BT_WGT_EN, 2389 0x1); 2390 } else { 2391 rtw89_phy_write32_mask(rtwdev, R_PATH0_BT_SHARE_V1, 2392 B_PATH0_BT_SHARE_V1, 0x0); 2393 rtw89_phy_write32_mask(rtwdev, R_PATH0_BTG_PATH_V1, 2394 B_PATH0_BTG_PATH_V1, 0x0); 2395 rtw89_phy_write32_mask(rtwdev, R_PATH1_G_LNA6_OP1DB_V1, 2396 B_PATH1_G_LNA6_OP1DB_V1, 0x1a); 2397 rtw89_phy_write32_mask(rtwdev, R_PATH1_G_TIA0_LNA6_OP1DB_V1, 2398 B_PATH1_G_TIA0_LNA6_OP1DB_V1, 0x2a); 2399 rtw89_phy_write32_mask(rtwdev, R_PATH1_BT_SHARE_V1, 2400 B_PATH1_BT_SHARE_V1, 0x0); 2401 rtw89_phy_write32_mask(rtwdev, R_PATH1_BTG_PATH_V1, 2402 B_PATH1_BTG_PATH_V1, 0x0); 2403 rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P1, 0xf); 2404 rtw89_phy_write32_mask(rtwdev, R_PMAC_GNT, B_PMAC_GNT_P2, 0x4); 2405 rtw89_phy_write32_mask(rtwdev, R_CHBW_MOD, B_BT_SHARE, 0x0); 2406 rtw89_phy_write32_mask(rtwdev, R_FC0_BW, B_ANT_RX_BT_SEG0, 0x0); 2407 rtw89_phy_write32_mask(rtwdev, R_BT_DYN_DC_EST_EN, 2408 B_BT_DYN_DC_EST_EN_MSK, 0x0); 2409 rtw89_phy_write32_mask(rtwdev, R_GNT_BT_WGT_EN, B_GNT_BT_WGT_EN, 2410 0x0); 2411 } 2412 } 2413 2414 static 2415 void rtw8852c_set_trx_mask(struct rtw89_dev *rtwdev, u8 path, u8 group, u32 val) 2416 { 2417 rtw89_write_rf(rtwdev, path, RR_LUTWE, RFREG_MASK, 0x20000); 2418 rtw89_write_rf(rtwdev, path, RR_LUTWA, RFREG_MASK, group); 2419 rtw89_write_rf(rtwdev, path, RR_LUTWD0, RFREG_MASK, val); 2420 rtw89_write_rf(rtwdev, path, RR_LUTWE, RFREG_MASK, 0x0); 2421 } 2422 2423 static void rtw8852c_btc_init_cfg(struct rtw89_dev *rtwdev) 2424 { 2425 struct rtw89_btc *btc = &rtwdev->btc; 2426 struct rtw89_btc_module *module = &btc->mdinfo; 2427 const struct rtw89_chip_info *chip = rtwdev->chip; 2428 const struct rtw89_mac_ax_coex coex_params = { 2429 .pta_mode = RTW89_MAC_AX_COEX_RTK_MODE, 2430 .direction = RTW89_MAC_AX_COEX_INNER, 2431 }; 2432 2433 /* PTA init */ 2434 rtw89_mac_coex_init_v1(rtwdev, &coex_params); 2435 2436 /* set WL Tx response = Hi-Pri */ 2437 chip->ops->btc_set_wl_pri(rtwdev, BTC_PRI_MASK_TX_RESP, true); 2438 chip->ops->btc_set_wl_pri(rtwdev, BTC_PRI_MASK_BEACON, true); 2439 2440 /* set rf gnt debug off */ 2441 rtw89_write_rf(rtwdev, RF_PATH_A, RR_WLSEL, RFREG_MASK, 0x0); 2442 rtw89_write_rf(rtwdev, RF_PATH_B, RR_WLSEL, RFREG_MASK, 0x0); 2443 2444 /* set WL Tx thru in TRX mask table if GNT_WL = 0 && BT_S1 = ss group */ 2445 if (module->ant.type == BTC_ANT_SHARED) { 2446 rtw8852c_set_trx_mask(rtwdev, 2447 RF_PATH_A, BTC_BT_SS_GROUP, 0x5ff); 2448 rtw8852c_set_trx_mask(rtwdev, 2449 RF_PATH_B, BTC_BT_SS_GROUP, 0x5ff); 2450 /* set path-A(S0) Tx/Rx no-mask if GNT_WL=0 && BT_S1=tx group */ 2451 rtw8852c_set_trx_mask(rtwdev, 2452 RF_PATH_A, BTC_BT_TX_GROUP, 0x5ff); 2453 } else { /* set WL Tx stb if GNT_WL = 0 && BT_S1 = ss group for 3-ant */ 2454 rtw8852c_set_trx_mask(rtwdev, 2455 RF_PATH_A, BTC_BT_SS_GROUP, 0x5df); 2456 rtw8852c_set_trx_mask(rtwdev, 2457 RF_PATH_B, BTC_BT_SS_GROUP, 0x5df); 2458 } 2459 2460 /* set PTA break table */ 2461 rtw89_write32(rtwdev, R_AX_BT_BREAK_TABLE, BTC_BREAK_PARAM); 2462 2463 /* enable BT counter 0xda10[1:0] = 2b'11 */ 2464 rtw89_write32_set(rtwdev, 2465 R_AX_BT_CNT_CFG, B_AX_BT_CNT_EN | 2466 B_AX_BT_CNT_RST_V1); 2467 btc->cx.wl.status.map.init_ok = true; 2468 } 2469 2470 static 2471 void rtw8852c_btc_set_wl_pri(struct rtw89_dev *rtwdev, u8 map, bool state) 2472 { 2473 u32 bitmap = 0; 2474 u32 reg = 0; 2475 2476 switch (map) { 2477 case BTC_PRI_MASK_TX_RESP: 2478 reg = R_BTC_COEX_WL_REQ; 2479 bitmap = B_BTC_RSP_ACK_HI; 2480 break; 2481 case BTC_PRI_MASK_BEACON: 2482 reg = R_BTC_COEX_WL_REQ; 2483 bitmap = B_BTC_TX_BCN_HI; 2484 break; 2485 default: 2486 return; 2487 } 2488 2489 if (state) 2490 rtw89_write32_set(rtwdev, reg, bitmap); 2491 else 2492 rtw89_write32_clr(rtwdev, reg, bitmap); 2493 } 2494 2495 union rtw8852c_btc_wl_txpwr_ctrl { 2496 u32 txpwr_val; 2497 struct { 2498 union { 2499 u16 ctrl_all_time; 2500 struct { 2501 s16 data:9; 2502 u16 rsvd:6; 2503 u16 flag:1; 2504 } all_time; 2505 }; 2506 union { 2507 u16 ctrl_gnt_bt; 2508 struct { 2509 s16 data:9; 2510 u16 rsvd:7; 2511 } gnt_bt; 2512 }; 2513 }; 2514 } __packed; 2515 2516 static void 2517 rtw8852c_btc_set_wl_txpwr_ctrl(struct rtw89_dev *rtwdev, u32 txpwr_val) 2518 { 2519 union rtw8852c_btc_wl_txpwr_ctrl arg = { .txpwr_val = txpwr_val }; 2520 s32 val; 2521 2522 #define __write_ctrl(_reg, _msk, _val, _en, _cond) \ 2523 do { \ 2524 const typeof(_msk) __msk = _msk; \ 2525 const typeof(_en) __en = _en; \ 2526 u32 _wrt = FIELD_PREP(__msk, _val); \ 2527 BUILD_BUG_ON((__msk & __en) != 0); \ 2528 if (_cond) \ 2529 _wrt |= __en; \ 2530 else \ 2531 _wrt &= ~__en; \ 2532 rtw89_mac_txpwr_write32_mask(rtwdev, RTW89_PHY_0, _reg, \ 2533 __msk | __en, _wrt); \ 2534 } while (0) 2535 2536 switch (arg.ctrl_all_time) { 2537 case 0xffff: 2538 val = 0; 2539 break; 2540 default: 2541 val = arg.all_time.data; 2542 break; 2543 } 2544 2545 __write_ctrl(R_AX_PWR_RATE_CTRL, B_AX_FORCE_PWR_BY_RATE_VALUE_MASK, 2546 val, B_AX_FORCE_PWR_BY_RATE_EN, 2547 arg.ctrl_all_time != 0xffff); 2548 2549 switch (arg.ctrl_gnt_bt) { 2550 case 0xffff: 2551 val = 0; 2552 break; 2553 default: 2554 val = arg.gnt_bt.data; 2555 break; 2556 } 2557 2558 __write_ctrl(R_AX_PWR_COEXT_CTRL, B_AX_TXAGC_BT_MASK, val, 2559 B_AX_TXAGC_BT_EN, arg.ctrl_gnt_bt != 0xffff); 2560 2561 #undef __write_ctrl 2562 } 2563 2564 static 2565 s8 rtw8852c_btc_get_bt_rssi(struct rtw89_dev *rtwdev, s8 val) 2566 { 2567 return clamp_t(s8, val, -100, 0) + 100; 2568 } 2569 2570 static 2571 void rtw8852c_btc_bt_aci_imp(struct rtw89_dev *rtwdev) 2572 { 2573 struct rtw89_btc *btc = &rtwdev->btc; 2574 struct rtw89_btc_dm *dm = &btc->dm; 2575 struct rtw89_btc_bt_info *bt = &btc->cx.bt; 2576 struct rtw89_btc_bt_link_info *b = &bt->link_info; 2577 2578 /* fix LNA2 = level-5 for BT ACI issue at BTG */ 2579 if (btc->dm.wl_btg_rx && b->profile_cnt.now != 0) 2580 dm->trx_para_level = 1; 2581 } 2582 2583 static 2584 void rtw8852c_btc_update_bt_cnt(struct rtw89_dev *rtwdev) 2585 { 2586 struct rtw89_btc *btc = &rtwdev->btc; 2587 struct rtw89_btc_cx *cx = &btc->cx; 2588 u32 val; 2589 2590 val = rtw89_read32(rtwdev, R_BTC_BT_CNT_HIGH); 2591 cx->cnt_bt[BTC_BCNT_HIPRI_TX] = FIELD_GET(B_AX_STATIS_BT_HI_TX_MASK, val); 2592 cx->cnt_bt[BTC_BCNT_HIPRI_RX] = FIELD_GET(B_AX_STATIS_BT_HI_RX_MASK, val); 2593 2594 val = rtw89_read32(rtwdev, R_BTC_BT_CNT_LOW); 2595 cx->cnt_bt[BTC_BCNT_LOPRI_TX] = FIELD_GET(B_AX_STATIS_BT_LO_TX_1_MASK, val); 2596 cx->cnt_bt[BTC_BCNT_LOPRI_RX] = FIELD_GET(B_AX_STATIS_BT_LO_RX_1_MASK, val); 2597 2598 /* clock-gate off before reset counter*/ 2599 rtw89_write32_set(rtwdev, R_AX_BTC_CFG, B_AX_DIS_BTC_CLK_G); 2600 rtw89_write32_clr(rtwdev, R_AX_BT_CNT_CFG, B_AX_BT_CNT_RST); 2601 rtw89_write32_set(rtwdev, R_AX_BT_CNT_CFG, B_AX_BT_CNT_RST); 2602 rtw89_write32_clr(rtwdev, R_AX_BTC_CFG, B_AX_DIS_BTC_CLK_G); 2603 } 2604 2605 static 2606 void rtw8852c_btc_wl_s1_standby(struct rtw89_dev *rtwdev, bool state) 2607 { 2608 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x80000); 2609 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWA, RFREG_MASK, 0x1); 2610 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD1, RFREG_MASK, 0x620); 2611 2612 /* set WL standby = Rx for GNT_BT_Tx = 1->0 settle issue */ 2613 if (state) 2614 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, 2615 RFREG_MASK, 0x179c); 2616 else 2617 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWD0, 2618 RFREG_MASK, 0x208); 2619 2620 rtw89_write_rf(rtwdev, RF_PATH_B, RR_LUTWE, RFREG_MASK, 0x0); 2621 } 2622 2623 static void rtw8852c_fill_freq_with_ppdu(struct rtw89_dev *rtwdev, 2624 struct rtw89_rx_phy_ppdu *phy_ppdu, 2625 struct ieee80211_rx_status *status) 2626 { 2627 u8 chan_idx = phy_ppdu->chan_idx; 2628 enum nl80211_band band; 2629 u8 ch; 2630 2631 if (chan_idx == 0) 2632 return; 2633 2634 rtw8852c_decode_chan_idx(rtwdev, chan_idx, &ch, &band); 2635 status->freq = ieee80211_channel_to_frequency(ch, band); 2636 status->band = band; 2637 } 2638 2639 static void rtw8852c_query_ppdu(struct rtw89_dev *rtwdev, 2640 struct rtw89_rx_phy_ppdu *phy_ppdu, 2641 struct ieee80211_rx_status *status) 2642 { 2643 u8 path; 2644 s8 *rx_power = phy_ppdu->rssi; 2645 2646 status->signal = max_t(s8, rx_power[RF_PATH_A], rx_power[RF_PATH_B]); 2647 for (path = 0; path < rtwdev->chip->rf_path_num; path++) { 2648 status->chains |= BIT(path); 2649 status->chain_signal[path] = rx_power[path]; 2650 } 2651 if (phy_ppdu->valid) 2652 rtw8852c_fill_freq_with_ppdu(rtwdev, phy_ppdu, status); 2653 } 2654 2655 static int rtw8852c_mac_enable_bb_rf(struct rtw89_dev *rtwdev) 2656 { 2657 int ret; 2658 2659 rtw89_write8_set(rtwdev, R_AX_SYS_FUNC_EN, 2660 B_AX_FEN_BBRSTB | B_AX_FEN_BB_GLB_RSTN); 2661 2662 rtw89_write32_set(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 2663 rtw89_write32_clr(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 2664 rtw89_write32_set(rtwdev, R_AX_WLRF_CTRL, B_AX_AFC_AFEDIG); 2665 2666 rtw89_write32_mask(rtwdev, R_AX_AFE_OFF_CTRL1, B_AX_S0_LDO_VSEL_F_MASK, 0x1); 2667 rtw89_write32_mask(rtwdev, R_AX_AFE_OFF_CTRL1, B_AX_S1_LDO_VSEL_F_MASK, 0x1); 2668 2669 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL0, 0x7, FULL_BIT_MASK); 2670 if (ret) 2671 return ret; 2672 2673 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_ANAPAR_WL, 0x6c, FULL_BIT_MASK); 2674 if (ret) 2675 return ret; 2676 2677 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S0, 0xc7, FULL_BIT_MASK); 2678 if (ret) 2679 return ret; 2680 2681 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_WL_RFC_S1, 0xc7, FULL_BIT_MASK); 2682 if (ret) 2683 return ret; 2684 2685 ret = rtw89_mac_write_xtal_si(rtwdev, XTAL3, 0xd, FULL_BIT_MASK); 2686 if (ret) 2687 return ret; 2688 2689 return 0; 2690 } 2691 2692 static void rtw8852c_mac_disable_bb_rf(struct rtw89_dev *rtwdev) 2693 { 2694 rtw89_write8_clr(rtwdev, R_AX_SYS_FUNC_EN, 2695 B_AX_FEN_BBRSTB | B_AX_FEN_BB_GLB_RSTN); 2696 } 2697 2698 static const struct rtw89_chip_ops rtw8852c_chip_ops = { 2699 .enable_bb_rf = rtw8852c_mac_enable_bb_rf, 2700 .disable_bb_rf = rtw8852c_mac_disable_bb_rf, 2701 .bb_reset = rtw8852c_bb_reset, 2702 .bb_sethw = rtw8852c_bb_sethw, 2703 .set_channel = rtw8852c_set_channel, 2704 .set_channel_help = rtw8852c_set_channel_help, 2705 .read_efuse = rtw8852c_read_efuse, 2706 .read_phycap = rtw8852c_read_phycap, 2707 .rfk_init = rtw8852c_rfk_init, 2708 .rfk_channel = rtw8852c_rfk_channel, 2709 .power_trim = rtw8852c_power_trim, 2710 .set_txpwr = rtw8852c_set_txpwr, 2711 .set_txpwr_ctrl = rtw8852c_set_txpwr_ctrl, 2712 .init_txpwr_unit = rtw8852c_init_txpwr_unit, 2713 .get_thermal = rtw8852c_get_thermal, 2714 .query_ppdu = rtw8852c_query_ppdu, 2715 .read_rf = rtw89_phy_read_rf_v1, 2716 .write_rf = rtw89_phy_write_rf_v1, 2717 .set_txpwr_ul_tb_offset = rtw8852c_set_txpwr_ul_tb_offset, 2718 .cfg_txrx_path = rtw8852c_bb_cfg_txrx_path, 2719 .pwr_on_func = rtw8852c_pwr_on_func, 2720 .pwr_off_func = rtw8852c_pwr_off_func, 2721 .fill_txdesc = rtw89_core_fill_txdesc_v1, 2722 .fill_txdesc_fwcmd = rtw89_core_fill_txdesc_fwcmd_v1, 2723 .cfg_ctrl_path = rtw89_mac_cfg_ctrl_path_v1, 2724 .mac_cfg_gnt = rtw89_mac_cfg_gnt_v1, 2725 .stop_sch_tx = rtw89_mac_stop_sch_tx_v1, 2726 .resume_sch_tx = rtw89_mac_resume_sch_tx_v1, 2727 .h2c_dctl_sec_cam = rtw89_fw_h2c_dctl_sec_cam_v1, 2728 2729 .btc_set_rfe = rtw8852c_btc_set_rfe, 2730 .btc_init_cfg = rtw8852c_btc_init_cfg, 2731 .btc_set_wl_pri = rtw8852c_btc_set_wl_pri, 2732 .btc_set_wl_txpwr_ctrl = rtw8852c_btc_set_wl_txpwr_ctrl, 2733 .btc_get_bt_rssi = rtw8852c_btc_get_bt_rssi, 2734 .btc_bt_aci_imp = rtw8852c_btc_bt_aci_imp, 2735 .btc_update_bt_cnt = rtw8852c_btc_update_bt_cnt, 2736 .btc_wl_s1_standby = rtw8852c_btc_wl_s1_standby, 2737 }; 2738 2739 const struct rtw89_chip_info rtw8852c_chip_info = { 2740 .chip_id = RTL8852C, 2741 .ops = &rtw8852c_chip_ops, 2742 .fw_name = "rtw89/rtw8852c_fw.bin", 2743 .hfc_param_ini = rtw8852c_hfc_param_ini_pcie, 2744 .dle_mem = rtw8852c_dle_mem_pcie, 2745 .rf_base_addr = {0xe000, 0xf000}, 2746 .pwr_on_seq = NULL, 2747 .pwr_off_seq = NULL, 2748 .bb_table = &rtw89_8852c_phy_bb_table, 2749 .bb_gain_table = &rtw89_8852c_phy_bb_gain_table, 2750 .rf_table = {&rtw89_8852c_phy_radiob_table, 2751 &rtw89_8852c_phy_radioa_table,}, 2752 .nctl_table = &rtw89_8852c_phy_nctl_table, 2753 .byr_table = &rtw89_8852c_byr_table, 2754 .txpwr_lmt_2g = &rtw89_8852c_txpwr_lmt_2g, 2755 .txpwr_lmt_5g = &rtw89_8852c_txpwr_lmt_5g, 2756 .txpwr_lmt_6g = &rtw89_8852c_txpwr_lmt_6g, 2757 .txpwr_lmt_ru_2g = &rtw89_8852c_txpwr_lmt_ru_2g, 2758 .txpwr_lmt_ru_5g = &rtw89_8852c_txpwr_lmt_ru_5g, 2759 .txpwr_lmt_ru_6g = &rtw89_8852c_txpwr_lmt_ru_6g, 2760 .txpwr_factor_rf = 2, 2761 .txpwr_factor_mac = 1, 2762 .dig_table = NULL, 2763 .tssi_dbw_table = &rtw89_8852c_tssi_dbw_table, 2764 .hw_sec_hdr = true, 2765 .sec_ctrl_efuse_size = 4, 2766 .physical_efuse_size = 1216, 2767 .logical_efuse_size = 2048, 2768 .limit_efuse_size = 1280, 2769 .dav_phy_efuse_size = 96, 2770 .dav_log_efuse_size = 16, 2771 .phycap_addr = 0x590, 2772 .phycap_size = 0x60, 2773 .low_power_hci_modes = BIT(RTW89_PS_MODE_CLK_GATED) | 2774 BIT(RTW89_PS_MODE_PWR_GATED), 2775 .h2c_cctl_func_id = H2C_FUNC_MAC_CCTLINFO_UD_V1, 2776 .hci_func_en_addr = R_AX_HCI_FUNC_EN_V1, 2777 .h2c_desc_size = sizeof(struct rtw89_rxdesc_short), 2778 .txwd_body_size = sizeof(struct rtw89_txwd_body_v1), 2779 .h2c_ctrl_reg = R_AX_H2CREG_CTRL_V1, 2780 .h2c_regs = rtw8852c_h2c_regs, 2781 .c2h_ctrl_reg = R_AX_C2HREG_CTRL_V1, 2782 .c2h_regs = rtw8852c_c2h_regs, 2783 .page_regs = &rtw8852c_page_regs, 2784 .dcfo_comp = &rtw8852c_dcfo_comp, 2785 .dcfo_comp_sft = 5, 2786 .imr_info = &rtw8852c_imr_info 2787 }; 2788 EXPORT_SYMBOL(rtw8852c_chip_info); 2789 2790 MODULE_FIRMWARE("rtw89/rtw8852c_fw.bin"); 2791 MODULE_AUTHOR("Realtek Corporation"); 2792 MODULE_DESCRIPTION("Realtek 802.11ax wireless 8852C driver"); 2793 MODULE_LICENSE("Dual BSD/GPL"); 2794