blob: c7e2e095a8c7e045c419061d6a5b058170ae0336 [file] [log] [blame]
From ac7abe57fec7283da9c50d4f513c1b6171e0e912 Mon Sep 17 00:00:00 2001
From: Bo Jiao <Bo.Jiao@mediatek.com>
Date: Mon, 4 Jul 2022 19:24:34 +0800
Subject: [PATCH 1113/1119] mt76: mt7915: drop packets when TWT stations use
---
.../net/wireless/mediatek/mt76/mt7915/mac.c | 21 ++++++++++++++++---
.../wireless/mediatek/mt76/mt7915/mt7915.h | 2 ++
2 files changed, 20 insertions(+), 3 deletions(-)
diff --git a/mt7915/mac.c b/mt7915/mac.c
index 5e5df23d..55b38d16 100644
--- a/mt7915/mac.c
+++ b/mt7915/mac.c
@@ -725,6 +725,7 @@ int mt7915_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_info->skb);
struct ieee80211_key_conf *key = info->control.hw_key;
struct ieee80211_vif *vif = info->control.vif;
+ struct mt7915_sta *msta = NULL;
struct mt76_connac_fw_txp *txp;
struct mt76_txwi_cache *t;
int id, i, nbuf = tx_info->nbuf - 1;
@@ -738,8 +739,6 @@ int mt7915_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
wcid = &dev->mt76.global_wcid;
if (sta) {
- struct mt7915_sta *msta;
-
msta = (struct mt7915_sta *)sta->drv_priv;
if (time_after(jiffies, msta->jiffies + HZ / 4)) {
@@ -755,10 +754,22 @@ int mt7915_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
mgmt->u.action.category == 0xff)
return -1;
+ spin_lock_bh(&mdev->token_lock);
+ if (msta && msta->twt.flowid_mask && msta->token_count > 128) {
+ spin_unlock_bh(&mdev->token_lock);
+ return -1;
+ }
+ spin_unlock_bh(&mdev->token_lock);
+
id = mt76_token_consume(mdev, &t);
if (id < 0)
return id;
+ spin_lock_bh(&mdev->token_lock);
+ if (msta)
+ msta->token_count++;
+ spin_unlock_bh(&mdev->token_lock);
+
pid = mt76_tx_status_skb_add(mdev, wcid, tx_info->skb);
mt7915_mac_write_txwi(mdev, txwi_ptr, tx_info->skb, wcid, pid, key,
qid, 0);
@@ -939,6 +950,7 @@ mt7915_mac_tx_free(struct mt7915_dev *dev, void *data, int len)
struct mt76_dev *mdev = &dev->mt76;
struct mt76_txwi_cache *txwi;
struct ieee80211_sta *sta = NULL;
+ struct mt7915_sta *msta = NULL;
LIST_HEAD(free_list);
void *end = data + len;
bool v3, wake = false;
@@ -962,7 +974,6 @@ mt7915_mac_tx_free(struct mt7915_dev *dev, void *data, int len)
* 1'b0: msdu_id with the same 'wcid pair' as above.
*/
if (info & MT_TX_FREE_PAIR) {
- struct mt7915_sta *msta;
struct mt76_wcid *wcid;
u16 idx;
@@ -995,6 +1006,10 @@ mt7915_mac_tx_free(struct mt7915_dev *dev, void *data, int len)
txwi = mt76_token_release(mdev, msdu, &wake);
if (!txwi)
continue;
+ spin_lock(&mdev->token_lock);
+ if (msta)
+ msta->token_count--;
+ spin_unlock(&mdev->token_lock);
mt7915_txwi_free(dev, txwi, sta, &free_list);
}
diff --git a/mt7915/mt7915.h b/mt7915/mt7915.h
index 7c7d6bd3..5f11b3fb 100644
--- a/mt7915/mt7915.h
+++ b/mt7915/mt7915.h
@@ -136,6 +136,8 @@ struct mt7915_sta {
u8 flowid_mask;
struct mt7915_twt_flow flow[MT7915_MAX_STA_TWT_AGRT];
} twt;
+
+ int token_count;
};
struct mt7915_vif_cap {
--
2.25.1