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

mt76: mt7615: add .set_tsf callback 



It is useful for IBSS Mesh to adjust t_clockdrift.

Signed-off-by: default avatarRyder Lee <ryder.lee@mediatek.com>
Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent b807b368

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

+21 −0
Original line number Diff line number Diff line
@@ -740,6 +740,26 @@ mt7615_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) 
	return tsf.t64;

}



static void

mt7615_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif,

	       u64 timestamp)

{

	struct mt7615_dev *dev = mt7615_hw_dev(hw);

	union {

		u64 t64;

		u32 t32[2];

	} tsf = { .t64 = timestamp, };



	mutex_lock(&dev->mt76.mutex);



	mt76_wr(dev, MT_LPON_UTTR0, tsf.t32[0]);

	mt76_wr(dev, MT_LPON_UTTR1, tsf.t32[1]);

	/* TSF software overwrite */

	mt76_set(dev, MT_LPON_T0CR, MT_LPON_T0CR_WRITE);



	mutex_unlock(&dev->mt76.mutex);

}



static void

mt7615_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class)

{
@@ -1038,6 +1058,7 @@ const struct ieee80211_ops mt7615_ops = { 
	.channel_switch_beacon = mt7615_channel_switch_beacon,

	.get_stats = mt7615_get_stats,

	.get_tsf = mt7615_get_tsf,

	.set_tsf = mt7615_set_tsf,

	.get_survey = mt76_get_survey,

	.get_antenna = mt76_get_antenna,

	.set_antenna = mt7615_set_antenna,

drivers/net/wireless/mediatek/mt76/mt7615/regs.h

+1 −0
Original line number Diff line number Diff line
@@ -417,6 +417,7 @@ enum mt7615_reg_base { 


#define MT_LPON_T0CR			MT_LPON(0x010)

#define MT_LPON_T0CR_MODE		GENMASK(1, 0)

#define MT_LPON_T0CR_WRITE		BIT(0)



#define MT_LPON_UTTR0			MT_LPON(0x018)

#define MT_LPON_UTTR1			MT_LPON(0x01c)