mt76: mt7915: add ethtool stats support

This exposes some tx-path stats to the ethtool API, so that
ethtool -S wlanX provides some more useful info.

Signed-off-by: Ben Greear <greearb@candelatech.com>
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt7915/main.c b/drivers/net/wireless/mediatek/mt76/mt7915/main.c
index 3caefaf..d643df8 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7915/main.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7915/main.c
@@ -1054,6 +1054,132 @@ static void mt7915_sta_set_decap_offload(struct ieee80211_hw *hw,
        mt7915_mcu_sta_update_hdr_trans(dev, vif, sta);
 }
 
+static const char mt7915_gstrings_stats[][ETH_GSTRING_LEN] = {
+       "tx_ampdu_len:0-1",
+       "tx_ampdu_len:2-10",
+       "tx_ampdu_len:11-19",
+       "tx_ampdu_len:20-28",
+       "tx_ampdu_len:29-37",
+       "tx_ampdu_len:38-46",
+       "tx_ampdu_len:47-55",
+       "tx_ampdu_len:56-79",
+       "tx_ampdu_len:80-103",
+       "tx_ampdu_len:104-127",
+       "tx_ampdu_len:128-151",
+       "tx_ampdu_len:152-175",
+       "tx_ampdu_len:176-199",
+       "tx_ampdu_len:200-223",
+       "tx_ampdu_len:224-247",
+       "ba_miss_count",
+       "tx_beamformer_ppdu_iBF",
+       "tx_beamformer_ppdu_eBF",
+       "tx_beamformer_rx_feedback_all",
+       "tx_beamformer_rx_feedback_he",
+       "tx_beamformer_rx_feedback_vht",
+       "tx_beamformer_rx_feedback_ht",
+       "tx_beamformer_rx_feedback_bw", /* zero based idx: 20, 40, 80, 160 */
+       "tx_beamformer_rx_feedback_nc",
+       "tx_beamformer_rx_feedback_nr",
+       "tx_beamformee_ok_feedback_pkts",
+       "tx_beamformee_feedback_trig",
+       "tx_mu_beamforming",
+       "tx_mu_mpdu",
+       "tx_mu_successful_mpdu",
+       "tx_su_successful_mpdu",
+       "tx_msdu_pack_1",
+       "tx_msdu_pack_2",
+       "tx_msdu_pack_3",
+       "tx_msdu_pack_4",
+       "tx_msdu_pack_5",
+       "tx_msdu_pack_6",
+       "tx_msdu_pack_7",
+       "tx_msdu_pack_8",
+};
+
+#define MT7915_SSTATS_LEN ARRAY_SIZE(mt7915_gstrings_stats)
+
+/* Ethtool related API */
+static
+void mt7915_get_et_strings(struct ieee80211_hw *hw,
+                          struct ieee80211_vif *vif,
+                          u32 sset, u8 *data)
+{
+       if (sset == ETH_SS_STATS)
+               memcpy(data, *mt7915_gstrings_stats,
+                      sizeof(mt7915_gstrings_stats));
+}
+
+static
+int mt7915_get_et_sset_count(struct ieee80211_hw *hw,
+                            struct ieee80211_vif *vif, int sset)
+{
+       if (sset == ETH_SS_STATS)
+               return MT7915_SSTATS_LEN;
+
+       return 0;
+}
+
+static
+void mt7915_get_et_stats(struct ieee80211_hw *hw,
+                        struct ieee80211_vif *vif,
+                        struct ethtool_stats *stats, u64 *data)
+{
+       struct mt7915_dev *dev = mt7915_hw_dev(hw);
+       struct mt7915_phy *phy = mt7915_hw_phy(hw);
+
+       /* See mt7915_ampdu_stat_read_phy, etc */
+       bool ext_phy = phy != &dev->phy;
+       int i, n, ei = 0;
+
+       /* Tx ampdu stat */
+       n = ext_phy ? ARRAY_SIZE(dev->mt76.aggr_stats) / 2 : 0;
+       for (i = 0; i < 15 /*ARRAY_SIZE(bound)*/; i++)
+               data[ei++] = dev->mt76.aggr_stats[i + n];
+
+       data[ei++] = phy->mib.ba_miss_cnt;
+
+       /* Tx Beamformer monitor */
+       cnt = mt76_rr(dev, MT_ETBF_TX_APP_CNT(ext_phy));
+       data[ei++] = FIELD_GET(MT_ETBF_TX_IBF_CNT, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_TX_EBF_CNT, cnt);
+
+       /* Tx Beamformer Rx feedback monitor */
+       cnt = mt76_rr(dev, MT_ETBF_RX_FB_CNT(ext_phy));
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_ALL, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_HE, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_VHT, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_HT, cnt);
+
+       cnt = mt76_rr(dev, MT_ETBF_RX_FB_CONT(ext_phy));
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_BW, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_NC, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_RX_FB_NR, cnt);
+
+       /* Tx Beamformee Rx NDPA & Tx feedback report */
+       cnt = mt76_rr(dev, MT_ETBF_TX_NDP_BFRP(ext_phy));
+       data[ei++] = FIELD_GET(MT_ETBF_TX_FB_CPL, cnt);
+       data[ei++] = FIELD_GET(MT_ETBF_TX_FB_TRI, cnt);
+
+       /* Tx SU & MU counters */
+       cnt = mt76_rr(dev, MT_MIB_SDR34(ext_phy));
+       data[ei++] = FIELD_GET(MT_MIB_MU_BF_TX_CNT, cnt);
+
+       cnt = mt76_rr(dev, MT_MIB_DR8(ext_phy));
+       data[ei++] = cnt;
+
+       cnt = mt76_rr(dev, MT_MIB_DR9(ext_phy));
+       data[ei++] = cnt; /* MU MPDU SUccessful */
+
+       cnt = mt76_rr(dev, MT_MIB_DR11(ext_phy));
+       data[ei++] = cnt; /* SU MPDU successful */
+
+       /* Tx amsdu info (pack-count histogram) */
+       for (i = 0; i < 8; i++)
+               data[ei++] = mt76_rr(dev,  MT_PLE_AMSDU_PACK_MSDU_CNT(i));
+
+       WARN_ON(ei != MT7915_SSTATS_LEN);
+}
+
 const struct ieee80211_ops mt7915_ops = {
        .tx = mt7915_tx,
        .start = mt7915_start,
@@ -1078,6 +1204,9 @@ const struct ieee80211_ops mt7915_ops = {
        .get_txpower = mt76_get_txpower,
        .channel_switch_beacon = mt7915_channel_switch_beacon,
        .get_stats = mt7915_get_stats,
+       .get_et_sset_count = mt7915_get_et_sset_count,
+       .get_et_stats = mt7915_get_et_stats,
+       .get_et_strings = mt7915_get_et_strings,
        .get_tsf = mt7915_get_tsf,
        .set_tsf = mt7915_set_tsf,
        .offset_tsf = mt7915_offset_tsf,