mt76: mt7615: implement support for using DT rate power limits

Limits are used to update the channel max_power settings and also passed
to the firmware on channel changes

Signed-off-by: Felix Fietkau <nbd@nbd.name>
Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt7615/init.c b/drivers/net/wireless/mediatek/mt76/mt7615/init.c
index 1e41874..e58f46d 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7615/init.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7615/init.c
@@ -252,6 +252,7 @@ void mt7615_init_txpower(struct mt7615_dev *dev,
        int delta_idx, delta = mt76_tx_power_nss_delta(n_chains);
        u8 *eep = (u8 *)dev->mt76.eeprom.data;
        enum nl80211_band band = sband->band;
+       struct mt76_power_limits limits;
        u8 rate_val;
 
        delta_idx = mt7615_eeprom_get_power_delta_index(dev, band);
@@ -280,7 +281,11 @@ void mt7615_init_txpower(struct mt7615_dev *dev,
                        target_power = max(target_power, eep[index]);
                }
 
-               target_power = DIV_ROUND_UP(target_power + delta, 2);
+               target_power = mt76_get_rate_power_limits(&dev->mphy, chan,
+                                                         &limits,
+                                                         target_power);
+               target_power += delta;
+               target_power = DIV_ROUND_UP(target_power, 2);
                chan->max_power = min_t(int, chan->max_reg_power,
                                        target_power);
                chan->orig_mpwr = target_power;
@@ -311,6 +316,9 @@ mt7615_regd_notifier(struct wiphy *wiphy,
        memcpy(dev->mt76.alpha2, request->alpha2, sizeof(dev->mt76.alpha2));
        dev->mt76.region = request->dfs_region;
 
+       mt7615_init_txpower(dev, &mphy->sband_2g.sband);
+       mt7615_init_txpower(dev, &mphy->sband_5g.sband);
+
        mt7615_mutex_acquire(dev);
 
        if (chandef->chan->flags & IEEE80211_CHAN_RADAR)

diff --git a/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c b/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c
index 9b9f8d8..cb325b0 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c
@@ -2137,16 +2137,75 @@ static void mt7615_mcu_set_txpower_sku(struct mt7615_phy *phy, u8 *sku)
 {
        struct mt76_phy *mphy = phy->mt76;
        struct ieee80211_hw *hw = mphy->hw;
+       struct mt76_power_limits limits;
+       s8 *limits_array = (s8 *)&limits;
        int n_chains = hweight8(mphy->antenna_mask);
        int tx_power;
        int i;
+       static const u8 sku_mapping[] = {
+#define SKU_FIELD(_type, _field) \
+               [MT_SKU_##_type] = offsetof(struct mt76_power_limits, _field)
+               SKU_FIELD(CCK_1_2, cck[0]),
+               SKU_FIELD(CCK_55_11, cck[2]),
+               SKU_FIELD(OFDM_6_9, ofdm[0]),
+               SKU_FIELD(OFDM_12_18, ofdm[2]),
+               SKU_FIELD(OFDM_24_36, ofdm[4]),
+               SKU_FIELD(OFDM_48, ofdm[6]),
+               SKU_FIELD(OFDM_54, ofdm[7]),
+               SKU_FIELD(HT20_0_8, mcs[0][0]),
+               SKU_FIELD(HT20_32, ofdm[0]),
+               SKU_FIELD(HT20_1_2_9_10, mcs[0][1]),
+               SKU_FIELD(HT20_3_4_11_12, mcs[0][3]),
+               SKU_FIELD(HT20_5_13, mcs[0][5]),
+               SKU_FIELD(HT20_6_14, mcs[0][6]),
+               SKU_FIELD(HT20_7_15, mcs[0][7]),
+               SKU_FIELD(HT40_0_8, mcs[1][0]),
+               SKU_FIELD(HT40_32, ofdm[0]),
+               SKU_FIELD(HT40_1_2_9_10, mcs[1][1]),
+               SKU_FIELD(HT40_3_4_11_12, mcs[1][3]),
+               SKU_FIELD(HT40_5_13, mcs[1][5]),
+               SKU_FIELD(HT40_6_14, mcs[1][6]),
+               SKU_FIELD(HT40_7_15, mcs[1][7]),
+               SKU_FIELD(VHT20_0, mcs[0][0]),
+               SKU_FIELD(VHT20_1_2, mcs[0][1]),
+               SKU_FIELD(VHT20_3_4, mcs[0][3]),
+               SKU_FIELD(VHT20_5_6, mcs[0][5]),
+               SKU_FIELD(VHT20_7, mcs[0][7]),
+               SKU_FIELD(VHT20_8, mcs[0][8]),
+               SKU_FIELD(VHT20_9, mcs[0][9]),
+               SKU_FIELD(VHT40_0, mcs[1][0]),
+               SKU_FIELD(VHT40_1_2, mcs[1][1]),
+               SKU_FIELD(VHT40_3_4, mcs[1][3]),
+               SKU_FIELD(VHT40_5_6, mcs[1][5]),
+               SKU_FIELD(VHT40_7, mcs[1][7]),
+               SKU_FIELD(VHT40_8, mcs[1][8]),
+               SKU_FIELD(VHT40_9, mcs[1][9]),
+               SKU_FIELD(VHT80_0, mcs[2][0]),
+               SKU_FIELD(VHT80_1_2, mcs[2][1]),
+               SKU_FIELD(VHT80_3_4, mcs[2][3]),
+               SKU_FIELD(VHT80_5_6, mcs[2][5]),
+               SKU_FIELD(VHT80_7, mcs[2][7]),
+               SKU_FIELD(VHT80_8, mcs[2][8]),
+               SKU_FIELD(VHT80_9, mcs[2][9]),
+               SKU_FIELD(VHT160_0, mcs[3][0]),
+               SKU_FIELD(VHT160_1_2, mcs[3][1]),
+               SKU_FIELD(VHT160_3_4, mcs[3][3]),
+               SKU_FIELD(VHT160_5_6, mcs[3][5]),
+               SKU_FIELD(VHT160_7, mcs[3][7]),
+               SKU_FIELD(VHT160_8, mcs[3][8]),
+               SKU_FIELD(VHT160_9, mcs[3][9]),
+#undef SKU_FIELD
+       };
 
        tx_power = hw->conf.power_level * 2 -
                   mt76_tx_power_nss_delta(n_chains);
+
+       tx_power = mt76_get_rate_power_limits(mphy, mphy->chandef.chan,
+                                             &limits, tx_power);
        mphy->txpower_cur = tx_power;
 
        for (i = 0; i < MT_SKU_1SS_DELTA; i++)
-               sku[i] = tx_power;
+               sku[i] = limits_array[sku_mapping[i]];
 
        for (i = 0; i < 4; i++) {
                int delta = 0;