mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-29 23:24:11 +08:00
wifi: rtw89: introduce rtw89_chan for channel stuffs
Introduce struct rtw89_chan ahead to encapsulate stuffs from struct rtw89_channel_params. These stuffs have a clone in HAL and are used throughout driver. After multiple channels support, it's expected that each channel instance has a configuration of them. So, we refine them with struct rtw89_chan by precise type first, and will re-arrange HAL by struct rtw89_chan in the following as well. (No logic has changed.) Signed-off-by: Zong-Zhe Yang <kevin_yang@realtek.com> Signed-off-by: Ping-Ke Shih <pkshih@realtek.com> Signed-off-by: Kalle Valo <kvalo@kernel.org> Link: https://lore.kernel.org/r/20220809104952.61355-3-pkshih@realtek.com
This commit is contained in:
parent
967439c7a2
commit
3e5831cac1
@ -226,7 +226,7 @@ static void rtw89_traffic_stats_accu(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
|
||||
static void rtw89_get_channel_params(struct cfg80211_chan_def *chandef,
|
||||
struct rtw89_channel_params *chan_param)
|
||||
struct rtw89_chan *chan)
|
||||
{
|
||||
struct ieee80211_channel *channel = chandef->chan;
|
||||
enum nl80211_chan_width width = chandef->width;
|
||||
@ -344,13 +344,13 @@ static void rtw89_get_channel_params(struct cfg80211_chan_def *chandef,
|
||||
break;
|
||||
}
|
||||
|
||||
chan_param->center_chan = center_chan;
|
||||
chan_param->center_freq = center_freq;
|
||||
chan_param->primary_chan = channel->hw_value;
|
||||
chan_param->bandwidth = bandwidth;
|
||||
chan_param->pri_ch_idx = primary_chan_idx;
|
||||
chan_param->band_type = band;
|
||||
chan_param->subband_type = subband;
|
||||
chan->channel = center_chan;
|
||||
chan->freq = center_freq;
|
||||
chan->primary_channel = channel->hw_value;
|
||||
chan->band_type = band;
|
||||
chan->band_width = bandwidth;
|
||||
chan->subband_type = subband;
|
||||
chan->pri_ch_idx = primary_chan_idx;
|
||||
}
|
||||
|
||||
void rtw89_core_set_chip_txpwr(struct rtw89_dev *rtwdev)
|
||||
@ -371,7 +371,7 @@ void rtw89_set_channel(struct rtw89_dev *rtwdev)
|
||||
struct ieee80211_hw *hw = rtwdev->hw;
|
||||
const struct rtw89_chip_info *chip = rtwdev->chip;
|
||||
struct rtw89_hal *hal = &rtwdev->hal;
|
||||
struct rtw89_channel_params ch_param;
|
||||
struct rtw89_chan chan;
|
||||
struct rtw89_channel_help_params bak;
|
||||
u8 center_chan, bandwidth;
|
||||
bool band_changed;
|
||||
@ -379,28 +379,28 @@ void rtw89_set_channel(struct rtw89_dev *rtwdev)
|
||||
|
||||
entity_active = rtw89_get_entity_state(rtwdev);
|
||||
|
||||
rtw89_get_channel_params(&hw->conf.chandef, &ch_param);
|
||||
if (WARN(ch_param.center_chan == 0, "Invalid channel\n"))
|
||||
rtw89_get_channel_params(&hw->conf.chandef, &chan);
|
||||
if (WARN(chan.channel == 0, "Invalid channel\n"))
|
||||
return;
|
||||
|
||||
center_chan = ch_param.center_chan;
|
||||
bandwidth = ch_param.bandwidth;
|
||||
band_changed = hal->current_band_type != ch_param.band_type;
|
||||
center_chan = chan.channel;
|
||||
bandwidth = chan.band_width;
|
||||
band_changed = hal->current_band_type != chan.band_type;
|
||||
|
||||
hal->current_band_width = bandwidth;
|
||||
hal->current_channel = center_chan;
|
||||
hal->current_freq = ch_param.center_freq;
|
||||
hal->current_freq = chan.freq;
|
||||
hal->prev_primary_channel = hal->current_primary_channel;
|
||||
hal->prev_band_type = hal->current_band_type;
|
||||
hal->current_primary_channel = ch_param.primary_chan;
|
||||
hal->current_band_type = ch_param.band_type;
|
||||
hal->current_subband = ch_param.subband_type;
|
||||
hal->current_primary_channel = chan.primary_channel;
|
||||
hal->current_band_type = chan.band_type;
|
||||
hal->current_subband = chan.subband_type;
|
||||
|
||||
rtw89_set_entity_state(rtwdev, true);
|
||||
|
||||
rtw89_chip_set_channel_prepare(rtwdev, &bak);
|
||||
|
||||
chip->ops->set_channel(rtwdev, &ch_param);
|
||||
chip->ops->set_channel(rtwdev, &chan);
|
||||
|
||||
rtw89_core_set_chip_txpwr(rtwdev);
|
||||
|
||||
|
@ -624,14 +624,14 @@ enum rtw89_sc_offset {
|
||||
RTW89_SC_40_LOWER = 10,
|
||||
};
|
||||
|
||||
struct rtw89_channel_params {
|
||||
u8 center_chan;
|
||||
u32 center_freq;
|
||||
u8 primary_chan;
|
||||
u8 bandwidth;
|
||||
u8 pri_ch_idx;
|
||||
u8 band_type;
|
||||
u8 subband_type;
|
||||
struct rtw89_chan {
|
||||
u8 channel;
|
||||
u32 freq;
|
||||
u8 primary_channel;
|
||||
enum rtw89_band band_type;
|
||||
enum rtw89_bandwidth band_width;
|
||||
enum rtw89_subband subband_type;
|
||||
enum rtw89_sc_offset pri_ch_idx;
|
||||
};
|
||||
|
||||
struct rtw89_channel_help_params {
|
||||
@ -2100,7 +2100,7 @@ struct rtw89_chip_ops {
|
||||
bool (*write_rf)(struct rtw89_dev *rtwdev, enum rtw89_rf_path rf_path,
|
||||
u32 addr, u32 mask, u32 data);
|
||||
void (*set_channel)(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param);
|
||||
const struct rtw89_chan *chan);
|
||||
void (*set_channel_help)(struct rtw89_dev *rtwdev, bool enter,
|
||||
struct rtw89_channel_help_params *p);
|
||||
int (*read_efuse)(struct rtw89_dev *rtwdev, u8 *log_map);
|
||||
|
@ -542,12 +542,12 @@ void rtw89_phy_ra_assoc(struct rtw89_dev *rtwdev, struct ieee80211_sta *sta)
|
||||
}
|
||||
|
||||
u8 rtw89_phy_get_txsc(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_bandwidth dbw)
|
||||
{
|
||||
enum rtw89_bandwidth cbw = param->bandwidth;
|
||||
u8 pri_ch = param->primary_chan;
|
||||
u8 central_ch = param->center_chan;
|
||||
enum rtw89_bandwidth cbw = chan->band_width;
|
||||
u8 pri_ch = chan->primary_channel;
|
||||
u8 central_ch = chan->channel;
|
||||
u8 txsc_idx = 0;
|
||||
u8 tmp = 0;
|
||||
|
||||
|
@ -439,7 +439,7 @@ rtw89_rfk_parser(struct rtw89_dev *rtwdev, const struct rtw89_rfk_tbl *tbl);
|
||||
void rtw89_phy_write_reg3_tbl(struct rtw89_dev *rtwdev,
|
||||
const struct rtw89_phy_reg3_tbl *tbl);
|
||||
u8 rtw89_phy_get_txsc(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_bandwidth dbw);
|
||||
u32 rtw89_phy_read_rf(struct rtw89_dev *rtwdev, enum rtw89_rf_path rf_path,
|
||||
u32 addr, u32 mask);
|
||||
|
@ -660,7 +660,7 @@ static void rtw8852a_power_trim(struct rtw89_dev *rtwdev)
|
||||
}
|
||||
|
||||
static void rtw8852a_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
u8 mac_idx)
|
||||
{
|
||||
u32 rf_mod = rtw89_mac_reg_by_idx(R_AX_WMAC_RFMOD, mac_idx);
|
||||
@ -669,20 +669,20 @@ static void rtw8852a_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
u32 chk_rate = rtw89_mac_reg_by_idx(R_AX_TXRATE_CHK, mac_idx);
|
||||
u8 txsc20 = 0, txsc40 = 0;
|
||||
|
||||
switch (param->bandwidth) {
|
||||
switch (chan->band_width) {
|
||||
case RTW89_CHANNEL_WIDTH_80:
|
||||
txsc40 = rtw89_phy_get_txsc(rtwdev, param,
|
||||
txsc40 = rtw89_phy_get_txsc(rtwdev, chan,
|
||||
RTW89_CHANNEL_WIDTH_40);
|
||||
fallthrough;
|
||||
case RTW89_CHANNEL_WIDTH_40:
|
||||
txsc20 = rtw89_phy_get_txsc(rtwdev, param,
|
||||
txsc20 = rtw89_phy_get_txsc(rtwdev, chan,
|
||||
RTW89_CHANNEL_WIDTH_20);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
switch (param->bandwidth) {
|
||||
switch (chan->band_width) {
|
||||
case RTW89_CHANNEL_WIDTH_80:
|
||||
rtw89_write8_mask(rtwdev, rf_mod, B_AX_WMAC_RFMOD_MASK, BIT(1));
|
||||
rtw89_write32(rtwdev, sub_carr, txsc20 | (txsc40 << 4));
|
||||
@ -699,7 +699,7 @@ static void rtw8852a_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
break;
|
||||
}
|
||||
|
||||
if (param->center_chan > 14)
|
||||
if (chan->channel > 14)
|
||||
rtw89_write8_set(rtwdev, chk_rate,
|
||||
B_AX_CHECK_CCK_EN | B_AX_RTS_LIMIT_IN_OFDM6);
|
||||
else
|
||||
@ -1130,35 +1130,36 @@ static void rtw8852a_bbrst_for_rfk(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
|
||||
static void rtw8852a_set_channel_bb(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
bool cck_en = param->center_chan <= 14;
|
||||
u8 pri_ch_idx = param->pri_ch_idx;
|
||||
bool cck_en = chan->channel <= 14;
|
||||
u8 pri_ch_idx = chan->pri_ch_idx;
|
||||
|
||||
if (cck_en)
|
||||
rtw8852a_ctrl_sco_cck(rtwdev, param->center_chan,
|
||||
param->primary_chan, param->bandwidth);
|
||||
rtw8852a_ctrl_sco_cck(rtwdev, chan->channel,
|
||||
chan->primary_channel,
|
||||
chan->band_width);
|
||||
|
||||
rtw8852a_ctrl_ch(rtwdev, param->center_chan, phy_idx);
|
||||
rtw8852a_ctrl_bw(rtwdev, pri_ch_idx, param->bandwidth, phy_idx);
|
||||
rtw8852a_ctrl_ch(rtwdev, chan->channel, phy_idx);
|
||||
rtw8852a_ctrl_bw(rtwdev, pri_ch_idx, chan->band_width, phy_idx);
|
||||
if (cck_en) {
|
||||
rtw89_phy_write32_mask(rtwdev, R_RXCCA, B_RXCCA_DIS, 0);
|
||||
} else {
|
||||
rtw89_phy_write32_mask(rtwdev, R_RXCCA, B_RXCCA_DIS, 1);
|
||||
rtw8852a_bbrst_for_rfk(rtwdev, phy_idx);
|
||||
}
|
||||
rtw8852a_spur_elimination(rtwdev, param->center_chan);
|
||||
rtw8852a_spur_elimination(rtwdev, chan->channel);
|
||||
rtw89_phy_write32_mask(rtwdev, R_MAC_PIN_SEL, B_CH_IDX_SEG0,
|
||||
param->primary_chan);
|
||||
chan->primary_channel);
|
||||
rtw8852a_bb_reset_all(rtwdev, phy_idx);
|
||||
}
|
||||
|
||||
static void rtw8852a_set_channel(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *params)
|
||||
const struct rtw89_chan *chan)
|
||||
{
|
||||
rtw8852a_set_channel_mac(rtwdev, params, RTW89_MAC_0);
|
||||
rtw8852a_set_channel_bb(rtwdev, params, RTW89_PHY_0);
|
||||
rtw8852a_set_channel_mac(rtwdev, chan, RTW89_MAC_0);
|
||||
rtw8852a_set_channel_bb(rtwdev, chan, RTW89_PHY_0);
|
||||
}
|
||||
|
||||
static void rtw8852a_dfs_en(struct rtw89_dev *rtwdev, bool en)
|
||||
|
@ -567,7 +567,7 @@ static void rtw8852c_power_trim(struct rtw89_dev *rtwdev)
|
||||
}
|
||||
|
||||
static void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
u8 mac_idx)
|
||||
{
|
||||
u32 rf_mod = rtw89_mac_reg_by_idx(R_AX_WMAC_RFMOD, mac_idx);
|
||||
@ -578,24 +578,24 @@ static void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
u8 rf_mod_val = 0, chk_rate_mask = 0;
|
||||
u32 txsc;
|
||||
|
||||
switch (param->bandwidth) {
|
||||
switch (chan->band_width) {
|
||||
case RTW89_CHANNEL_WIDTH_160:
|
||||
txsc80 = rtw89_phy_get_txsc(rtwdev, param,
|
||||
txsc80 = rtw89_phy_get_txsc(rtwdev, chan,
|
||||
RTW89_CHANNEL_WIDTH_80);
|
||||
fallthrough;
|
||||
case RTW89_CHANNEL_WIDTH_80:
|
||||
txsc40 = rtw89_phy_get_txsc(rtwdev, param,
|
||||
txsc40 = rtw89_phy_get_txsc(rtwdev, chan,
|
||||
RTW89_CHANNEL_WIDTH_40);
|
||||
fallthrough;
|
||||
case RTW89_CHANNEL_WIDTH_40:
|
||||
txsc20 = rtw89_phy_get_txsc(rtwdev, param,
|
||||
txsc20 = rtw89_phy_get_txsc(rtwdev, chan,
|
||||
RTW89_CHANNEL_WIDTH_20);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
switch (param->bandwidth) {
|
||||
switch (chan->band_width) {
|
||||
case RTW89_CHANNEL_WIDTH_160:
|
||||
rf_mod_val = AX_WMAC_RFMOD_160M;
|
||||
txsc = FIELD_PREP(B_AX_TXSC_20M_MASK, txsc20) |
|
||||
@ -620,7 +620,7 @@ static void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
rtw89_write8_mask(rtwdev, rf_mod, B_AX_WMAC_RFMOD_MASK, rf_mod_val);
|
||||
rtw89_write32(rtwdev, sub_carr, txsc);
|
||||
|
||||
switch (param->band_type) {
|
||||
switch (chan->band_type) {
|
||||
case RTW89_BAND_2G:
|
||||
chk_rate_mask = B_AX_BAND_MODE;
|
||||
break;
|
||||
@ -629,7 +629,7 @@ static void rtw8852c_set_channel_mac(struct rtw89_dev *rtwdev,
|
||||
chk_rate_mask = B_AX_CHECK_CCK_EN | B_AX_RTS_LIMIT_IN_OFDM6;
|
||||
break;
|
||||
default:
|
||||
rtw89_warn(rtwdev, "Invalid band_type:%d\n", param->band_type);
|
||||
rtw89_warn(rtwdev, "Invalid band_type:%d\n", chan->band_type);
|
||||
return;
|
||||
}
|
||||
rtw89_write8_clr(rtwdev, chk_rate, B_AX_BAND_MODE | B_AX_CHECK_CCK_EN |
|
||||
@ -920,7 +920,7 @@ static void rtw8852c_decode_chan_idx(struct rtw89_dev *rtwdev, u8 chan_idx,
|
||||
}
|
||||
|
||||
static void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev,
|
||||
const struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx,
|
||||
enum rtw89_rf_path path)
|
||||
{
|
||||
@ -939,7 +939,7 @@ static void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev,
|
||||
if (rtwdev->dbcc_en && path == RF_PATH_B)
|
||||
phy_idx = RTW89_PHY_1;
|
||||
|
||||
if (param->band_type == RTW89_BAND_2G) {
|
||||
if (chan->band_type == RTW89_BAND_2G) {
|
||||
offset_q0 = efuse_gain->offset[path][RTW89_GAIN_OFFSET_2G_CCK];
|
||||
offset_base_q4 = efuse_gain->offset_base[phy_idx];
|
||||
|
||||
@ -948,7 +948,7 @@ static void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev,
|
||||
rtw89_phy_write32_mask(rtwdev, R_RPL_OFST, B_RPL_OFST_MASK, tmp & 0x7f);
|
||||
}
|
||||
|
||||
switch (param->subband_type) {
|
||||
switch (chan->subband_type) {
|
||||
default:
|
||||
case RTW89_CH_2G:
|
||||
gain_band = RTW89_GAIN_OFFSET_2G_OFDM;
|
||||
@ -977,14 +977,14 @@ static void rtw8852c_set_gain_offset(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
|
||||
static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev,
|
||||
const struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
u8 sco;
|
||||
u16 central_freq = param->center_freq;
|
||||
u8 central_ch = param->center_chan;
|
||||
u8 band = param->band_type;
|
||||
u8 subband = param->subband_type;
|
||||
u16 central_freq = chan->freq;
|
||||
u8 central_ch = chan->channel;
|
||||
u8 band = chan->band_type;
|
||||
u8 subband = chan->subband_type;
|
||||
bool is_2g = band == RTW89_BAND_2G;
|
||||
u8 chan_idx;
|
||||
|
||||
@ -996,7 +996,7 @@ static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev,
|
||||
if (phy_idx == RTW89_PHY_0) {
|
||||
/* Path A */
|
||||
rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_A);
|
||||
rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_A);
|
||||
rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_A);
|
||||
|
||||
if (is_2g)
|
||||
rtw89_phy_write32_idx(rtwdev, R_PATH0_BAND_SEL_V1,
|
||||
@ -1009,7 +1009,7 @@ static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev,
|
||||
/* Path B */
|
||||
if (!rtwdev->dbcc_en) {
|
||||
rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B);
|
||||
rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_B);
|
||||
rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_B);
|
||||
|
||||
if (is_2g)
|
||||
rtw89_phy_write32_idx(rtwdev,
|
||||
@ -1038,7 +1038,7 @@ static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev,
|
||||
} else {
|
||||
/* Path B */
|
||||
rtw8852c_set_gain_error(rtwdev, subband, RF_PATH_B);
|
||||
rtw8852c_set_gain_offset(rtwdev, param, phy_idx, RF_PATH_B);
|
||||
rtw8852c_set_gain_offset(rtwdev, chan, phy_idx, RF_PATH_B);
|
||||
|
||||
if (is_2g)
|
||||
rtw89_phy_write32_idx(rtwdev, R_PATH1_BAND_SEL_V1,
|
||||
@ -1095,7 +1095,7 @@ static void rtw8852c_ctrl_ch(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
}
|
||||
|
||||
chan_idx = rtw8852c_encode_chan_idx(rtwdev, param->primary_chan, band);
|
||||
chan_idx = rtw8852c_encode_chan_idx(rtwdev, chan->primary_channel, band);
|
||||
rtw89_phy_write32_idx(rtwdev, R_MAC_PIN_SEL, B_CH_IDX_SEG0, chan_idx, phy_idx);
|
||||
}
|
||||
|
||||
@ -1246,12 +1246,12 @@ rtw8852c_ctrl_bw(struct rtw89_dev *rtwdev, u8 pri_ch, u8 bw,
|
||||
}
|
||||
|
||||
static u32 rtw8852c_spur_freq(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param)
|
||||
const struct rtw89_chan *chan)
|
||||
{
|
||||
u8 center_chan = param->center_chan;
|
||||
u8 bw = param->bandwidth;
|
||||
u8 center_chan = chan->channel;
|
||||
u8 bw = chan->band_width;
|
||||
|
||||
switch (param->band_type) {
|
||||
switch (chan->band_type) {
|
||||
case RTW89_BAND_2G:
|
||||
if (bw == RTW89_CHANNEL_WIDTH_20) {
|
||||
if (center_chan >= 5 && center_chan <= 8)
|
||||
@ -1285,19 +1285,19 @@ static u32 rtw8852c_spur_freq(struct rtw89_dev *rtwdev,
|
||||
#define MAX_TONE_NUM 2048
|
||||
|
||||
static void rtw8852c_set_csi_tone_idx(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
u32 spur_freq;
|
||||
s32 freq_diff, csi_idx, csi_tone_idx;
|
||||
|
||||
spur_freq = rtw8852c_spur_freq(rtwdev, param);
|
||||
spur_freq = rtw8852c_spur_freq(rtwdev, chan);
|
||||
if (spur_freq == 0) {
|
||||
rtw89_phy_write32_idx(rtwdev, R_SEG0CSI_EN, B_SEG0CSI_EN, 0, phy_idx);
|
||||
return;
|
||||
}
|
||||
|
||||
freq_diff = (spur_freq - param->center_freq) * 1000000;
|
||||
freq_diff = (spur_freq - chan->freq) * 1000000;
|
||||
csi_idx = s32_div_u32_round_closest(freq_diff, CARRIER_SPACING_78_125);
|
||||
s32_div_u32_round_down(csi_idx, MAX_TONE_NUM, &csi_tone_idx);
|
||||
|
||||
@ -1325,7 +1325,7 @@ static const struct rtw89_nbi_reg_def rtw8852c_nbi_reg_def[] = {
|
||||
};
|
||||
|
||||
static void rtw8852c_set_nbi_tone_idx(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_rf_path path)
|
||||
{
|
||||
const struct rtw89_nbi_reg_def *nbi = &rtw8852c_nbi_reg_def[path];
|
||||
@ -1335,34 +1335,37 @@ static void rtw8852c_set_nbi_tone_idx(struct rtw89_dev *rtwdev,
|
||||
s32 nbi_frac_idx, nbi_frac_tone_idx;
|
||||
bool notch2_chk = false;
|
||||
|
||||
spur_freq = rtw8852c_spur_freq(rtwdev, param);
|
||||
spur_freq = rtw8852c_spur_freq(rtwdev, chan);
|
||||
if (spur_freq == 0) {
|
||||
rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0);
|
||||
rtw89_phy_write32_mask(rtwdev, nbi->notch1_en.addr, nbi->notch1_en.mask, 0);
|
||||
return;
|
||||
}
|
||||
|
||||
fc = param->center_freq;
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_160) {
|
||||
fc = chan->freq;
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_160) {
|
||||
fc = (spur_freq > fc) ? fc + 40 : fc - 40;
|
||||
if ((fc > spur_freq && param->center_chan < param->primary_chan) ||
|
||||
(fc < spur_freq && param->center_chan > param->primary_chan))
|
||||
if ((fc > spur_freq &&
|
||||
chan->channel < chan->primary_channel) ||
|
||||
(fc < spur_freq &&
|
||||
chan->channel > chan->primary_channel))
|
||||
notch2_chk = true;
|
||||
}
|
||||
|
||||
freq_diff = (spur_freq - fc) * 1000000;
|
||||
nbi_idx = s32_div_u32_round_down(freq_diff, CARRIER_SPACING_312_5, &nbi_frac_idx);
|
||||
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_20) {
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_20) {
|
||||
s32_div_u32_round_down(nbi_idx + 32, 64, &nbi_tone_idx);
|
||||
} else {
|
||||
u16 tone_para = (param->bandwidth == RTW89_CHANNEL_WIDTH_40) ? 128 : 256;
|
||||
u16 tone_para = (chan->band_width == RTW89_CHANNEL_WIDTH_40) ?
|
||||
128 : 256;
|
||||
|
||||
s32_div_u32_round_down(nbi_idx, tone_para, &nbi_tone_idx);
|
||||
}
|
||||
nbi_frac_tone_idx = s32_div_u32_round_closest(nbi_frac_idx, CARRIER_SPACING_78_125);
|
||||
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 && notch2_chk) {
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_160 && notch2_chk) {
|
||||
rtw89_phy_write32_mask(rtwdev, nbi->notch2_idx.addr,
|
||||
nbi->notch2_idx.mask, nbi_tone_idx);
|
||||
rtw89_phy_write32_mask(rtwdev, nbi->notch2_frac_idx.addr,
|
||||
@ -1404,42 +1407,42 @@ static void rtw8852c_spur_notch(struct rtw89_dev *rtwdev, u32 val,
|
||||
}
|
||||
|
||||
static void rtw8852c_spur_elimination(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
u8 pri_ch_idx,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
rtw8852c_set_csi_tone_idx(rtwdev, param, phy_idx);
|
||||
rtw8852c_set_csi_tone_idx(rtwdev, chan, phy_idx);
|
||||
|
||||
if (phy_idx == RTW89_PHY_0) {
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 &&
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_160 &&
|
||||
(pri_ch_idx == RTW89_SC_20_LOWER ||
|
||||
pri_ch_idx == RTW89_SC_20_UP3X)) {
|
||||
rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_0);
|
||||
if (!rtwdev->dbcc_en)
|
||||
rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_1);
|
||||
} else if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 &&
|
||||
} else if (chan->band_width == RTW89_CHANNEL_WIDTH_160 &&
|
||||
(pri_ch_idx == RTW89_SC_20_UPPER ||
|
||||
pri_ch_idx == RTW89_SC_20_LOW3X)) {
|
||||
rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_0);
|
||||
if (!rtwdev->dbcc_en)
|
||||
rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_1);
|
||||
} else {
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, param, RF_PATH_A);
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, chan, RF_PATH_A);
|
||||
if (!rtwdev->dbcc_en)
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, param,
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, chan,
|
||||
RF_PATH_B);
|
||||
}
|
||||
} else {
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 &&
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_160 &&
|
||||
(pri_ch_idx == RTW89_SC_20_LOWER ||
|
||||
pri_ch_idx == RTW89_SC_20_UP3X)) {
|
||||
rtw8852c_spur_notch(rtwdev, 0xe7f, RTW89_PHY_1);
|
||||
} else if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 &&
|
||||
} else if (chan->band_width == RTW89_CHANNEL_WIDTH_160 &&
|
||||
(pri_ch_idx == RTW89_SC_20_UPPER ||
|
||||
pri_ch_idx == RTW89_SC_20_LOW3X)) {
|
||||
rtw8852c_spur_notch(rtwdev, 0x280, RTW89_PHY_1);
|
||||
} else {
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, param, RF_PATH_B);
|
||||
rtw8852c_set_nbi_tone_idx(rtwdev, chan, RF_PATH_B);
|
||||
}
|
||||
}
|
||||
|
||||
@ -1450,14 +1453,14 @@ static void rtw8852c_spur_elimination(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
|
||||
static void rtw8852c_5m_mask(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
u8 pri_ch = param->primary_chan;
|
||||
u8 pri_ch = chan->primary_channel;
|
||||
bool mask_5m_low;
|
||||
bool mask_5m_en;
|
||||
|
||||
switch (param->bandwidth) {
|
||||
switch (chan->band_width) {
|
||||
case RTW89_CHANNEL_WIDTH_40:
|
||||
mask_5m_en = true;
|
||||
mask_5m_low = pri_ch == 2;
|
||||
@ -1690,21 +1693,22 @@ static void rtw8852c_bb_sethw(struct rtw89_dev *rtwdev)
|
||||
}
|
||||
|
||||
static void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
bool cck_en = param->band_type == RTW89_BAND_2G;
|
||||
u8 pri_ch_idx = param->pri_ch_idx;
|
||||
bool cck_en = chan->band_type == RTW89_BAND_2G;
|
||||
u8 pri_ch_idx = chan->pri_ch_idx;
|
||||
u32 mask, reg;
|
||||
u32 ru_alloc_msk[2] = {B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY0,
|
||||
B_P80_AT_HIGH_FREQ_RU_ALLOC_PHY1};
|
||||
|
||||
if (param->band_type == RTW89_BAND_2G)
|
||||
rtw8852c_ctrl_sco_cck(rtwdev, param->center_chan,
|
||||
param->primary_chan, param->bandwidth);
|
||||
if (chan->band_type == RTW89_BAND_2G)
|
||||
rtw8852c_ctrl_sco_cck(rtwdev, chan->channel,
|
||||
chan->primary_channel,
|
||||
chan->band_width);
|
||||
|
||||
rtw8852c_ctrl_ch(rtwdev, param, phy_idx);
|
||||
rtw8852c_ctrl_bw(rtwdev, pri_ch_idx, param->bandwidth, phy_idx);
|
||||
rtw8852c_ctrl_ch(rtwdev, chan, phy_idx);
|
||||
rtw8852c_ctrl_bw(rtwdev, pri_ch_idx, chan->band_width, phy_idx);
|
||||
if (cck_en) {
|
||||
rtw89_phy_write32_mask(rtwdev, R_UPD_CLK_ADC, B_ENABLE_CCK, 1);
|
||||
rtw89_phy_write32_mask(rtwdev, R_RXCCA_V1, B_RXCCA_DIS_V1, 0);
|
||||
@ -1717,17 +1721,17 @@ static void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev,
|
||||
B_PD_ARBITER_OFF, 0x1, phy_idx);
|
||||
}
|
||||
|
||||
rtw8852c_spur_elimination(rtwdev, param, pri_ch_idx, phy_idx);
|
||||
rtw8852c_ctrl_btg(rtwdev, param->band_type == RTW89_BAND_2G);
|
||||
rtw8852c_5m_mask(rtwdev, param, phy_idx);
|
||||
rtw8852c_spur_elimination(rtwdev, chan, pri_ch_idx, phy_idx);
|
||||
rtw8852c_ctrl_btg(rtwdev, chan->band_type == RTW89_BAND_2G);
|
||||
rtw8852c_5m_mask(rtwdev, chan, phy_idx);
|
||||
|
||||
if (param->bandwidth == RTW89_CHANNEL_WIDTH_160 &&
|
||||
if (chan->band_width == RTW89_CHANNEL_WIDTH_160 &&
|
||||
rtwdev->hal.cv != CHIP_CAV) {
|
||||
rtw89_phy_write32_idx(rtwdev, R_P80_AT_HIGH_FREQ,
|
||||
B_P80_AT_HIGH_FREQ, 0x0, phy_idx);
|
||||
reg = rtw89_mac_reg_by_idx(R_P80_AT_HIGH_FREQ_BB_WRP,
|
||||
phy_idx);
|
||||
if (param->primary_chan > param->center_chan) {
|
||||
if (chan->primary_channel > chan->channel) {
|
||||
rtw89_phy_write32_mask(rtwdev,
|
||||
R_P80_AT_HIGH_FREQ_RU_ALLOC,
|
||||
ru_alloc_msk[phy_idx], 1);
|
||||
@ -1742,8 +1746,8 @@ static void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
}
|
||||
|
||||
if (param->band_type == RTW89_BAND_6G &&
|
||||
param->bandwidth == RTW89_CHANNEL_WIDTH_160)
|
||||
if (chan->band_type == RTW89_BAND_6G &&
|
||||
chan->band_width == RTW89_CHANNEL_WIDTH_160)
|
||||
rtw89_phy_write32_idx(rtwdev, R_CDD_EVM_CHK_EN,
|
||||
B_CDD_EVM_CHK_EN, 0, phy_idx);
|
||||
else
|
||||
@ -1773,11 +1777,11 @@ static void rtw8852c_set_channel_bb(struct rtw89_dev *rtwdev,
|
||||
}
|
||||
|
||||
static void rtw8852c_set_channel(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *params)
|
||||
const struct rtw89_chan *chan)
|
||||
{
|
||||
rtw8852c_set_channel_mac(rtwdev, params, RTW89_MAC_0);
|
||||
rtw8852c_set_channel_bb(rtwdev, params, RTW89_PHY_0);
|
||||
rtw8852c_set_channel_rf(rtwdev, params, RTW89_PHY_0);
|
||||
rtw8852c_set_channel_mac(rtwdev, chan, RTW89_MAC_0);
|
||||
rtw8852c_set_channel_bb(rtwdev, chan, RTW89_PHY_0);
|
||||
rtw8852c_set_channel_rf(rtwdev, chan, RTW89_PHY_0);
|
||||
}
|
||||
|
||||
static void rtw8852c_dfs_en(struct rtw89_dev *rtwdev, bool en)
|
||||
|
@ -3802,11 +3802,12 @@ void rtw8852c_ctrl_bw_ch(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy,
|
||||
}
|
||||
|
||||
void rtw8852c_set_channel_rf(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx)
|
||||
{
|
||||
rtw8852c_ctrl_bw_ch(rtwdev, phy_idx, param->center_chan, param->band_type,
|
||||
param->bandwidth);
|
||||
rtw8852c_ctrl_bw_ch(rtwdev, phy_idx, chan->channel,
|
||||
chan->band_type,
|
||||
chan->band_width);
|
||||
}
|
||||
|
||||
void rtw8852c_mcc_get_ch_info(struct rtw89_dev *rtwdev, enum rtw89_phy_idx phy_idx)
|
||||
|
@ -21,7 +21,7 @@ void rtw8852c_tssi_cont_en_phyidx(struct rtw89_dev *rtwdev, bool en, u8 phy_idx)
|
||||
void rtw8852c_wifi_scan_notify(struct rtw89_dev *rtwdev, bool scan_start,
|
||||
enum rtw89_phy_idx phy_idx);
|
||||
void rtw8852c_set_channel_rf(struct rtw89_dev *rtwdev,
|
||||
struct rtw89_channel_params *param,
|
||||
const struct rtw89_chan *chan,
|
||||
enum rtw89_phy_idx phy_idx);
|
||||
void rtw8852c_lck_init(struct rtw89_dev *rtwdev);
|
||||
void rtw8852c_lck_track(struct rtw89_dev *rtwdev);
|
||||
|
Loading…
Reference in New Issue
Block a user