Commit 0d88aea8 authored by Ryder Lee's avatar Ryder Lee Committed by Felix Fietkau
Browse files

mt76: mt7615: add set_antenna callback 



Add a set_antenna callback to setup per phy tx/rx streams.

Signed-off-by: default avatarShayne Chen <shayne.chen@mediatek.com>
Signed-off-by: default avatarRyder Lee <ryder.lee@mediatek.com>
Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent 4fe9218c

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

+27 −0
Original line number Diff line number Diff line
@@ -642,6 +642,32 @@ mt7615_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class) 
	mt7615_mac_set_timing(phy);

}



static int

mt7615_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)

{

	struct mt7615_dev *dev = mt7615_hw_dev(hw);

	struct mt7615_phy *phy = mt7615_hw_phy(hw);

	int max_nss = hweight8(hw->wiphy->available_antennas_tx);

	bool ext_phy = phy != &dev->phy;



	if (!tx_ant || tx_ant != rx_ant || ffs(tx_ant) > max_nss)

		return -EINVAL;



	if ((BIT(hweight8(tx_ant)) - 1) != tx_ant)

		tx_ant = BIT(ffs(tx_ant) - 1) - 1;



	mutex_lock(&dev->mt76.mutex);



	phy->mt76->antenna_mask = tx_ant;

	phy->chainmask = ext_phy ? tx_ant << 2 : tx_ant;



	mt76_set_stream_caps(&dev->mt76, true);



	mutex_unlock(&dev->mt76.mutex);



	return 0;

}



const struct ieee80211_ops mt7615_ops = {

	.tx = mt7615_tx,

	.start = mt7615_start,
@@ -666,5 +692,6 @@ const struct ieee80211_ops mt7615_ops = { 
	.channel_switch_beacon = mt7615_channel_switch_beacon,

	.get_survey = mt76_get_survey,

	.get_antenna = mt76_get_antenna,

	.set_antenna = mt7615_set_antenna,

	.set_coverage_class = mt7615_set_coverage_class,

};