Commit f75e4779 authored by Shayne Chen's avatar Shayne Chen Committed by Felix Fietkau
Browse files

wifi: mt76: mt7996: add txpower setting support 



Add support for setting txpower from upper layer and configuring per-rate
txpower limit table.

Co-developed-by: default avatarAllen Ye <allen.ye@mediatek.com>
Signed-off-by: default avatarAllen Ye <allen.ye@mediatek.com>
Co-developed-by: default avatarStanleyYP Wang <StanleyYP.Wang@mediatek.com>
Signed-off-by: default avatarStanleyYP Wang <StanleyYP.Wang@mediatek.com>
Signed-off-by: default avatarShayne Chen <shayne.chen@mediatek.com>
Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent 11a60bd2

drivers/net/wireless/mediatek/mt76/mt7996/main.c

+8 −0
Original line number Diff line number Diff line
@@ -396,6 +396,13 @@ static int mt7996_config(struct ieee80211_hw *hw, u32 changed) 
		ieee80211_wake_queues(hw);

	}



	if (changed & (IEEE80211_CONF_CHANGE_POWER |

		       IEEE80211_CONF_CHANGE_CHANNEL)) {

		ret = mt7996_mcu_set_txpower_sku(phy);

		if (ret)

			return ret;

	}



	mutex_lock(&dev->mt76.mutex);



	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
@@ -965,6 +972,7 @@ mt7996_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant) 
	mt76_set_stream_caps(phy->mt76, true);

	mt7996_set_stream_vht_txbf_caps(phy);

	mt7996_set_stream_he_eht_caps(phy);

	mt7996_mcu_set_txpower_sku(phy);



	mutex_unlock(&dev->mt76.mutex);

drivers/net/wireless/mediatek/mt76/mt7996/mcu.c

+58 −0
Original line number Diff line number Diff line
@@ -4353,3 +4353,61 @@ int mt7996_mcu_wed_rro_reset_sessions(struct mt7996_dev *dev, u16 id) 
	return mt76_mcu_send_msg(&dev->mt76, MCU_WM_UNI_CMD(RRO), &req,

				 sizeof(req), true);

}



int mt7996_mcu_set_txpower_sku(struct mt7996_phy *phy)

{

#define TX_POWER_LIMIT_TABLE_RATE	0

	struct mt7996_dev *dev = phy->dev;

	struct mt76_phy *mphy = phy->mt76;

	struct ieee80211_hw *hw = mphy->hw;

	struct tx_power_limit_table_ctrl {

		u8 __rsv1[4];



		__le16 tag;

		__le16 len;

		u8 power_ctrl_id;

		u8 power_limit_type;

		u8 band_idx;

	} __packed req = {

		.tag = cpu_to_le16(UNI_TXPOWER_POWER_LIMIT_TABLE_CTRL),

		.len = cpu_to_le16(sizeof(req) + MT7996_SKU_RATE_NUM - 4),

		.power_ctrl_id = UNI_TXPOWER_POWER_LIMIT_TABLE_CTRL,

		.power_limit_type = TX_POWER_LIMIT_TABLE_RATE,

		.band_idx = phy->mt76->band_idx,

	};

	struct mt76_power_limits la = {};

	struct sk_buff *skb;

	int i, tx_power;



	tx_power = mt7996_get_power_bound(phy, hw->conf.power_level);

	tx_power = mt76_get_rate_power_limits(mphy, mphy->chandef.chan,

					      &la, tx_power);

	mphy->txpower_cur = tx_power;



	skb = mt76_mcu_msg_alloc(&dev->mt76, NULL,

				 sizeof(req) + MT7996_SKU_RATE_NUM);

	if (!skb)

		return -ENOMEM;



	skb_put_data(skb, &req, sizeof(req));

	/* cck and ofdm */

	skb_put_data(skb, &la.cck, sizeof(la.cck) + sizeof(la.ofdm));

	/* ht20 */

	skb_put_data(skb, &la.mcs[0], 8);

	/* ht40 */

	skb_put_data(skb, &la.mcs[1], 9);



	/* vht */

	for (i = 0; i < 4; i++) {

		skb_put_data(skb, &la.mcs[i], sizeof(la.mcs[i]));

		skb_put_zero(skb, 2);  /* padding */

	}



	/* he */

	skb_put_data(skb, &la.ru[0], sizeof(la.ru));

	/* eht */

	skb_put_data(skb, &la.eht[0], sizeof(la.eht));



	return mt76_mcu_skb_send_msg(&dev->mt76, skb,

				     MCU_WM_UNI_CMD(TXPOWER), true);

}

drivers/net/wireless/mediatek/mt76/mt7996/mcu.h

+16 −0
Original line number Diff line number Diff line
@@ -762,6 +762,18 @@ enum { 
#define MT7996_MAX_BSS_OFFLOAD_SIZE	(MT7996_MAX_BEACON_SIZE +		\

					 MT7996_BEACON_UPDATE_SIZE)



static inline s8

mt7996_get_power_bound(struct mt7996_phy *phy, s8 txpower)

{

	struct mt76_phy *mphy = phy->mt76;

	int n_chains = hweight16(mphy->chainmask);



	txpower = mt76_get_sar_power(mphy, mphy->chandef.chan, txpower * 2);

	txpower -= mt76_tx_power_nss_delta(n_chains);



	return txpower;

}



enum {

	UNI_BAND_CONFIG_RADIO_ENABLE,

	UNI_BAND_CONFIG_RTS_THRESHOLD = 0x08,
@@ -830,6 +842,10 @@ enum { 
	UNI_CMD_THERMAL_PROTECT_DUTY_CONFIG,

};



enum {

	UNI_TXPOWER_POWER_LIMIT_TABLE_CTRL = 4,

};



enum {

	UNI_CMD_ACCESS_REG_BASIC = 0x0,

	UNI_CMD_ACCESS_RF_REG_BASIC,

drivers/net/wireless/mediatek/mt76/mt7996/mt7996.h

+3 −0
Original line number Diff line number Diff line
@@ -42,6 +42,8 @@ 
#define MT7996_CFEND_RATE_DEFAULT	0x49	/* OFDM 24M */

#define MT7996_CFEND_RATE_11B		0x03	/* 11B LP, 11M */



#define MT7996_SKU_RATE_NUM		417



#define MT7996_MAX_TWT_AGRT		16

#define MT7996_MAX_STA_TWT_AGRT		8

#define MT7996_MAX_QUEUE		(__MT_RXQ_MAX +	__MT_MCUQ_MAX + 3)
@@ -471,6 +473,7 @@ int mt7996_mcu_get_chan_mib_info(struct mt7996_phy *phy, bool chan_switch); 
int mt7996_mcu_get_temperature(struct mt7996_phy *phy);

int mt7996_mcu_set_thermal_throttling(struct mt7996_phy *phy, u8 state);

int mt7996_mcu_set_thermal_protect(struct mt7996_phy *phy, bool enable);

int mt7996_mcu_set_txpower_sku(struct mt7996_phy *phy);

int mt7996_mcu_rdd_cmd(struct mt7996_dev *dev, int cmd, u8 index,

		       u8 rx_sel, u8 val);

int mt7996_mcu_rdd_background_enable(struct mt7996_phy *phy,