Commit 633f77b5 authored by Lorenzo Bianconi's avatar Lorenzo Bianconi Committed by Felix Fietkau
Browse files

mt76: mt76x02: introduce SAR support 



Add SAR spec support to mt76x02 driver to allow configuring SAR power
limitations on the frequency ranges from the userland.

Signed-off-by: default avatarLorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent b3cb885e

drivers/net/wireless/mediatek/mt76/mt76x0/init.c

+4 −1
Original line number Diff line number Diff line
@@ -237,7 +237,10 @@ int mt76x0_register_device(struct mt76x02_dev *dev) 
{

	int ret;



	mt76x02_init_device(dev);

	ret = mt76x02_init_device(dev);

	if (ret)

		return ret;



	mt76x02_config_mac_addr_list(dev);



	ret = mt76_register_device(&dev->mt76, true, mt76x02_rates,

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

+32 −2
Original line number Diff line number Diff line
@@ -31,6 +31,32 @@ mt76x0_set_channel(struct mt76x02_dev *dev, struct cfg80211_chan_def *chandef) 
	mt76_txq_schedule_all(&dev->mphy);

}



int mt76x0_set_sar_specs(struct ieee80211_hw *hw,

			 const struct cfg80211_sar_specs *sar)

{

	int err = -EINVAL, power = hw->conf.power_level * 2;

	struct mt76x02_dev *dev = hw->priv;

	struct mt76_phy *mphy = &dev->mphy;



	mutex_lock(&dev->mt76.mutex);

	if (!cfg80211_chandef_valid(&mphy->chandef))

		goto out;



	err = mt76_init_sar_power(hw, sar);

	if (err)

		goto out;



	dev->txpower_conf = mt76_get_sar_power(mphy, mphy->chandef.chan,

					       power);

	if (test_bit(MT76_STATE_RUNNING, &mphy->state))

		mt76x0_phy_set_txpower(dev);

out:

	mutex_unlock(&dev->mt76.mutex);



	return err;

}

EXPORT_SYMBOL_GPL(mt76x0_set_sar_specs);



int mt76x0_config(struct ieee80211_hw *hw, u32 changed)

{

	struct mt76x02_dev *dev = hw->priv;
@@ -44,9 +70,13 @@ int mt76x0_config(struct ieee80211_hw *hw, u32 changed) 
	}



	if (changed & IEEE80211_CONF_CHANGE_POWER) {

		dev->txpower_conf = hw->conf.power_level * 2;

		struct mt76_phy *mphy = &dev->mphy;



		if (test_bit(MT76_STATE_RUNNING, &dev->mphy.state))

		dev->txpower_conf = hw->conf.power_level * 2;

		dev->txpower_conf = mt76_get_sar_power(mphy,

						       mphy->chandef.chan,

						       dev->txpower_conf);

		if (test_bit(MT76_STATE_RUNNING, &mphy->state))

			mt76x0_phy_set_txpower(dev);

	}

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

+2 −0
Original line number Diff line number Diff line
@@ -49,6 +49,8 @@ void mt76x0_chip_onoff(struct mt76x02_dev *dev, bool enable, bool reset); 
void mt76x0_mac_stop(struct mt76x02_dev *dev);



int mt76x0_config(struct ieee80211_hw *hw, u32 changed);

int mt76x0_set_sar_specs(struct ieee80211_hw *hw,

			 const struct cfg80211_sar_specs *sar);



/* PHY */

void mt76x0_phy_init(struct mt76x02_dev *dev);

drivers/net/wireless/mediatek/mt76/mt76x0/pci.c

+1 −0
Original line number Diff line number Diff line
@@ -85,6 +85,7 @@ static const struct ieee80211_ops mt76x0e_ops = { 
	.set_rts_threshold = mt76x02_set_rts_threshold,

	.get_antenna = mt76_get_antenna,

	.reconfig_complete = mt76x02_reconfig_complete,

	.set_sar_specs = mt76x0_set_sar_specs,

};



static int mt76x0e_init_hardware(struct mt76x02_dev *dev, bool resume)

drivers/net/wireless/mediatek/mt76/mt76x0/usb.c

+1 −0
Original line number Diff line number Diff line
@@ -141,6 +141,7 @@ static const struct ieee80211_ops mt76x0u_ops = { 
	.set_tim = mt76_set_tim,

	.release_buffered_frames = mt76_release_buffered_frames,

	.get_antenna = mt76_get_antenna,

	.set_sar_specs = mt76x0_set_sar_specs,

};



static int mt76x0u_init_hardware(struct mt76x02_dev *dev, bool reset)