Commit 56d965da authored by Sean Wang's avatar Sean Wang Committed by Felix Fietkau
Browse files

mt76: mt7921: introduce 802.11 PS support in sta mode 



Enable 802.11 power-save support available in mt7921 firmware

Co-developed-by: default avatarLorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: default avatarLorenzo Bianconi <lorenzo@kernel.org>
Co-developed-by: default avatarSoul Huang <Soul.Huang@mediatek.com>
Signed-off-by: default avatarSoul Huang <Soul.Huang@mediatek.com>
Signed-off-by: default avatarSean Wang <sean.wang@mediatek.com>
Signed-off-by: default avatarFelix Fietkau <nbd@nbd.name>
parent 29f9d8b0

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

+2 −0
Original line number Diff line number Diff line
@@ -83,6 +83,8 @@ mt7921_init_wiphy(struct ieee80211_hw *hw) 
	ieee80211_hw_set(hw, HAS_RATE_CONTROL);

	ieee80211_hw_set(hw, SUPPORTS_TX_ENCAP_OFFLOAD);

	ieee80211_hw_set(hw, WANT_MONITOR_VIF);

	ieee80211_hw_set(hw, SUPPORTS_PS);

	ieee80211_hw_set(hw, SUPPORTS_DYNAMIC_PS);



	hw->max_tx_fragments = 4;

}

drivers/net/wireless/mediatek/mt76/mt7921/mac.c

+1 −2
Original line number Diff line number Diff line
@@ -690,8 +690,7 @@ void mt7921_mac_write_txwi(struct mt7921_dev *dev, __le32 *txwi, 
	txwi[1] = cpu_to_le32(val);

	txwi[2] = 0;



	val = MT_TXD3_SW_POWER_MGMT |

	      FIELD_PREP(MT_TXD3_REM_TX_COUNT, tx_count);

	val = FIELD_PREP(MT_TXD3_REM_TX_COUNT, tx_count);

	if (key)

		val |= MT_TXD3_PROTECT_FRAME;

	if (info->flags & IEEE80211_TX_CTL_NO_ACK)

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

+3 −0
Original line number Diff line number Diff line
@@ -561,6 +561,9 @@ static void mt7921_bss_info_changed(struct ieee80211_hw *hw, 
	if (changed & (BSS_CHANGED_QOS | BSS_CHANGED_BEACON_ENABLED))

		mt7921_mcu_set_tx(dev, vif);



	if (changed & BSS_CHANGED_PS)

		mt7921_mcu_uni_bss_ps(dev, vif);



	mutex_unlock(&dev->mt76.mutex);

}

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

+37 −0
Original line number Diff line number Diff line
@@ -2463,3 +2463,40 @@ u32 mt7921_get_wtbl_info(struct mt7921_dev *dev, u16 wlan_idx) 


	return 0;

}



int mt7921_mcu_uni_bss_ps(struct mt7921_dev *dev, struct ieee80211_vif *vif)

{

	struct mt7921_vif *mvif = (struct mt7921_vif *)vif->drv_priv;

	struct {

		struct {

			u8 bss_idx;

			u8 pad[3];

		} __packed hdr;

		struct ps_tlv {

			__le16 tag;

			__le16 len;

			u8 ps_state; /* 0: device awake

				      * 1: static power save

				      * 2: dynamic power saving

				      * 3: enter TWT power saving

				      * 4: leave TWT power saving

				      */

			u8 pad[3];

		} __packed ps;

	} __packed ps_req = {

		.hdr = {

			.bss_idx = mvif->mt76.idx,

		},

		.ps = {

			.tag = cpu_to_le16(UNI_BSS_INFO_PS),

			.len = cpu_to_le16(sizeof(struct ps_tlv)),

			.ps_state = vif->bss_conf.ps ? 2 : 0,

		},

	};



	if (vif->type != NL80211_IFTYPE_STATION)

		return -EOPNOTSUPP;



	return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD_BSS_INFO_UPDATE,

				 &ps_req, sizeof(ps_req), true);

}

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

+1 −1
Original line number Diff line number Diff line
@@ -185,7 +185,6 @@ struct mt7921_mcu_uni_event { 
/* offload mcu commands */

enum {

	MCU_CMD_START_HW_SCAN = MCU_CE_PREFIX | 0x03,

	MCU_CMD_SET_PS_PROFILE = MCU_CE_PREFIX | 0x05,

	MCU_CMD_SET_CHAN_DOMAIN = MCU_CE_PREFIX | 0x0f,

	MCU_CMD_SET_BSS_CONNECTED = MCU_CE_PREFIX | 0x16,

	MCU_CMD_SET_BSS_ABORT = MCU_CE_PREFIX | 0x17,
@@ -211,6 +210,7 @@ enum { 
	UNI_BSS_INFO_BCN_CONTENT = 7,

	UNI_BSS_INFO_QBSS = 15,

	UNI_BSS_INFO_UAPSD = 19,

	UNI_BSS_INFO_PS = 21,

};



enum {