blob: 89b423c7f885fc08970d7fbe1669eae6af8c938c [file] [log] [blame]
developer4f0d84b2023-03-03 14:21:44 +08001From 40bc4191469a25ab239596071faf7d8ad69e9fb3 Mon Sep 17 00:00:00 2001
developerc04f5402023-02-03 09:22:26 +08002From: Sujuan Chen <sujuan.chen@mediatek.com>
3Date: Thu, 5 Jan 2023 16:43:57 +0800
developer4f0d84b2023-03-03 14:21:44 +08004Subject: [PATCH 3013/3013] mt76: connac: wed: add wed rx copy skb and revert
developerc04f5402023-02-03 09:22:26 +08005 page_pool
6
7Signed-off-by: Sujuan Chen <sujuan.chen@mediatek.com>
8---
9 dma.c | 138 ++++++++++++++++++++++++++++++++------------------
10 mac80211.c | 57 ---------------------
11 mt76.h | 22 +-------
12 mt7915/main.c | 26 ++++------
developerfd8e1152023-02-14 11:29:23 +080013 mt7915/mmio.c | 74 +++++++++++++++++++--------
developerc04f5402023-02-03 09:22:26 +080014 mt7921/main.c | 31 ++----------
15 usb.c | 42 +++++++--------
developer4f0d84b2023-03-03 14:21:44 +080016 7 files changed, 179 insertions(+), 211 deletions(-)
developerc04f5402023-02-03 09:22:26 +080017
18diff --git a/dma.c b/dma.c
developer4f0d84b2023-03-03 14:21:44 +080019index d1a1dae4..3adb1136 100644
developerc04f5402023-02-03 09:22:26 +080020--- a/dma.c
21+++ b/dma.c
22@@ -173,7 +173,7 @@ mt76_free_pending_rxwi(struct mt76_dev *dev)
23 local_bh_disable();
24 while ((r = __mt76_get_rxwi(dev)) != NULL) {
25 if (r->ptr)
26- mt76_put_page_pool_buf(r->ptr, false);
27+ skb_free_frag(r->ptr);
28 kfree(r);
29 }
30 local_bh_enable();
31@@ -208,11 +208,11 @@ mt76_dma_queue_reset(struct mt76_dev *dev, struct mt76_queue *q)
32
33 static int
34 mt76_dma_add_rx_buf(struct mt76_dev *dev, struct mt76_queue *q,
35- struct mt76_queue_buf *buf, void *data)
36+ struct mt76_queue_buf *buf, void *data,
37+ struct mt76_rxwi_cache *rxwi)
38 {
39 struct mt76_desc *desc = &q->desc[q->head];
40 struct mt76_queue_entry *entry = &q->entry[q->head];
41- struct mt76_rxwi_cache *rxwi = NULL;
42 u32 buf1 = 0, ctrl;
43 int idx = q->head;
44 int rx_token;
45@@ -220,9 +220,11 @@ mt76_dma_add_rx_buf(struct mt76_dev *dev, struct mt76_queue *q,
46 ctrl = FIELD_PREP(MT_DMA_CTL_SD_LEN0, buf[0].len);
47
48 if (mt76_queue_is_wed_rx(q)) {
49- rxwi = mt76_get_rxwi(dev);
50- if (!rxwi)
51- return -ENOMEM;
52+ if (!rxwi) {
53+ rxwi = mt76_get_rxwi(dev);
54+ if (!rxwi)
55+ return -ENOMEM;
56+ }
57
58 rx_token = mt76_rx_token_consume(dev, data, rxwi, buf->addr);
59 if (rx_token < 0) {
60@@ -387,7 +389,7 @@ mt76_dma_tx_cleanup(struct mt76_dev *dev, struct mt76_queue *q, bool flush)
61
62 static void *
63 mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx,
64- int *len, u32 *info, bool *more, bool *drop)
65+ int *len, u32 *info, bool *more, bool *drop, bool flush)
66 {
67 struct mt76_queue_entry *e = &q->entry[idx];
68 struct mt76_desc *desc = &q->desc[idx];
developer4f0d84b2023-03-03 14:21:44 +080069@@ -433,15 +435,47 @@ mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx,
developerc04f5402023-02-03 09:22:26 +080070 if (!r)
71 return NULL;
72
73- dma_sync_single_for_cpu(dev->dma_dev, r->dma_addr,
74- SKB_WITH_OVERHEAD(q->buf_size),
75- page_pool_get_dma_dir(q->page_pool));
76+ dma_unmap_single(dev->dma_dev, r->dma_addr,
77+ SKB_WITH_OVERHEAD(q->buf_size),
78+ DMA_FROM_DEVICE);
79
80- buf = r->ptr;
81- r->dma_addr = 0;
82- r->ptr = NULL;
83+ if (flush) {
84+ buf = r->ptr;
85+ r->dma_addr = 0;
86+ r->ptr = NULL;
87
88- mt76_put_rxwi(dev, r);
89+ mt76_put_rxwi(dev, r);
90+ } else {
91+ struct mt76_queue_buf qbuf;
92+
93+ buf = page_frag_alloc(&q->rx_page, q->buf_size, GFP_ATOMIC);
94+ if (!buf)
95+ return NULL;
96+
97+ memcpy(buf, r->ptr, SKB_WITH_OVERHEAD(q->buf_size));
98+
99+ r->dma_addr = dma_map_single(dev->dma_dev, r->ptr,
100+ SKB_WITH_OVERHEAD(q->buf_size),
101+ DMA_FROM_DEVICE);
102+ if (unlikely(dma_mapping_error(dev->dma_dev, r->dma_addr))) {
103+ skb_free_frag(r->ptr);
104+ mt76_put_rxwi(dev, r);
105+ return NULL;
106+ }
107+
108+ qbuf.addr = r->dma_addr;
109+ qbuf.len = SKB_WITH_OVERHEAD(q->buf_size);
110+ qbuf.skip_unmap = false;
111+
112+ if (mt76_dma_add_rx_buf(dev, q, &qbuf, r->ptr, r) < 0) {
113+ dma_unmap_single(dev->dma_dev, r->dma_addr,
114+ SKB_WITH_OVERHEAD(q->buf_size),
115+ DMA_FROM_DEVICE);
116+ skb_free_frag(r->ptr);
117+ mt76_put_rxwi(dev, r);
118+ return NULL;
119+ }
120+ }
121
122 if (drop) {
123 u32 ctrl = le32_to_cpu(READ_ONCE(desc->ctrl));
developer4f0d84b2023-03-03 14:21:44 +0800124@@ -454,9 +488,9 @@ mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx,
developerc04f5402023-02-03 09:22:26 +0800125 } else {
126 buf = e->buf;
127 e->buf = NULL;
128- dma_sync_single_for_cpu(dev->dma_dev, e->dma_addr[0],
129- SKB_WITH_OVERHEAD(q->buf_size),
130- page_pool_get_dma_dir(q->page_pool));
131+ dma_unmap_single(dev->dma_dev, e->dma_addr[0],
132+ SKB_WITH_OVERHEAD(q->buf_size),
133+ DMA_FROM_DEVICE);
134 }
135
136 return buf;
developer4f0d84b2023-03-03 14:21:44 +0800137@@ -480,7 +514,7 @@ mt76_dma_dequeue(struct mt76_dev *dev, struct mt76_queue *q, bool flush,
developerc04f5402023-02-03 09:22:26 +0800138 q->tail = (q->tail + 1) % q->ndesc;
139 q->queued--;
140
141- return mt76_dma_get_buf(dev, q, idx, len, info, more, drop);
142+ return mt76_dma_get_buf(dev, q, idx, len, info, more, drop, flush);
143 }
144
145 static int
developer4f0d84b2023-03-03 14:21:44 +0800146@@ -607,11 +641,12 @@ free_skb:
developerc04f5402023-02-03 09:22:26 +0800147 }
148
149 static int
150-mt76_dma_rx_fill(struct mt76_dev *dev, struct mt76_queue *q,
151- bool allow_direct)
152+mt76_dma_rx_fill(struct mt76_dev *dev, struct mt76_queue *q)
153 {
154 int len = SKB_WITH_OVERHEAD(q->buf_size);
155- int frames = 0;
156+ int frames = 0, offset = q->buf_offset;
157+ dma_addr_t addr;
158+ bool flags = false;
159
160 if (!q->ndesc)
161 return 0;
developer4f0d84b2023-03-03 14:21:44 +0800162@@ -619,31 +654,35 @@ mt76_dma_rx_fill(struct mt76_dev *dev, struct mt76_queue *q,
developerc04f5402023-02-03 09:22:26 +0800163 spin_lock_bh(&q->lock);
164
165 while (q->queued < q->ndesc - 1) {
166- enum dma_data_direction dir;
167 struct mt76_queue_buf qbuf;
168- dma_addr_t addr;
169- int offset;
170- void *buf;
171+ void *buf = NULL;
172
173- buf = mt76_get_page_pool_buf(q, &offset, q->buf_size);
174+ buf = page_frag_alloc(&q->rx_page, q->buf_size, GFP_ATOMIC);
175 if (!buf)
176 break;
177
178- addr = page_pool_get_dma_addr(virt_to_head_page(buf)) + offset;
179- dir = page_pool_get_dma_dir(q->page_pool);
180- dma_sync_single_for_device(dev->dma_dev, addr, len, dir);
181+ addr = dma_map_single(dev->dma_dev, buf, len, DMA_FROM_DEVICE);
182+ if (unlikely(dma_mapping_error(dev->dma_dev, addr))) {
183+ skb_free_frag(buf);
184+ break;
185+ }
186
187- qbuf.addr = addr + q->buf_offset;
188- qbuf.len = len - q->buf_offset;
189+ qbuf.addr = addr + offset;
190+ qbuf.len = len - offset;
191 qbuf.skip_unmap = false;
192- if (mt76_dma_add_rx_buf(dev, q, &qbuf, buf) < 0) {
193- mt76_put_page_pool_buf(buf, allow_direct);
194+ if (mt76_dma_add_rx_buf(dev, q, &qbuf, buf, NULL) < 0) {
195+ dma_unmap_single(dev->dma_dev, addr, len,
196+ DMA_FROM_DEVICE);
197+ skb_free_frag(buf);
198 break;
199 }
200 frames++;
201 }
202
203- if (frames)
204+ flags = (q->flags & MT_QFLAG_WED) &&
205+ FIELD_GET(MT_QFLAG_WED_TYPE, q->flags) == MT76_WED_Q_RX;
206+
207+ if (frames || flags)
208 mt76_dma_kick_queue(dev, q);
209
210 spin_unlock_bh(&q->lock);
developer4f0d84b2023-03-03 14:21:44 +0800211@@ -681,7 +720,7 @@ int mt76_dma_wed_setup(struct mt76_dev *dev, struct mt76_queue *q, bool reset)
developerc04f5402023-02-03 09:22:26 +0800212 /* WED txfree queue needs ring to be initialized before setup */
213 q->flags = 0;
214 mt76_dma_queue_reset(dev, q);
215- mt76_dma_rx_fill(dev, q, false);
216+ mt76_dma_rx_fill(dev, q);
217 q->flags = flags;
218
219 ret = mtk_wed_device_txfree_ring_setup(wed, q->regs);
developer4f0d84b2023-03-03 14:21:44 +0800220@@ -729,10 +768,6 @@ mt76_dma_alloc_queue(struct mt76_dev *dev, struct mt76_queue *q,
developerc04f5402023-02-03 09:22:26 +0800221 if (!q->entry)
222 return -ENOMEM;
223
224- ret = mt76_create_page_pool(dev, q);
225- if (ret)
226- return ret;
227-
228 ret = mt76_dma_wed_setup(dev, q, false);
229 if (ret)
230 return ret;
developer4f0d84b2023-03-03 14:21:44 +0800231@@ -746,6 +781,7 @@ mt76_dma_alloc_queue(struct mt76_dev *dev, struct mt76_queue *q,
developerc04f5402023-02-03 09:22:26 +0800232 static void
233 mt76_dma_rx_cleanup(struct mt76_dev *dev, struct mt76_queue *q)
234 {
235+ struct page *page;
236 void *buf;
237 bool more;
238
developer4f0d84b2023-03-03 14:21:44 +0800239@@ -759,7 +795,7 @@ mt76_dma_rx_cleanup(struct mt76_dev *dev, struct mt76_queue *q)
developerc04f5402023-02-03 09:22:26 +0800240 if (!buf)
241 break;
242
243- mt76_put_page_pool_buf(buf, false);
244+ skb_free_frag(buf);
245 } while (1);
246
247 if (q->rx_head) {
developer4f0d84b2023-03-03 14:21:44 +0800248@@ -768,6 +804,15 @@ mt76_dma_rx_cleanup(struct mt76_dev *dev, struct mt76_queue *q)
developerc04f5402023-02-03 09:22:26 +0800249 }
250
251 spin_unlock_bh(&q->lock);
252+
253+ if (FIELD_GET(MT_QFLAG_WED_TYPE, q->flags) != MT76_WED_Q_RX) {
254+ if (!q->rx_page.va)
255+ return;
256+
257+ page = virt_to_page(q->rx_page.va);
258+ __page_frag_cache_drain(page, q->rx_page.pagecnt_bias);
259+ memset(&q->rx_page, 0, sizeof(q->rx_page));
260+ }
261 }
262
263 static void
developer4f0d84b2023-03-03 14:21:44 +0800264@@ -788,7 +833,7 @@ mt76_dma_rx_reset(struct mt76_dev *dev, enum mt76_rxq_id qid)
developerc04f5402023-02-03 09:22:26 +0800265 mt76_dma_wed_setup(dev, q, true);
266 if (q->flags != MT_WED_Q_TXFREE) {
267 mt76_dma_sync_idx(dev, q);
268- mt76_dma_rx_fill(dev, q, false);
269+ mt76_dma_rx_fill(dev, q);
270 }
271 }
272
developer4f0d84b2023-03-03 14:21:44 +0800273@@ -806,7 +851,7 @@ mt76_add_fragment(struct mt76_dev *dev, struct mt76_queue *q, void *data,
developerc04f5402023-02-03 09:22:26 +0800274
275 skb_add_rx_frag(skb, nr_frags, page, offset, len, q->buf_size);
276 } else {
277- mt76_put_page_pool_buf(data, true);
278+ skb_free_frag(data);
279 }
280
281 if (more)
developer4f0d84b2023-03-03 14:21:44 +0800282@@ -879,7 +924,6 @@ mt76_dma_rx_process(struct mt76_dev *dev, struct mt76_queue *q, int budget)
developerc04f5402023-02-03 09:22:26 +0800283 goto free_frag;
284
285 skb_reserve(skb, q->buf_offset);
286- skb_mark_for_recycle(skb);
287
288 *(u32 *)skb->cb = info;
289
developer4f0d84b2023-03-03 14:21:44 +0800290@@ -895,10 +939,10 @@ mt76_dma_rx_process(struct mt76_dev *dev, struct mt76_queue *q, int budget)
developerc04f5402023-02-03 09:22:26 +0800291 continue;
292
293 free_frag:
294- mt76_put_page_pool_buf(data, true);
295+ skb_free_frag(data);
296 }
297
298- mt76_dma_rx_fill(dev, q, true);
299+ mt76_dma_rx_fill(dev, q);
300 return done;
301 }
302
developer4f0d84b2023-03-03 14:21:44 +0800303@@ -943,7 +987,7 @@ mt76_dma_init(struct mt76_dev *dev,
developerc04f5402023-02-03 09:22:26 +0800304
305 mt76_for_each_q_rx(dev, i) {
306 netif_napi_add(&dev->napi_dev, &dev->napi[i], poll);
307- mt76_dma_rx_fill(dev, &dev->q_rx[i], false);
308+ mt76_dma_rx_fill(dev, &dev->q_rx[i]);
309 napi_enable(&dev->napi[i]);
310 }
311
developer4f0d84b2023-03-03 14:21:44 +0800312@@ -994,8 +1038,6 @@ void mt76_dma_cleanup(struct mt76_dev *dev)
developerc04f5402023-02-03 09:22:26 +0800313
314 netif_napi_del(&dev->napi[i]);
315 mt76_dma_rx_cleanup(dev, q);
316-
317- page_pool_destroy(q->page_pool);
318 }
319
320 mt76_free_pending_txwi(dev);
321diff --git a/mac80211.c b/mac80211.c
developer4f0d84b2023-03-03 14:21:44 +0800322index 4655f814..4dc7627e 100644
developerc04f5402023-02-03 09:22:26 +0800323--- a/mac80211.c
324+++ b/mac80211.c
325@@ -4,7 +4,6 @@
326 */
327 #include <linux/sched.h>
328 #include <linux/of.h>
329-#include <net/page_pool.h>
330 #include "mt76.h"
331
332 #define CHAN2G(_idx, _freq) { \
developer4f0d84b2023-03-03 14:21:44 +0800333@@ -573,47 +572,6 @@ void mt76_unregister_phy(struct mt76_phy *phy)
developerc04f5402023-02-03 09:22:26 +0800334 }
335 EXPORT_SYMBOL_GPL(mt76_unregister_phy);
336
337-int mt76_create_page_pool(struct mt76_dev *dev, struct mt76_queue *q)
338-{
339- struct page_pool_params pp_params = {
340- .order = 0,
341- .flags = PP_FLAG_PAGE_FRAG,
342- .nid = NUMA_NO_NODE,
343- .dev = dev->dma_dev,
344- };
345- int idx = q - dev->q_rx;
346-
347- switch (idx) {
348- case MT_RXQ_MAIN:
349- case MT_RXQ_BAND1:
350- case MT_RXQ_BAND2:
351- pp_params.pool_size = 256;
352- break;
353- default:
354- pp_params.pool_size = 16;
355- break;
356- }
357-
358- if (mt76_is_mmio(dev)) {
359- /* rely on page_pool for DMA mapping */
360- pp_params.flags |= PP_FLAG_DMA_MAP | PP_FLAG_DMA_SYNC_DEV;
361- pp_params.dma_dir = DMA_FROM_DEVICE;
362- pp_params.max_len = PAGE_SIZE;
363- pp_params.offset = 0;
364- }
365-
366- q->page_pool = page_pool_create(&pp_params);
367- if (IS_ERR(q->page_pool)) {
368- int err = PTR_ERR(q->page_pool);
369-
370- q->page_pool = NULL;
371- return err;
372- }
373-
374- return 0;
375-}
376-EXPORT_SYMBOL_GPL(mt76_create_page_pool);
377-
378 struct mt76_dev *
379 mt76_alloc_device(struct device *pdev, unsigned int size,
380 const struct ieee80211_ops *ops,
developer4f0d84b2023-03-03 14:21:44 +0800381@@ -1753,21 +1711,6 @@ void mt76_ethtool_worker(struct mt76_ethtool_worker_info *wi,
developerc04f5402023-02-03 09:22:26 +0800382 }
383 EXPORT_SYMBOL_GPL(mt76_ethtool_worker);
384
385-void mt76_ethtool_page_pool_stats(struct mt76_dev *dev, u64 *data, int *index)
386-{
387-#ifdef CONFIG_PAGE_POOL_STATS
388- struct page_pool_stats stats = {};
389- int i;
390-
391- mt76_for_each_q_rx(dev, i)
392- page_pool_get_stats(dev->q_rx[i].page_pool, &stats);
393-
394- page_pool_ethtool_stats_get(data, &stats);
395- *index += page_pool_ethtool_stats_get_count();
396-#endif
397-}
398-EXPORT_SYMBOL_GPL(mt76_ethtool_page_pool_stats);
399-
400 enum mt76_dfs_state mt76_phy_dfs_state(struct mt76_phy *phy)
401 {
402 struct ieee80211_hw *hw = phy->hw;
403diff --git a/mt76.h b/mt76.h
developer4f0d84b2023-03-03 14:21:44 +0800404index bc0c9ae7..d17650d0 100644
developerc04f5402023-02-03 09:22:26 +0800405--- a/mt76.h
406+++ b/mt76.h
developer4f0d84b2023-03-03 14:21:44 +0800407@@ -209,7 +209,7 @@ struct mt76_queue {
developerc04f5402023-02-03 09:22:26 +0800408
409 dma_addr_t desc_dma;
410 struct sk_buff *rx_head;
411- struct page_pool *page_pool;
412+ struct page_frag_cache rx_page;
413 };
414
415 struct mt76_mcu_ops {
developer33554a22023-01-30 14:11:29 +0800416@@ -1458,7 +1458,6 @@ mt76u_bulk_msg(struct mt76_dev *dev, void *data, int len, int *actual_len,
developerc04f5402023-02-03 09:22:26 +0800417 return usb_bulk_msg(udev, pipe, data, len, actual_len, timeout);
418 }
419
420-void mt76_ethtool_page_pool_stats(struct mt76_dev *dev, u64 *data, int *index);
421 void mt76_ethtool_worker(struct mt76_ethtool_worker_info *wi,
422 struct mt76_sta_stats *stats, bool eht);
423 int mt76_skb_adjust_pad(struct sk_buff *skb, int pad);
developer33554a22023-01-30 14:11:29 +0800424@@ -1570,25 +1569,6 @@ void __mt76_set_tx_blocked(struct mt76_dev *dev, bool blocked);
developerc04f5402023-02-03 09:22:26 +0800425 struct mt76_rxwi_cache *mt76_rx_token_release(struct mt76_dev *dev, int token);
426 int mt76_rx_token_consume(struct mt76_dev *dev, void *ptr,
427 struct mt76_rxwi_cache *r, dma_addr_t phys);
428-int mt76_create_page_pool(struct mt76_dev *dev, struct mt76_queue *q);
429-static inline void mt76_put_page_pool_buf(void *buf, bool allow_direct)
430-{
431- struct page *page = virt_to_head_page(buf);
432-
433- page_pool_put_full_page(page->pp, page, allow_direct);
434-}
435-
436-static inline void *
437-mt76_get_page_pool_buf(struct mt76_queue *q, u32 *offset, u32 size)
438-{
439- struct page *page;
440-
441- page = page_pool_dev_alloc_frag(q->page_pool, offset, size);
442- if (!page)
443- return NULL;
444-
445- return page_address(page) + *offset;
446-}
447
448 static inline void mt76_set_tx_blocked(struct mt76_dev *dev, bool blocked)
449 {
450diff --git a/mt7915/main.c b/mt7915/main.c
developerfd8e1152023-02-14 11:29:23 +0800451index a4d1b816..21caddbe 100644
developerc04f5402023-02-03 09:22:26 +0800452--- a/mt7915/main.c
453+++ b/mt7915/main.c
developerfd8e1152023-02-14 11:29:23 +0800454@@ -1359,22 +1359,19 @@ void mt7915_get_et_strings(struct ieee80211_hw *hw,
developerc04f5402023-02-03 09:22:26 +0800455 struct ieee80211_vif *vif,
456 u32 sset, u8 *data)
457 {
458- if (sset != ETH_SS_STATS)
459- return;
460-
461- memcpy(data, *mt7915_gstrings_stats, sizeof(mt7915_gstrings_stats));
462- data += sizeof(mt7915_gstrings_stats);
463- page_pool_ethtool_stats_get_strings(data);
464+ if (sset == ETH_SS_STATS)
465+ memcpy(data, *mt7915_gstrings_stats,
466+ sizeof(mt7915_gstrings_stats));
467 }
468
469 static
470 int mt7915_get_et_sset_count(struct ieee80211_hw *hw,
471 struct ieee80211_vif *vif, int sset)
472 {
473- if (sset != ETH_SS_STATS)
474- return 0;
475+ if (sset == ETH_SS_STATS)
476+ return MT7915_SSTATS_LEN;
477
478- return MT7915_SSTATS_LEN + page_pool_ethtool_stats_get_count();
479+ return 0;
480 }
481
482 static void mt7915_ethtool_worker(void *wi_data, struct ieee80211_sta *sta)
developerfd8e1152023-02-14 11:29:23 +0800483@@ -1402,7 +1399,7 @@ void mt7915_get_et_stats(struct ieee80211_hw *hw,
developerc04f5402023-02-03 09:22:26 +0800484 };
485 struct mib_stats *mib = &phy->mib;
486 /* See mt7915_ampdu_stat_read_phy, etc */
487- int i, ei = 0, stats_size;
488+ int i, ei = 0;
489
490 mutex_lock(&dev->mt76.mutex);
491
developerfd8e1152023-02-14 11:29:23 +0800492@@ -1483,12 +1480,9 @@ void mt7915_get_et_stats(struct ieee80211_hw *hw,
developerc04f5402023-02-03 09:22:26 +0800493 return;
494
495 ei += wi.worker_stat_count;
496-
497- mt76_ethtool_page_pool_stats(&dev->mt76, &data[ei], &ei);
498-
499- stats_size = MT7915_SSTATS_LEN + page_pool_ethtool_stats_get_count();
500- if (ei != stats_size)
501- dev_err(dev->mt76.dev, "ei: %d size: %d", ei, stats_size);
502+ if (ei != MT7915_SSTATS_LEN)
503+ dev_err(dev->mt76.dev, "ei: %d MT7915_SSTATS_LEN: %d",
504+ ei, (int)MT7915_SSTATS_LEN);
505 }
506
507 static void
508diff --git a/mt7915/mmio.c b/mt7915/mmio.c
developerfd8e1152023-02-14 11:29:23 +0800509index 87cff5d4..b6adfd0b 100644
developerc04f5402023-02-03 09:22:26 +0800510--- a/mt7915/mmio.c
511+++ b/mt7915/mmio.c
developer33554a22023-01-30 14:11:29 +0800512@@ -581,9 +581,14 @@ static void mt7915_mmio_wed_offload_disable(struct mtk_wed_device *wed)
developerc04f5402023-02-03 09:22:26 +0800513 static void mt7915_mmio_wed_release_rx_buf(struct mtk_wed_device *wed)
514 {
515 struct mt7915_dev *dev;
516+ struct page *page;
517+ u32 length;
518 int i;
519
520 dev = container_of(wed, struct mt7915_dev, mt76.mmio.wed);
521+ length = SKB_DATA_ALIGN(NET_SKB_PAD + wed->wlan.rx_size +
522+ sizeof(struct skb_shared_info));
523+
524 for (i = 0; i < dev->mt76.rx_token_size; i++) {
525 struct mt76_rxwi_cache *r;
526
developerfd8e1152023-02-14 11:29:23 +0800527@@ -591,50 +596,79 @@ static void mt7915_mmio_wed_release_rx_buf(struct mtk_wed_device *wed)
developerc04f5402023-02-03 09:22:26 +0800528 if (!r || !r->ptr)
529 continue;
530
531- mt76_put_page_pool_buf(r->ptr, false);
532+ dma_unmap_single(dev->mt76.dma_dev, r->dma_addr,
533+ wed->wlan.rx_size, DMA_FROM_DEVICE);
developerfd8e1152023-02-14 11:29:23 +0800534+ skb_free_frag(r->ptr);
developerc04f5402023-02-03 09:22:26 +0800535 r->ptr = NULL;
536
537 mt76_put_rxwi(&dev->mt76, r);
538 }
539
540 mt76_free_pending_rxwi(&dev->mt76);
541+
542+ mt76_for_each_q_rx(&dev->mt76, i) {
developerfd8e1152023-02-14 11:29:23 +0800543+ struct mt76_queue *q = &dev->mt76.q_rx[i];
developerc04f5402023-02-03 09:22:26 +0800544+
developerfd8e1152023-02-14 11:29:23 +0800545+ if (mt76_queue_is_wed_rx(q)) {
developerc04f5402023-02-03 09:22:26 +0800546+ if (!q->rx_page.va)
547+ continue;
548+
549+ page = virt_to_page(q->rx_page.va);
550+ __page_frag_cache_drain(page, q->rx_page.pagecnt_bias);
551+ memset(&q->rx_page, 0, sizeof(q->rx_page));
552+ }
553+ }
554+
555+ if (!wed->rx_buf_ring.rx_page.va)
556+ return;
557+
558+ page = virt_to_page(wed->rx_buf_ring.rx_page.va);
559+ __page_frag_cache_drain(page, wed->rx_buf_ring.rx_page.pagecnt_bias);
560+ memset(&wed->rx_buf_ring.rx_page, 0, sizeof(wed->rx_buf_ring.rx_page));
561 }
562
563 static u32 mt7915_mmio_wed_init_rx_buf(struct mtk_wed_device *wed, int size)
564 {
565 struct mtk_rxbm_desc *desc = wed->rx_buf_ring.desc;
566- struct mt76_rxwi_cache *r = NULL;
567 struct mt7915_dev *dev;
568- struct mt76_queue *q;
569- int i, len;
570+ u32 length;
571+ int i;
572
573 dev = container_of(wed, struct mt7915_dev, mt76.mmio.wed);
574- q = &dev->mt76.q_rx[MT_RXQ_MAIN];
575- len = SKB_WITH_OVERHEAD(q->buf_size);
576+ length = SKB_DATA_ALIGN(NET_SKB_PAD + wed->wlan.rx_size +
577+ sizeof(struct skb_shared_info));
578
579 for (i = 0; i < size; i++) {
580- enum dma_data_direction dir;
581- dma_addr_t addr;
582- u32 offset;
583+ struct mt76_rxwi_cache *r = mt76_get_rxwi(&dev->mt76);
584+ dma_addr_t phy_addr;
developerc04f5402023-02-03 09:22:26 +0800585 int token;
586- void *buf;
587+ void *ptr;
588
589- r = mt76_get_rxwi(&dev->mt76);
590 if (!r)
591 goto unmap;
592
593- buf = mt76_get_page_pool_buf(q, &offset, q->buf_size);
594- if (!buf)
developerfd8e1152023-02-14 11:29:23 +0800595+ ptr = page_frag_alloc(&wed->rx_buf_ring.rx_page, length, GFP_ATOMIC);
596+ if (!ptr) {
developerc04f5402023-02-03 09:22:26 +0800597+ mt76_put_rxwi(&dev->mt76, r);
598 goto unmap;
599+ }
600
601- addr = page_pool_get_dma_addr(virt_to_head_page(buf)) + offset;
602- dir = page_pool_get_dma_dir(q->page_pool);
603- dma_sync_single_for_device(dev->mt76.dma_dev, addr, len, dir);
developerc04f5402023-02-03 09:22:26 +0800604+ phy_addr = dma_map_single(dev->mt76.dma_dev, ptr,
605+ wed->wlan.rx_size,
606+ DMA_TO_DEVICE);
developerfd8e1152023-02-14 11:29:23 +0800607
608- desc->buf0 = cpu_to_le32(addr);
609- token = mt76_rx_token_consume(&dev->mt76, buf, r, addr);
developerc04f5402023-02-03 09:22:26 +0800610+ if (unlikely(dma_mapping_error(dev->mt76.dev, phy_addr))) {
developerfd8e1152023-02-14 11:29:23 +0800611+ skb_free_frag(ptr);
developerc04f5402023-02-03 09:22:26 +0800612+ mt76_put_rxwi(&dev->mt76, r);
613+ goto unmap;
614+ }
615+ desc->buf0 = cpu_to_le32(phy_addr);
616+ token = mt76_rx_token_consume(&dev->mt76, ptr, r, phy_addr);
617 if (token < 0) {
618- mt76_put_page_pool_buf(buf, false);
619+ dma_unmap_single(dev->mt76.dma_dev, phy_addr,
620+ wed->wlan.rx_size, DMA_TO_DEVICE);
developerfd8e1152023-02-14 11:29:23 +0800621+ skb_free_frag(ptr);
developerc04f5402023-02-03 09:22:26 +0800622+ mt76_put_rxwi(&dev->mt76, r);
623 goto unmap;
624 }
625
developerfd8e1152023-02-14 11:29:23 +0800626@@ -646,8 +680,6 @@ static u32 mt7915_mmio_wed_init_rx_buf(struct mtk_wed_device *wed, int size)
developerc04f5402023-02-03 09:22:26 +0800627 return 0;
628
629 unmap:
630- if (r)
631- mt76_put_rxwi(&dev->mt76, r);
632 mt7915_mmio_wed_release_rx_buf(wed);
633 return -ENOMEM;
634 }
635diff --git a/mt7921/main.c b/mt7921/main.c
developer4f0d84b2023-03-03 14:21:44 +0800636index a72964e7..4c400223 100644
developerc04f5402023-02-03 09:22:26 +0800637--- a/mt7921/main.c
638+++ b/mt7921/main.c
639@@ -1090,34 +1090,17 @@ static void
640 mt7921_get_et_strings(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
641 u32 sset, u8 *data)
642 {
643- struct mt7921_dev *dev = mt7921_hw_dev(hw);
644-
645 if (sset != ETH_SS_STATS)
646 return;
647
648 memcpy(data, *mt7921_gstrings_stats, sizeof(mt7921_gstrings_stats));
649-
650- if (mt76_is_sdio(&dev->mt76))
651- return;
652-
653- data += sizeof(mt7921_gstrings_stats);
654- page_pool_ethtool_stats_get_strings(data);
655 }
656
657 static int
658 mt7921_get_et_sset_count(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
659 int sset)
660 {
661- struct mt7921_dev *dev = mt7921_hw_dev(hw);
662-
663- if (sset != ETH_SS_STATS)
664- return 0;
665-
666- if (mt76_is_sdio(&dev->mt76))
667- return ARRAY_SIZE(mt7921_gstrings_stats);
668-
669- return ARRAY_SIZE(mt7921_gstrings_stats) +
670- page_pool_ethtool_stats_get_count();
671+ return sset == ETH_SS_STATS ? ARRAY_SIZE(mt7921_gstrings_stats) : 0;
672 }
673
674 static void
675@@ -1137,7 +1120,6 @@ void mt7921_get_et_stats(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
676 struct ethtool_stats *stats, u64 *data)
677 {
678 struct mt7921_vif *mvif = (struct mt7921_vif *)vif->drv_priv;
679- int stats_size = ARRAY_SIZE(mt7921_gstrings_stats);
680 struct mt7921_phy *phy = mt7921_hw_phy(hw);
681 struct mt7921_dev *dev = phy->dev;
682 struct mib_stats *mib = &phy->mib;
683@@ -1193,14 +1175,9 @@ void mt7921_get_et_stats(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
684 return;
685
686 ei += wi.worker_stat_count;
687-
688- if (!mt76_is_sdio(&dev->mt76)) {
689- mt76_ethtool_page_pool_stats(&dev->mt76, &data[ei], &ei);
690- stats_size += page_pool_ethtool_stats_get_count();
691- }
692-
693- if (ei != stats_size)
694- dev_err(dev->mt76.dev, "ei: %d SSTATS_LEN: %d", ei, stats_size);
695+ if (ei != ARRAY_SIZE(mt7921_gstrings_stats))
696+ dev_err(dev->mt76.dev, "ei: %d SSTATS_LEN: %zu",
697+ ei, ARRAY_SIZE(mt7921_gstrings_stats));
698 }
699
700 static u64
701diff --git a/usb.c b/usb.c
developer4f0d84b2023-03-03 14:21:44 +0800702index 5e5c7bf5..f0a50f57 100644
developerc04f5402023-02-03 09:22:26 +0800703--- a/usb.c
704+++ b/usb.c
705@@ -319,27 +319,29 @@ mt76u_set_endpoints(struct usb_interface *intf,
706
707 static int
708 mt76u_fill_rx_sg(struct mt76_dev *dev, struct mt76_queue *q, struct urb *urb,
709- int nsgs)
710+ int nsgs, gfp_t gfp)
711 {
712 int i;
713
714 for (i = 0; i < nsgs; i++) {
715+ struct page *page;
716 void *data;
717 int offset;
718
719- data = mt76_get_page_pool_buf(q, &offset, q->buf_size);
720+ data = page_frag_alloc(&q->rx_page, q->buf_size, gfp);
721 if (!data)
722 break;
723
724- sg_set_page(&urb->sg[i], virt_to_head_page(data), q->buf_size,
725- offset);
726+ page = virt_to_head_page(data);
727+ offset = data - page_address(page);
728+ sg_set_page(&urb->sg[i], page, q->buf_size, offset);
729 }
730
731 if (i < nsgs) {
732 int j;
733
734 for (j = nsgs; j < urb->num_sgs; j++)
735- mt76_put_page_pool_buf(sg_virt(&urb->sg[j]), false);
736+ skb_free_frag(sg_virt(&urb->sg[j]));
737 urb->num_sgs = i;
738 }
739
740@@ -352,16 +354,15 @@ mt76u_fill_rx_sg(struct mt76_dev *dev, struct mt76_queue *q, struct urb *urb,
741
742 static int
743 mt76u_refill_rx(struct mt76_dev *dev, struct mt76_queue *q,
744- struct urb *urb, int nsgs)
745+ struct urb *urb, int nsgs, gfp_t gfp)
746 {
747 enum mt76_rxq_id qid = q - &dev->q_rx[MT_RXQ_MAIN];
748- int offset;
749
750 if (qid == MT_RXQ_MAIN && dev->usb.sg_en)
751- return mt76u_fill_rx_sg(dev, q, urb, nsgs);
752+ return mt76u_fill_rx_sg(dev, q, urb, nsgs, gfp);
753
754 urb->transfer_buffer_length = q->buf_size;
755- urb->transfer_buffer = mt76_get_page_pool_buf(q, &offset, q->buf_size);
756+ urb->transfer_buffer = page_frag_alloc(&q->rx_page, q->buf_size, gfp);
757
758 return urb->transfer_buffer ? 0 : -ENOMEM;
759 }
760@@ -399,7 +400,7 @@ mt76u_rx_urb_alloc(struct mt76_dev *dev, struct mt76_queue *q,
761 if (err)
762 return err;
763
764- return mt76u_refill_rx(dev, q, e->urb, sg_size);
765+ return mt76u_refill_rx(dev, q, e->urb, sg_size, GFP_KERNEL);
766 }
767
768 static void mt76u_urb_free(struct urb *urb)
769@@ -407,10 +408,10 @@ static void mt76u_urb_free(struct urb *urb)
770 int i;
771
772 for (i = 0; i < urb->num_sgs; i++)
773- mt76_put_page_pool_buf(sg_virt(&urb->sg[i]), false);
774+ skb_free_frag(sg_virt(&urb->sg[i]));
775
776 if (urb->transfer_buffer)
777- mt76_put_page_pool_buf(urb->transfer_buffer, false);
778+ skb_free_frag(urb->transfer_buffer);
779
780 usb_free_urb(urb);
781 }
782@@ -546,8 +547,6 @@ mt76u_process_rx_entry(struct mt76_dev *dev, struct urb *urb,
783 len -= data_len;
784 nsgs++;
785 }
786-
787- skb_mark_for_recycle(skb);
788 dev->drv->rx_skb(dev, MT_RXQ_MAIN, skb, NULL);
789
790 return nsgs;
791@@ -613,7 +612,7 @@ mt76u_process_rx_queue(struct mt76_dev *dev, struct mt76_queue *q)
792
793 count = mt76u_process_rx_entry(dev, urb, q->buf_size);
794 if (count > 0) {
795- err = mt76u_refill_rx(dev, q, urb, count);
796+ err = mt76u_refill_rx(dev, q, urb, count, GFP_ATOMIC);
797 if (err < 0)
798 break;
799 }
800@@ -664,10 +663,6 @@ mt76u_alloc_rx_queue(struct mt76_dev *dev, enum mt76_rxq_id qid)
801 struct mt76_queue *q = &dev->q_rx[qid];
802 int i, err;
803
804- err = mt76_create_page_pool(dev, q);
805- if (err)
806- return err;
807-
808 spin_lock_init(&q->lock);
809 q->entry = devm_kcalloc(dev->dev,
810 MT_NUM_RX_ENTRIES, sizeof(*q->entry),
811@@ -696,6 +691,7 @@ EXPORT_SYMBOL_GPL(mt76u_alloc_mcu_queue);
812 static void
813 mt76u_free_rx_queue(struct mt76_dev *dev, struct mt76_queue *q)
814 {
815+ struct page *page;
816 int i;
817
818 for (i = 0; i < q->ndesc; i++) {
developer4f0d84b2023-03-03 14:21:44 +0800819@@ -705,8 +701,12 @@ mt76u_free_rx_queue(struct mt76_dev *dev, struct mt76_queue *q)
developerc04f5402023-02-03 09:22:26 +0800820 mt76u_urb_free(q->entry[i].urb);
821 q->entry[i].urb = NULL;
822 }
823- page_pool_destroy(q->page_pool);
developer4f0d84b2023-03-03 14:21:44 +0800824- q->page_pool = NULL;
developerc04f5402023-02-03 09:22:26 +0800825+ if (!q->rx_page.va)
826+ return;
827+
828+ page = virt_to_page(q->rx_page.va);
829+ __page_frag_cache_drain(page, q->rx_page.pagecnt_bias);
830+ memset(&q->rx_page, 0, sizeof(q->rx_page));
831 }
832
833 static void mt76u_free_rx(struct mt76_dev *dev)
834--
8352.18.0
836