wifi: rtw89: register ops of can_activate_links

Register mac80211 ops of can_activate_links which is required when
we are ready to enable multiple active links.

Signed-off-by: Zong-Zhe Yang <kevin_yang@realtek.com>
Signed-off-by: Ping-Ke Shih <pkshih@realtek.com>
Link: https://patch.msgid.link/20241120034054.13575-3-pkshih@realtek.com

diff --git a/drivers/net/wireless/realtek/rtw89/core.h b/drivers/net/wireless/realtek/rtw89/core.h
index 3e93b53fd67ba751c1ba90ed0ad1cfceb72d3188..dcd2ccadac96c38982050c2a0dd697c996a552be 100644 (file)
--- a/drivers/net/wireless/realtek/rtw89/core.h
+++ b/drivers/net/wireless/realtek/rtw89/core.h
@@ -830,6 +830,7 @@ enum rtw89_phy_idx {
 };
 
 #define __RTW89_MLD_MAX_LINK_NUM 2
+#define RTW89_MLD_NON_STA_LINK_NUM 1
 
 enum rtw89_chanctx_idx {
        RTW89_CHANCTX_0 = 0,

diff --git a/drivers/net/wireless/realtek/rtw89/mac80211.c b/drivers/net/wireless/realtek/rtw89/mac80211.c
index 8dc475f6fdf7b7fa5e36902da8f327c1076b66a1..40ff5aa041fa64d80f6ddc57d8a68102e6dfae67 100644 (file)
--- a/drivers/net/wireless/realtek/rtw89/mac80211.c
+++ b/drivers/net/wireless/realtek/rtw89/mac80211.c
@@ -1484,6 +1484,30 @@ static int rtw89_ops_set_tid_config(struct ieee80211_hw *hw,
        return 0;
 }
 
+static bool rtw89_can_work_on_links(struct rtw89_dev *rtwdev,
+                                   struct ieee80211_vif *vif, u16 links)
+{
+       struct rtw89_vif *rtwvif = vif_to_rtwvif(vif);
+       u8 w = hweight16(links);
+
+       if (vif->type != NL80211_IFTYPE_STATION &&
+           w > RTW89_MLD_NON_STA_LINK_NUM)
+               return false;
+
+       return w <= rtwvif->links_inst_valid_num;
+}
+
+static bool rtw89_ops_can_activate_links(struct ieee80211_hw *hw,
+                                        struct ieee80211_vif *vif,
+                                        u16 active_links)
+{
+       struct rtw89_dev *rtwdev = hw->priv;
+
+       guard(mutex)(&rtwdev->mutex);
+
+       return rtw89_can_work_on_links(rtwdev, vif, active_links);
+}
+
 #ifdef CONFIG_PM
 static int rtw89_ops_suspend(struct ieee80211_hw *hw,
                             struct cfg80211_wowlan *wowlan)
@@ -1611,6 +1635,7 @@ const struct ieee80211_ops rtw89_ops = {
        .set_sar_specs          = rtw89_ops_set_sar_specs,
        .link_sta_rc_update     = rtw89_ops_sta_rc_update,
        .set_tid_config         = rtw89_ops_set_tid_config,
+       .can_activate_links     = rtw89_ops_can_activate_links,
 #ifdef CONFIG_PM
        .suspend                = rtw89_ops_suspend,
        .resume                 = rtw89_ops_resume,