| From 0c5b82da3de9a903de87814a8fd70956c2280c47 Mon Sep 17 00:00:00 2001 |
| From: Sujuan Chen <sujuan.chen@mediatek.com> |
| Date: Fri, 25 Nov 2022 14:32:35 +0800 |
| Subject: [PATCH 3008/3013] mt76: mt7915: wed: find rx token by physical |
| address |
| |
| The token id in RxDMAD may be incorrect when it is not the last frame due to |
| WED HW bug. Lookup correct token id by physical address in sdp0. |
| |
| Signed-off-by: Peter Chiu <chui-hao.chiu@mediatek.com> |
| --- |
| dma.c | 21 ++++++++++++++++++++- |
| 1 file changed, 20 insertions(+), 1 deletion(-) |
| |
| diff --git a/dma.c b/dma.c |
| index 35beec7..327ed3b 100644 |
| --- a/dma.c |
| +++ b/dma.c |
| @@ -376,10 +376,29 @@ mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx, |
| |
| if ((q->flags & MT_QFLAG_WED) && |
| FIELD_GET(MT_QFLAG_WED_TYPE, q->flags) == MT76_WED_Q_RX) { |
| + u32 id, find = 0; |
| u32 token = FIELD_GET(MT_DMA_CTL_TOKEN, |
| le32_to_cpu(desc->buf1)); |
| - struct mt76_txwi_cache *t = mt76_rx_token_release(dev, token); |
| + struct mt76_txwi_cache *t; |
| + |
| + if (*more) { |
| + spin_lock_bh(&dev->rx_token_lock); |
| + |
| + idr_for_each_entry(&dev->rx_token, t, id) { |
| + if (t->dma_addr == le32_to_cpu(desc->buf0)) { |
| + find = 1; |
| + desc->buf1 = FIELD_PREP(MT_DMA_CTL_TOKEN, id); |
| + token = id; |
| + break; |
| + } |
| + } |
| + |
| + spin_unlock_bh(&dev->rx_token_lock); |
| + if (!find) |
| + return NULL; |
| + } |
| |
| + t = mt76_rx_token_release(dev, token); |
| if (!t) |
| return NULL; |
| |
| -- |
| 2.36.1 |
| |