}
}
-const struct rtw89_chan *__rtw89_mgnt_chan_get(struct rtw89_dev *rtwdev,
- const char *caller_message,
- u8 link_index, bool nullchk)
-{
- struct rtw89_hal *hal = &rtwdev->hal;
- struct rtw89_entity_mgnt *mgnt = &hal->entity_mgnt;
- enum rtw89_chanctx_idx chanctx_idx;
- u8 role_index;
-
- lockdep_assert_wiphy(rtwdev->hw->wiphy);
-
- if (unlikely(link_index >= __RTW89_MLD_MAX_LINK_NUM)) {
- WARN(1, "link index %u is invalid (max link inst num: %d)\n",
- link_index, __RTW89_MLD_MAX_LINK_NUM);
- goto dflt;
- }
-
- role_index = rtw89_entity_role_get_index(rtwdev);
-
- chanctx_idx = mgnt->chanctx_tbl[role_index][link_index];
- if (chanctx_idx == RTW89_CHANCTX_IDLE)
- goto dflt;
-
- return rtw89_chan_get(rtwdev, chanctx_idx);
-
-dflt:
- if (unlikely(nullchk))
- return NULL;
-
- rtw89_debug(rtwdev, RTW89_DBG_CHAN,
- "%s (%s): prefetch NULL on link index %u\n",
- __func__, caller_message ?: "", link_index);
-
- return rtw89_chan_get(rtwdev, RTW89_CHANCTX_0);
-}
-EXPORT_SYMBOL(__rtw89_mgnt_chan_get);
-
bool rtw89_entity_check_hw(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx)
{
switch (rtwdev->mlo_dbcc_mode) {
rtw89_debug(rtwdev, RTW89_DBG_CHAN, "%s: (none)\n", __func__);
}
+void rtw89_entity_get_conf(struct rtw89_dev *rtwdev, struct rtw89_entity_conf *conf)
+{
+ struct rtw89_entity_mgnt *mgnt = &rtwdev->hal.entity_mgnt;
+ enum rtw89_chanctx_idx idxes[ARRAY_SIZE(conf->chans)];
+ struct rtw89_vif *role;
+ u8 ridx;
+ int i;
+
+ lockdep_assert_wiphy(rtwdev->hw->wiphy);
+
+ memset(conf, 0, sizeof(*conf));
+
+ ridx = rtw89_entity_role_get_index(rtwdev);
+ role = mgnt->active_roles[ridx];
+ if (role) {
+ struct ieee80211_vif *vif = rtwvif_to_vif(role);
+
+ conf->is_mld = ieee80211_vif_is_mld(vif);
+ conf->en_emlsr = role->mlo_mode == RTW89_MLO_MODE_EMLSR;
+ }
+
+ for (i = 0; i < ARRAY_SIZE(idxes); i++)
+ idxes[i] = RTW89_CHANCTX_IDLE;
+
+ switch (rtwdev->mlo_dbcc_mode) {
+ default:
+ case MLO_2_PLUS_0_1RF:
+ set_bit(0, conf->hw_bitmap);
+ idxes[0] = mgnt->chanctx_tbl[ridx][0];
+ idxes[1] = idxes[0];
+ break;
+ case MLO_0_PLUS_2_1RF:
+ set_bit(1, conf->hw_bitmap);
+ idxes[1] = mgnt->chanctx_tbl[ridx][1];
+ idxes[0] = idxes[1];
+ break;
+ case MLO_1_PLUS_1_1RF:
+ set_bit(0, conf->hw_bitmap);
+ set_bit(1, conf->hw_bitmap);
+ idxes[0] = mgnt->chanctx_tbl[ridx][0];
+ idxes[1] = mgnt->chanctx_tbl[ridx][1];
+ break;
+ }
+
+ for (i = 0; i < ARRAY_SIZE(idxes); i++) {
+ if (idxes[i] == RTW89_CHANCTX_IDLE)
+ idxes[i] = RTW89_CHANCTX_0;
+
+ conf->chans[i] = rtw89_chan_get(rtwdev, idxes[i]);
+ }
+}
+EXPORT_SYMBOL(rtw89_entity_get_conf);
+
static enum rtw89_mlo_dbcc_mode
rtw89_entity_sel_mlo_dbcc_mode(struct rtw89_dev *rtwdev, u8 active_hws)
{
unsigned int active_roles;
};
+struct rtw89_entity_conf {
+ bool is_mld;
+ bool en_emlsr;
+ DECLARE_BITMAP(hw_bitmap, __RTW89_MLD_MAX_LINK_NUM);
+ const struct rtw89_chan *chans[__RTW89_MLD_MAX_LINK_NUM];
+};
+
static inline bool rtw89_get_entity_state(struct rtw89_dev *rtwdev,
enum rtw89_phy_idx phy_idx)
{
enum rtw89_entity_mode rtw89_entity_recalc(struct rtw89_dev *rtwdev);
bool rtw89_entity_check_hw(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx);
void rtw89_entity_force_hw(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx);
+void rtw89_entity_get_conf(struct rtw89_dev *rtwdev, struct rtw89_entity_conf *conf);
void rtw89_chanctx_work(struct wiphy *wiphy, struct wiphy_work *work);
void rtw89_queue_chanctx_work(struct rtw89_dev *rtwdev);
void rtw89_queue_chanctx_change(struct rtw89_dev *rtwdev,
void rtw89_chanctx_proceed(struct rtw89_dev *rtwdev,
const struct rtw89_chanctx_cb_parm *cb_parm);
-const struct rtw89_chan *__rtw89_mgnt_chan_get(struct rtw89_dev *rtwdev,
- const char *caller_message,
- u8 link_index, bool nullchk);
-
-#define rtw89_mgnt_chan_get(rtwdev, link_index) \
- __rtw89_mgnt_chan_get(rtwdev, __func__, link_index, false)
-
-static inline const struct rtw89_chan *
-rtw89_mgnt_chan_get_or_null(struct rtw89_dev *rtwdev, u8 link_index)
-{
- return __rtw89_mgnt_chan_get(rtwdev, NULL, link_index, true);
-}
-
struct rtw89_mcc_links_info {
struct rtw89_vif_link *links[NUM_OF_RTW89_MCC_ROLES];
};
void rtw89_core_set_chip_txpwr(struct rtw89_dev *rtwdev)
{
- const struct rtw89_chan *chan;
+ struct rtw89_entity_conf conf;
+
+ rtw89_entity_get_conf(rtwdev, &conf);
- chan = rtw89_mgnt_chan_get(rtwdev, 0);
- __rtw89_core_set_chip_txpwr(rtwdev, chan, RTW89_PHY_0);
+ __rtw89_core_set_chip_txpwr(rtwdev, conf.chans[0], RTW89_PHY_0);
if (rtwdev->chip->chip_gen == RTW89_CHIP_AX)
return;
- chan = rtw89_mgnt_chan_get(rtwdev, 1);
- __rtw89_core_set_chip_txpwr(rtwdev, chan, RTW89_PHY_1);
+ __rtw89_core_set_chip_txpwr(rtwdev, conf.chans[1], RTW89_PHY_1);
}
void rtw89_chip_rfk_channel(struct rtw89_dev *rtwdev,
int rtw89_set_channel(struct rtw89_dev *rtwdev)
{
- const struct rtw89_chan *chan;
+ struct rtw89_entity_conf conf;
enum rtw89_entity_mode mode;
mode = rtw89_entity_recalc(rtwdev);
return -EINVAL;
}
- chan = rtw89_mgnt_chan_get(rtwdev, 0);
- __rtw89_set_channel(rtwdev, chan, RTW89_MAC_0, RTW89_PHY_0);
+ rtw89_entity_get_conf(rtwdev, &conf);
+
+ __rtw89_set_channel(rtwdev, conf.chans[0], RTW89_MAC_0, RTW89_PHY_0);
if (rtwdev->chip->chip_gen == RTW89_CHIP_AX)
return 0;
- chan = rtw89_mgnt_chan_get(rtwdev, 1);
- __rtw89_set_channel(rtwdev, chan, RTW89_MAC_1, RTW89_PHY_1);
+ __rtw89_set_channel(rtwdev, conf.chans[1], RTW89_MAC_1, RTW89_PHY_1);
return 0;
}
static void rtw89_phy_dig_update_para(struct rtw89_dev *rtwdev,
struct rtw89_bb_ctx *bb)
{
- const struct rtw89_chan *chan = rtw89_mgnt_chan_get(rtwdev, bb->phy_idx);
struct rtw89_dig_info *dig = &bb->dig;
bool is_linked = rtwdev->total_sta_assoc > 0;
+ struct rtw89_entity_conf conf;
+ const struct rtw89_chan *chan;
const u16 *fa_th_src = NULL;
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan = conf.chans[bb->phy_idx];
+
switch (chan->band_type) {
case RTW89_BAND_2G:
dig->lna_gain = dig->lna_gain_g;
struct rtw89_bb_ctx *bb,
u8 rssi, bool enable)
{
- const struct rtw89_chan *chan = rtw89_mgnt_chan_get(rtwdev, bb->phy_idx);
const struct rtw89_dig_regs *dig_regs = rtwdev->chip->dig_regs;
struct rtw89_dig_info *dig = &bb->dig;
struct rtw89_hal *hal = &rtwdev->hal;
u8 final_rssi, under_region = dig->pd_low_th_ofst;
+ struct rtw89_entity_conf conf;
+ const struct rtw89_chan *chan;
s8 cck_cca_th;
u32 pd_val;
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan = conf.chans[bb->phy_idx];
+
if (hal->disabled_dm_bitmap & BIT(RTW89_DM_DIG_PD)) {
pd_val = hal->fixed_dig_pd_th;
{
enum rtw89_phy_idx phy_idx = mac_idx != RTW89_MAC_0 ? RTW89_PHY_1 : RTW89_PHY_0;
enum rtw89_core_chip_id chip_id = rtwdev->chip->chip_id;
+ struct rtw89_entity_conf conf;
const struct rtw89_chan *chan;
if (chip_id != RTL8922D)
rtw89_phy_bb_wrap_set_rfsi_ct_opt(rtwdev, phy_idx);
- chan = rtw89_mgnt_chan_get(rtwdev, phy_idx);
- if (chan)
- rtw89_phy_bb_wrap_set_rfsi_bandedge_ch(rtwdev, chan, phy_idx);
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan = conf.chans[phy_idx];
+
+ rtw89_phy_bb_wrap_set_rfsi_bandedge_ch(rtwdev, chan, phy_idx);
}
static void rtw89_phy_bb_wrap_ul_pwr(struct rtw89_dev *rtwdev)
void rtw8852b_mcc_get_ch_info(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx)
{
- const struct rtw89_chan *chan = rtw89_mgnt_chan_get(rtwdev, 0);
struct rtw89_rfk_mcc_info_data *rfk_mcc = rtwdev->rfk_mcc.data;
struct rtw89_rfk_chan_desc desc[__RTW89_RFK_CHS_NR_V0] = {};
+ struct rtw89_entity_conf conf;
+ const struct rtw89_chan *chan;
u8 idx;
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan = conf.chans[0];
+
for (idx = 0; idx < ARRAY_SIZE(desc); idx++) {
struct rtw89_rfk_chan_desc *p = &desc[idx];
void rtw8852bt_mcc_get_ch_info(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx)
{
- const struct rtw89_chan *chan = rtw89_mgnt_chan_get(rtwdev, 0);
struct rtw89_rfk_mcc_info_data *rfk_mcc = rtwdev->rfk_mcc.data;
struct rtw89_rfk_chan_desc desc[__RTW89_RFK_CHS_NR_V0] = {};
+ struct rtw89_entity_conf conf;
+ const struct rtw89_chan *chan;
u8 idx;
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan = conf.chans[0];
+
for (idx = 0; idx < ARRAY_SIZE(desc); idx++) {
struct rtw89_rfk_chan_desc *p = &desc[idx];
static int rtw8922a_ctrl_mlo(struct rtw89_dev *rtwdev, enum rtw89_mlo_dbcc_mode mode)
{
- const struct rtw89_chan *chan0, *chan1;
+ struct rtw89_entity_conf conf;
if (mode == MLO_1_PLUS_1_1RF || mode == DBCC_LEGACY) {
rtw89_phy_write32_mask(rtwdev, R_DBCC, B_DBCC_EN, 0x1);
return -EOPNOTSUPP;
}
- if (mode == MLO_1_PLUS_1_1RF) {
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- } else if (mode == MLO_0_PLUS_2_1RF) {
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- chan0 = chan1;
- } else {
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = chan0;
- }
+ rtw89_entity_get_conf(rtwdev, &conf);
- rtw8922a_ctrl_afe_dac(rtwdev, chan0->band_width, RF_PATH_A);
- rtw8922a_ctrl_afe_dac(rtwdev, chan1->band_width, RF_PATH_B);
+ rtw8922a_ctrl_afe_dac(rtwdev, conf.chans[0]->band_width, RF_PATH_A);
+ rtw8922a_ctrl_afe_dac(rtwdev, conf.chans[1]->band_width, RF_PATH_B);
rtw89_phy_write32_mask(rtwdev, R_EMLSR, B_EMLSR_PARM, 0x6180);
static void rtw8922a_chlk_reload(struct rtw89_dev *rtwdev)
{
- const struct rtw89_chan *chan0, *chan1;
+ struct rtw89_entity_conf conf;
u8 s0_tbl, s1_tbl;
- switch (rtwdev->mlo_dbcc_mode) {
- default:
- case MLO_2_PLUS_0_1RF:
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = chan0;
- break;
- case MLO_0_PLUS_2_1RF:
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- chan0 = chan1;
- break;
- case MLO_1_PLUS_1_1RF:
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- break;
- }
+ rtw89_entity_get_conf(rtwdev, &conf);
- s0_tbl = rtw8922a_chlk_reload_sel_tbl(rtwdev, chan0, 0);
- s1_tbl = rtw8922a_chlk_reload_sel_tbl(rtwdev, chan1, 1);
+ s0_tbl = rtw8922a_chlk_reload_sel_tbl(rtwdev, conf.chans[0], 0);
+ s1_tbl = rtw8922a_chlk_reload_sel_tbl(rtwdev, conf.chans[1], 1);
rtw8922a_chlk_ktbl_sel(rtwdev, RF_A, s0_tbl);
rtw8922a_chlk_ktbl_sel(rtwdev, RF_B, s1_tbl);
static void rtw8922d_digital_pwr_comp(struct rtw89_dev *rtwdev,
enum rtw89_phy_idx phy_idx)
{
- const struct rtw89_chan *chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- const struct rtw89_chan *chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
-
- if (rtwdev->mlo_dbcc_mode == MLO_1_PLUS_1_1RF) {
+ const struct rtw89_chan *chan0, *chan1;
+ struct rtw89_entity_conf conf;
+
+ rtw89_entity_get_conf(rtwdev, &conf);
+ chan0 = conf.chans[0];
+ chan1 = conf.chans[1];
+
+ if (conf.en_emlsr) {
+ rtw8922d_set_digital_pwr_comp(rtwdev, chan0, 1, RF_PATH_A, RTW89_PHY_0);
+ rtw8922d_set_digital_pwr_comp(rtwdev, chan0, 1, RF_PATH_B, RTW89_PHY_0);
+ rtw8922d_set_digital_pwr_comp(rtwdev, chan1, 1, RF_PATH_A, RTW89_PHY_1);
+ rtw8922d_set_digital_pwr_comp(rtwdev, chan1, 1, RF_PATH_B, RTW89_PHY_1);
+ } else if (rtwdev->mlo_dbcc_mode == MLO_1_PLUS_1_1RF) {
rtw8922d_set_digital_pwr_comp(rtwdev, chan0, 0, RF_PATH_A, RTW89_PHY_0);
rtw8922d_set_digital_pwr_comp(rtwdev, chan1, 0, RF_PATH_B, RTW89_PHY_1);
} else {
static int rtw8922d_ctrl_mlo(struct rtw89_dev *rtwdev, enum rtw89_mlo_dbcc_mode mode,
bool pwr_comp)
{
- const struct rtw89_chan *chan1;
u32 reg0, reg1;
u8 cck_phy_idx;
rtw89_write32_mask(rtwdev, reg0, B_BBWRAP_ELMSR_EN_BE4, 0);
rtw89_write32_mask(rtwdev, reg1, B_BBWRAP_ELMSR_EN_BE4, 0);
} else if ((mode == MLO_1_PLUS_1_1RF) || (mode == DBCC_LEGACY)) {
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- cck_phy_idx = chan1->band_type == RTW89_BAND_2G ?
+ struct rtw89_entity_conf conf;
+
+ rtw89_entity_get_conf(rtwdev, &conf);
+ cck_phy_idx = conf.chans[1]->band_type == RTW89_BAND_2G ?
RTW89_PHY_1 : RTW89_PHY_0;
rtw89_phy_write32_mask(rtwdev, R_SYS_DBCC_BE4,
static void rtw8922d_set_txpwr_ctrl(struct rtw89_dev *rtwdev,
enum rtw89_phy_idx phy_idx)
{
- const struct rtw89_chan *chan = rtw89_mgnt_chan_get(rtwdev, phy_idx);
+ struct rtw89_entity_conf conf;
- rtw8922d_set_txpwr_ref(rtwdev, chan, phy_idx);
+ rtw89_entity_get_conf(rtwdev, &conf);
+
+ rtw8922d_set_txpwr_ref(rtwdev, conf.chans[phy_idx], phy_idx);
}
static void rtw8922d_ctrl_trx_path(struct rtw89_dev *rtwdev,
static void rtw8922d_chlk_reload(struct rtw89_dev *rtwdev)
{
- const struct rtw89_chan *chan0, *chan1;
+ struct rtw89_entity_conf conf;
u8 s0_tbl, s1_tbl;
- switch (rtwdev->mlo_dbcc_mode) {
- default:
- case MLO_2_PLUS_0_1RF:
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = chan0;
- break;
- case MLO_0_PLUS_2_1RF:
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- chan0 = chan1;
- break;
- case MLO_1_PLUS_1_1RF:
- chan0 = rtw89_mgnt_chan_get(rtwdev, 0);
- chan1 = rtw89_mgnt_chan_get(rtwdev, 1);
- break;
- }
+ rtw89_entity_get_conf(rtwdev, &conf);
- s0_tbl = rtw8922d_chlk_reload_sel_tbl(rtwdev, chan0, 0);
- s1_tbl = rtw8922d_chlk_reload_sel_tbl(rtwdev, chan1, 1);
+ s0_tbl = rtw8922d_chlk_reload_sel_tbl(rtwdev, conf.chans[0], 0);
+ s1_tbl = rtw8922d_chlk_reload_sel_tbl(rtwdev, conf.chans[1], 1);
rtw8922d_chlk_ktbl_sel(rtwdev, RF_A, s0_tbl);
rtw8922d_chlk_ktbl_sel(rtwdev, RF_B, s1_tbl);