]> git.proxmox.com Git - mirror_ubuntu-kernels.git/commitdiff
wifi: mt76: mt7996: add support to configure spatial reuse parameter set
authorRyder Lee <ryder.lee@mediatek.com>
Thu, 1 Dec 2022 08:03:32 +0000 (16:03 +0800)
committerFelix Fietkau <nbd@nbd.name>
Thu, 1 Dec 2022 16:29:15 +0000 (17:29 +0100)
The SPR parameter set comprises OBSS PD threshold for SRG and
non SRG and Bitmap of BSS color and partial BSSID. This adds
support to configure fields of SPR element to firmware.

User can disable firmware SR algorithms by turning sr_scene_detect off.

Signed-off-by: Ryder Lee <ryder.lee@mediatek.com>
Signed-off-by: Felix Fietkau <nbd@nbd.name>
drivers/net/wireless/mediatek/mt76/mt7996/main.c
drivers/net/wireless/mediatek/mt76/mt7996/mcu.c
drivers/net/wireless/mediatek/mt76/mt7996/mcu.h
drivers/net/wireless/mediatek/mt76/mt7996/mt7996.h

index f2129be25d99903f5ea4d2f374d1f49de778774a..4421cd54311b1b5c88ab38ed1fb115bb01d67ba6 100644 (file)
@@ -518,10 +518,8 @@ static void mt7996_bss_info_changed(struct ieee80211_hw *hw,
                mt7996_mcu_add_sta(dev, vif, NULL, join);
        }
 
-       if (changed & BSS_CHANGED_ASSOC) {
+       if (changed & BSS_CHANGED_ASSOC)
                mt7996_mcu_add_bss_info(phy, vif, vif->cfg.assoc);
-               mt7996_mcu_add_obss_spr(dev, vif, info->he_obss_pd.enable);
-       }
 
        if (changed & BSS_CHANGED_ERP_CTS_PROT)
                mt7996_mac_enable_rtscts(dev, vif, info->use_cts_prot);
