wifi: mt76: mt7925: add link handling in the BSS_CHANGED_PS handler

Added link handling in the BSS_CHANGED_PS handler.

Co-developed-by: Ming Yen Hsieh <mingyen.hsieh@mediatek.com>
Signed-off-by: Ming Yen Hsieh <mingyen.hsieh@mediatek.com>
Co-developed-by: Deren Wu <deren.wu@mediatek.com>
Signed-off-by: Deren Wu <deren.wu@mediatek.com>
Signed-off-by: Sean Wang <sean.wang@mediatek.com>
Link: https://patch.msgid.link/542ca29261af0cac007d2cb821ed36284d51c679.1720248331.git.sean.wang@kernel.org
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt7925/main.c b/drivers/net/wireless/mediatek/mt76/mt7925/main.c
index 957e6bcaf9c1f25c96c918344791ba0ca1af4f3e..938909ab8d1cde511bb401b063b87d5170b5bcc6 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7925/main.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7925/main.c
@@ -1637,6 +1637,7 @@ static void mt7925_vif_cfg_changed(struct ieee80211_hw *hw,
                                   struct ieee80211_vif *vif,
                                   u64 changed)
 {
+       struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
        struct mt792x_dev *dev = mt792x_hw_dev(hw);
 
        mt792x_mutex_acquire(dev);
@@ -1653,8 +1654,17 @@ static void mt7925_vif_cfg_changed(struct ieee80211_hw *hw,
                mt7925_mcu_update_arp_filter(&dev->mt76, &mvif->bss_conf.mt76);
        }
 
-       if (changed & BSS_CHANGED_PS)
-               mt7925_mcu_uni_bss_ps(dev, &vif->bss_conf);
+       if (changed & BSS_CHANGED_PS) {
+               unsigned long valid = ieee80211_vif_is_mld(vif) ?
+                                             mvif->valid_links : BIT(0);
+               struct ieee80211_bss_conf *bss_conf;
+               int i;
+
+               for_each_set_bit(i, &valid, IEEE80211_MLD_MAX_NUM_LINKS) {
+                       bss_conf = mt792x_vif_to_bss_conf(vif, i);
+                       mt7925_mcu_uni_bss_ps(dev, bss_conf);
+               }
+       }
 
        mt792x_mutex_release(dev);
 }