@@ -545,7 +543,7 @@ static void mt7996_bss_info_changed(struct ieee80211_hw *hw,
                mt7996_mcu_set_tx(dev, vif);
 
        if (changed & BSS_CHANGED_HE_OBSS_PD)
-               mt7996_mcu_add_obss_spr(dev, vif, info->he_obss_pd.enable);
+               mt7996_mcu_add_obss_spr(phy, vif, &info->he_obss_pd);
 
        if (changed & BSS_CHANGED_HE_BSS_COLOR)
                mt7996_update_bss_color(hw, vif, &info->he_bss_color);
index 123076db80217bd0ca7d3f9614c0604026a801f5..04e1d10bbd21e4f1a302774dfc517fa749a6062f 100644 (file)
@@ -71,6 +71,10 @@ struct mt7996_fw_region {
 #define HE_PHY(p, c)                   u8_get_bits(c, IEEE80211_HE_PHY_##p)
 #define HE_MAC(m, c)                   u8_get_bits(c, IEEE80211_HE_MAC_##m)
 
+static bool sr_scene_detect = true;
+module_param(sr_scene_detect, bool, 0644);
+MODULE_PARM_DESC(sr_scene_detect, "Enable firmware scene detection algorithm");
+
 static u8
 mt7996_mcu_get_sta_nss(u16 mcs_map)
 {
@@ -3123,29 +3127,203 @@ int mt7996_mcu_set_txbf(struct mt7996_dev *dev, u8 action)
        return mt76_mcu_skb_send_msg(&dev->mt76, skb, MCU_WM_UNI_CMD(BF), true);
 }
 
-int mt7996_mcu_add_obss_spr(struct mt7996_dev *dev, struct ieee80211_vif *vif,
-                           bool enable)
+static int
+mt7996_mcu_enable_obss_spr(struct mt7996_phy *phy, u16 action, u8 val)
 {
-#define MT_SPR_ENABLE          1
-       struct mt7996_vif *mvif = (struct mt7996_vif *)vif->drv_priv;
+       struct mt7996_dev *dev = phy->dev;
        struct {
                u8 band_idx;
                u8 __rsv[3];
 
                __le16 tag;
                __le16 len;
+
                __le32 val;
        } __packed req = {
-               .band_idx = mvif->mt76.band_idx,
-               .tag = cpu_to_le16(UNI_CMD_SR_ENABLE),
+               .band_idx = phy->mt76->band_idx,
+               .tag = cpu_to_le16(action),
+               .len = cpu_to_le16(sizeof(req) - 4),
+               .val = cpu_to_le32(val),
+       };
+
+       return mt76_mcu_send_msg(&dev->mt76, MCU_WM_UNI_CMD(SR),
+                                &req, sizeof(req), true);
+}
+
+static int
+mt7996_mcu_set_obss_spr_pd(struct mt7996_phy *phy,
+                          struct ieee80211_he_obss_pd *he_obss_pd)
+{
+       struct mt7996_dev *dev = phy->dev;
+       u8 max_th = 82, non_srg_max_th = 62;
+       struct {
+               u8 band_idx;
+               u8 __rsv[3];
+
+               __le16 tag;
+               __le16 len;
+
+               u8 pd_th_non_srg;
+               u8 pd_th_srg;
+               u8 period_offs;
+               u8 rcpi_src;
+               __le16 obss_pd_min;
+               __le16 obss_pd_min_srg;
+               u8 resp_txpwr_mode;
+               u8 txpwr_restrict_mode;
+               u8 txpwr_ref;
+               u8 __rsv2[3];
+       } __packed req = {
+               .band_idx = phy->mt76->band_idx,
+               .tag = cpu_to_le16(UNI_CMD_SR_SET_PARAM),
+               .len = cpu_to_le16(sizeof(req) - 4),
+               .obss_pd_min = cpu_to_le16(max_th),
+               .obss_pd_min_srg = cpu_to_le16(max_th),
+               .txpwr_restrict_mode = 2,
+               .txpwr_ref = 21
+       };
+       int ret;
+
+       /* disable firmware dynamical PD asjustment */
+       ret = mt7996_mcu_enable_obss_spr(phy, UNI_CMD_SR_ENABLE_DPD, false);
+       if (ret)
+               return ret;
+
+       if (he_obss_pd->sr_ctrl &
+           IEEE80211_HE_SPR_NON_SRG_OBSS_PD_SR_DISALLOWED)
+               req.pd_th_non_srg = max_th;
+       else if (he_obss_pd->sr_ctrl & IEEE80211_HE_SPR_NON_SRG_OFFSET_PRESENT)
+               req.pd_th_non_srg  = max_th - he_obss_pd->non_srg_max_offset;
+       else
+               req.pd_th_non_srg  = non_srg_max_th;
+
+       if (he_obss_pd->sr_ctrl & IEEE80211_HE_SPR_SRG_INFORMATION_PRESENT)
+               req.pd_th_srg = max_th - he_obss_pd->max_offset;
+
+       return mt76_mcu_send_msg(&dev->mt76, MCU_WM_UNI_CMD(SR),
+                                &req, sizeof(req), true);
+}
+
+static int
+mt7996_mcu_set_obss_spr_siga(struct mt7996_phy *phy, struct ieee80211_vif *vif,
+                            struct ieee80211_he_obss_pd *he_obss_pd)
+{
+       struct mt7996_vif *mvif = (struct mt7996_vif *)vif->drv_priv;
+       struct mt7996_dev *dev = phy->dev;
+       u8 omac = mvif->mt76.omac_idx;
+       struct {
+               u8 band_idx;
+               u8 __rsv[3];
+
+               __le16 tag;
+               __le16 len;
+
+               u8 omac;
+               u8 __rsv2[3];
+               u8 flag[20];
+       } __packed req = {
+               .band_idx = phy->mt76->band_idx,
+               .tag = cpu_to_le16(UNI_CMD_SR_SET_SIGA),
                .len = cpu_to_le16(sizeof(req) - 4),
-               .val = cpu_to_le32(enable),
+               .omac = omac > HW_BSSID_MAX ? omac - 12 : omac,
        };
+       int ret;
+
+       if (he_obss_pd->sr_ctrl & IEEE80211_HE_SPR_HESIGA_SR_VAL15_ALLOWED)
+               req.flag[req.omac] = 0xf;
+       else
+               return 0;
+
+       /* switch to normal AP mode */
+       ret = mt7996_mcu_enable_obss_spr(phy, UNI_CMD_SR_ENABLE_MODE, 0);
+       if (ret)
+               return ret;
 
        return mt76_mcu_send_msg(&dev->mt76, MCU_WM_UNI_CMD(SR),
                                 &req, sizeof(req), true);
 }
 
+static int
+mt7996_mcu_set_obss_spr_bitmap(struct mt7996_phy *phy,
+                              struct ieee80211_he_obss_pd *he_obss_pd)
+{
+       struct mt7996_dev *dev = phy->dev;
+       struct {
+               u8 band_idx;
+               u8 __rsv[3];
+
+               __le16 tag;
+               __le16 len;
+
+               __le32 color_l[2];
+               __le32 color_h[2];
+               __le32 bssid_l[2];
+               __le32 bssid_h[2];
+       } __packed req = {
+               .band_idx = phy->mt76->band_idx,
+               .tag = cpu_to_le16(UNI_CMD_SR_SET_SRG_BITMAP),
+               .len = cpu_to_le16(sizeof(req) - 4),
+       };
+       u32 bitmap;
+
+       memcpy(&bitmap, he_obss_pd->bss_color_bitmap, sizeof(bitmap));
+       req.color_l[req.band_idx] = cpu_to_le32(bitmap);
+
+       memcpy(&bitmap, he_obss_pd->bss_color_bitmap + 4, sizeof(bitmap));
+       req.color_h[req.band_idx] = cpu_to_le32(bitmap);
+
+       memcpy(&bitmap, he_obss_pd->partial_bssid_bitmap, sizeof(bitmap));
+       req.bssid_l[req.band_idx] = cpu_to_le32(bitmap);
+
+       memcpy(&bitmap, he_obss_pd->partial_bssid_bitmap + 4, sizeof(bitmap));
+       req.bssid_h[req.band_idx] = cpu_to_le32(bitmap);
+
+       return mt76_mcu_send_msg(&dev->mt76, MCU_WM_UNI_CMD(SR), &req,
+                                sizeof(req), true);
+}
+
+int mt7996_mcu_add_obss_spr(struct mt7996_phy *phy, struct ieee80211_vif *vif,
+                           struct ieee80211_he_obss_pd *he_obss_pd)
+{
+       int ret;
+
+       /* enable firmware scene detection algorithms */
+       ret = mt7996_mcu_enable_obss_spr(phy, UNI_CMD_SR_ENABLE_SD,
+                                        sr_scene_detect);
+       if (ret)
+               return ret;
+
+       /* firmware dynamically adjusts PD threshold so skip manual control */
+       if (sr_scene_detect && !he_obss_pd->enable)
+               return 0;
+
+       /* enable spatial reuse */
+       ret = mt7996_mcu_enable_obss_spr(phy, UNI_CMD_SR_ENABLE,
+                                        he_obss_pd->enable);
+       if (ret)
+               return ret;
+
+       if (sr_scene_detect || !he_obss_pd->enable)
+               return 0;
+
+       ret = mt7996_mcu_enable_obss_spr(phy, UNI_CMD_SR_ENABLE_TX, true);
+       if (ret)
+               return ret;
+
+       /* set SRG/non-SRG OBSS PD threshold */
+       ret = mt7996_mcu_set_obss_spr_pd(phy, he_obss_pd);
+       if (ret)
+               return ret;
+
+       /* Set SR prohibit */
+       ret = mt7996_mcu_set_obss_spr_siga(phy, vif, he_obss_pd);
+       if (ret)
+               return ret;
+
+       /* set SRG BSS color/BSSID bitmap */
+       return mt7996_mcu_set_obss_spr_bitmap(phy, he_obss_pd);
+}
+
 int mt7996_mcu_update_bss_color(struct mt7996_dev *dev, struct ieee80211_vif *vif,
                                struct cfg80211_he_bss_color *he_bss_color)
 {
index ff12a7168bd8a00a94be1dfaa5d611dd04826ddf..6084b23375984b131e68b344139e4bcfe465952e 100644 (file)
@@ -617,6 +617,13 @@ enum {
 
 enum{
        UNI_CMD_SR_ENABLE = 0x1,
+       UNI_CMD_SR_ENABLE_SD,
+       UNI_CMD_SR_ENABLE_MODE,
+       UNI_CMD_SR_ENABLE_DPD = 0x12,
+       UNI_CMD_SR_ENABLE_TX,
+       UNI_CMD_SR_SET_SRG_BITMAP = 0x80,
+       UNI_CMD_SR_SET_PARAM = 0xc1,
+       UNI_CMD_SR_SET_SIGA = 0xd0,
 };
 
 enum {
index 17dcd05d3459ce2ced36cd277d6f71d43df04f07..725344791b4cdeebc5c2bddf938e5039732c42d4 100644 (file)
@@ -407,8 +407,8 @@ int mt7996_mcu_add_beacon(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
                          int enable);
 int mt7996_mcu_beacon_inband_discov(struct mt7996_dev *dev,
                                    struct ieee80211_vif *vif, u32 changed);
-int mt7996_mcu_add_obss_spr(struct mt7996_dev *dev, struct ieee80211_vif *vif,
-                           bool enable);
+int mt7996_mcu_add_obss_spr(struct mt7996_phy *phy, struct ieee80211_vif *vif,
+                           struct ieee80211_he_obss_pd *he_obss_pd);
 int mt7996_mcu_add_rate_ctrl(struct mt7996_dev *dev, struct ieee80211_vif *vif,
                             struct ieee80211_sta *sta, bool changed);
 int mt7996_set_channel(struct mt7996_phy *phy);