[PATCH net-next v1 04/11] xsk: Allocate UMEM chunks through page_pool

@@ -69,6 +69,7 @@ DECLARE_STATIC_KEY_FALSE(page_pool_restricted);
 enum net_iov_type {
 	NET_IOV_DMABUF,
 	NET_IOV_IOURING,
+	NET_IOV_XSK,
 };
 
 /* A memory descriptor representing abstract networking I/O vectors.

@@ -107,6 +108,10 @@ struct net_iov_area {
 	size_t num_niovs;
 	/* Each net_iov covers 1 << niov_shift bytes. */
 	unsigned int niov_shift;
+	/* CPU address of the first net_iov, or NULL if the CPU cannot read
+	 * the area.
+	 */
+	void *vaddr;
 };
 
 static inline struct net_iov_area *net_iov_owner(const struct net_iov *niov)

@@ -119,6 +124,18 @@ static inline unsigned int net_iov_idx(const struct net_iov *niov)
 	return niov - net_iov_owner(niov)->niovs;
 }
 
+static inline void *net_iov_address(const struct net_iov *niov)
+{
+	const struct net_iov_area *area = net_iov_owner(niov);
+	unsigned long off;
+
+	if (!area->vaddr)
+		return NULL;
+
+	off = (unsigned long)net_iov_idx(niov) << area->niov_shift;
+	return area->vaddr + off;
+}
+
 /* Initialize a niov: stamp the owning area, the memory provider type.
  */
 static inline void net_iov_init(struct net_iov *niov,

@@ -345,10 +362,16 @@ static inline void *__netmem_address(netmem_ref netmem)
 	return page_address(__netmem_to_page(netmem));
 }
 
+/**
+ * netmem_address - get the CPU address of the memory behind @netmem
+ * @netmem: netmem to get the address of
+ *
+ * Return: the address, or NULL if the CPU cannot read @netmem.
+ */
 static inline void *netmem_address(netmem_ref netmem)
 {
 	if (netmem_is_net_iov(netmem))
-		return NULL;
+		return net_iov_address(netmem_to_net_iov(netmem));
 
 	return __netmem_address(netmem);
 }

@@ -368,7 +368,7 @@ static inline bool xdp_buff_add_frag(struct xdp_buff *xdp, netmem_ref netmem,
 
 	if (unlikely(netmem_is_pfmemalloc(netmem)))
 		xdp_buff_set_frag_pfmemalloc(xdp);
-	if (unlikely(netmem_is_net_iov(netmem)))
+	if (unlikely(netmem_is_net_iov(netmem) && !netmem_address(netmem)))
 		xdp_buff_set_frag_unreadable(xdp);
 
 	return true;

@@ -2,6 +2,7 @@
 config XDP_SOCKETS
 	bool "XDP sockets"
 	depends on BPF_SYSCALL
+	select PAGE_POOL
 	default n
 	help
 	  XDP sockets allows a channel between XDP programs and

@@ -1,4 +1,4 @@
 # SPDX-License-Identifier: GPL-2.0-only
 obj-$(CONFIG_XDP_SOCKETS) += xsk.o xdp_umem.o xsk_queue.o xskmap.o
-obj-$(CONFIG_XDP_SOCKETS) += xsk_buff_pool.o
+obj-$(CONFIG_XDP_SOCKETS) += xsk_buff_pool.o xsk_pp.o
 obj-$(CONFIG_XDP_SOCKETS_DIAG) += xsk_diag.o

@@ -34,6 +34,12 @@ static inline struct xdp_sock *xdp_sk(struct sock *sk)
 
 void xsk_map_try_sock_delete(struct xsk_map *map, struct xdp_sock *xs,
 			     struct xdp_sock __rcu **map_entry);
+struct xsk_pp;
+
+extern const struct memory_provider_ops xsk_pp_ops;
+
+struct xsk_pp *xsk_pp_create(struct xsk_buff_pool *pool);
+void xsk_pp_put(struct xsk_pp *pp);
 void xsk_clear_pool_at_qid(struct net_device *dev, u16 queue_id);
 int xsk_reg_pool_at_qid(struct net_device *dev, struct xsk_buff_pool *pool,
 			u16 queue_id);

@@ -0,0 +1,246 @@
+// SPDX-License-Identifier: GPL-2.0
+/* AF_XDP UMEM as a page pool memory provider
+ *
+ * Each aligned UMEM chunk is a readable net_iov with one owner at a time:
+ *
+ *   userspace --FILL--> page pool --release--> reuse --alloc--> page pool
+ *       ^                   |
+ *       +-----RX ring-------+
+ */
+
+#include <net/page_pool/helpers.h>
+#include <net/page_pool/memory_provider.h>
+#include <net/xdp_sock_drv.h>
+
+#include "xsk.h"
+#include "xsk_queue.h"
+
+enum xsk_pp_chunk {
+	XSK_PP_USER,	/* owned by userspace */
+	XSK_PP_POOL,	/* owned by a page pool */
+	XSK_PP_REUSE,	/* on the reuse stack */
+};
+
+struct xsk_pp {
+	struct net_iov_area area;
+	struct xsk_buff_pool *pool;
+	/* Protects fq, state and reuse */
+	spinlock_t lock;
+	struct xsk_queue *fq;
+	refcount_t refs;
+	u32 nr_pools;
+	bool dma_need_sync;
+	u8 *state;
+	u32 reuse_cnt;
+	u32 reuse[];
+};
+
+static void xsk_pp_free(struct xsk_pp *pp)
+{
+	kvfree(pp->state);
+	kvfree(pp->area.niovs);
+	kvfree(pp);
+}
+
+void xsk_pp_put(struct xsk_pp *pp)
+{
+	if (refcount_dec_and_test(&pp->refs))
+		xsk_pp_free(pp);
+}
+
+/* @pool must be DMA mapped and have aligned chunks. The provider must be
+ * the only consumer of its FILL ring.
+ */
+struct xsk_pp *xsk_pp_create(struct xsk_buff_pool *pool)
+{
+	struct net_iov *niov;
+	struct xsk_pp *pp;
+	dma_addr_t dma;
+	u32 i;
+
+	pp = kvzalloc_flex(*pp, reuse, pool->heads_cnt, GFP_KERNEL_ACCOUNT);
+	if (!pp)
+		return ERR_PTR(-ENOMEM);
+
+	pp->area.niovs = kvzalloc_objs(*pp->area.niovs, pool->heads_cnt,
+				       GFP_KERNEL_ACCOUNT);
+	pp->state = kvzalloc(pool->heads_cnt, GFP_KERNEL_ACCOUNT);
+	if (!pp->area.niovs || !pp->state) {
+		xsk_pp_free(pp);
+		return ERR_PTR(-ENOMEM);
+	}
+
+	pp->area.num_niovs = pool->heads_cnt;
+	pp->area.niov_shift = pool->chunk_shift;
+	pp->area.vaddr = pool->addrs;
+	pp->pool = pool;
+	pp->fq = pool->fq;
+	pp->dma_need_sync = dma_dev_need_sync(pool->dev);
+	spin_lock_init(&pp->lock);
+	refcount_set(&pp->refs, 1);
+
+	for (i = 0; i < pp->area.num_niovs; i++) {
+		niov = &pp->area.niovs[i];
+		dma = xp_raw_get_dma(pool, (u64)i << pool->chunk_shift);
+		net_iov_init(niov, &pp->area, NET_IOV_XSK);
+		if (net_mp_niov_set_dma_addr(niov, dma)) {
+			xsk_pp_free(pp);
+			return ERR_PTR(-ERANGE);
+		}
+	}
+
+	return pp;
+}
+
+static int xsk_pp_init(struct page_pool *pool)
+{
+	struct xsk_pp *pp = pool->mp_priv;
+
+	if (pool->p.order || pool->p.dma_dir != DMA_BIDIRECTIONAL ||
+	    pool->p.dev != pp->pool->dev)
+		return -EINVAL;
+	if (pool->p.max_len > pp->pool->chunk_size ||
+	    pool->p.offset > pp->pool->chunk_size - pool->p.max_len)
+		return -EINVAL;
+
+	refcount_inc(&pp->refs);
+	spin_lock_bh(&pp->lock);
+	pp->nr_pools++;
+	spin_unlock_bh(&pp->lock);
+	return 0;
+}
+
+static void xsk_pp_destroy(struct page_pool *pool)
+{
+	struct xsk_pp *pp = pool->mp_priv;
+
+	spin_lock_bh(&pp->lock);
+	pp->nr_pools--;
+	spin_unlock_bh(&pp->lock);
+	xsk_pp_put(pp);
+}
+
+static bool xsk_pp_claim(struct xsk_pp *pp, u32 idx, enum xsk_pp_chunk from)
+{
+	lockdep_assert_held(&pp->lock);
+
+	if (pp->state[idx] != from)
+		return false;
+
+	pp->state[idx] = XSK_PP_POOL;
+	return true;
+}
+
+static u32 xsk_pp_alloc_reuse(struct xsk_pp *pp, netmem_ref *netmems, u32 max)
+{
+	u32 idx, n = 0;
+
+	while (n < max && pp->reuse_cnt) {
+		idx = pp->reuse[--pp->reuse_cnt];
+		if (WARN_ON_ONCE(!xsk_pp_claim(pp, idx, XSK_PP_REUSE)))
+			continue;
+		netmems[n++] = net_iov_to_netmem(&pp->area.niovs[idx]);
+	}
+
+	return n;
+}
+
+static u32 xsk_pp_alloc_fill(struct xsk_pp *pp, netmem_ref *netmems, u32 max)
+{
+	struct xsk_buff_pool *pool = pp->pool;
+	struct xsk_queue *fq = pp->fq;
+	u32 i, entries, cons, idx, n = 0;
+	u64 addr;
+
+	if (!fq || !max)
+		return 0;
+
+	entries = xskq_cons_nb_entries(fq, max);
+	if (!entries) {
+		fq->queue_empty_descs++;
+		return 0;
+	}
+
+	cons = fq->cached_cons;
+	for (i = 0; i < entries; i++) {
+		__xskq_cons_read_addr_unchecked(fq, cons++, &addr);
+		addr &= pool->chunk_mask;
+		idx = addr >> pp->area.niov_shift;
+		if (unlikely(addr >= pool->addrs_cnt ||
+			     !xsk_pp_claim(pp, idx, XSK_PP_USER))) {
+			fq->invalid_descs++;
+			continue;
+		}
+		netmems[n++] = net_iov_to_netmem(&pp->area.niovs[idx]);
+	}
+
+	xskq_cons_release_n(fq, entries);
+	__xskq_cons_release(fq);
+	return n;
+}
+
+static netmem_ref xsk_pp_alloc_netmems(struct page_pool *pool, gfp_t gfp)
+{
+	netmem_ref *netmems = pool->alloc.cache;
+	struct xsk_pp *pp = pool->mp_priv;
+	struct net_iov *niov;
+	dma_addr_t dma;
+	u32 i, n;
+
+	if (WARN_ON_ONCE(pool->alloc.count))
+		return 0;
+
+	spin_lock_bh(&pp->lock);
+	n = xsk_pp_alloc_reuse(pp, netmems, PP_ALLOC_CACHE_REFILL);
+	n += xsk_pp_alloc_fill(pp, netmems + n, PP_ALLOC_CACHE_REFILL - n);
+	spin_unlock_bh(&pp->lock);
+	if (!n)
+		return 0;
+
+	for (i = 0; i < n; i++) {
+		niov = netmem_to_net_iov(netmems[i]);
+		dma = page_pool_get_dma_addr_netmem(netmems[i]);
+		if (pp->dma_need_sync)
+			dma_sync_single_range_for_device(pool->p.dev, dma,
+							 pool->p.offset,
+							 pool->p.max_len,
+							 pool->p.dma_dir);
+		net_mp_niov_set_page_pool(pool, niov);
+	}
+
+	pool->alloc.count = n - 1;
+	return netmems[n - 1];
+}
+
+static bool xsk_pp_release_netmem(struct page_pool *pool, netmem_ref netmem)
+{
+	struct net_iov *niov = netmem_to_net_iov(netmem);
+	struct xsk_pp *pp = pool->mp_priv;
+	u32 idx = net_iov_idx(niov);
+
+	spin_lock_bh(&pp->lock);
+	net_mp_niov_clear_page_pool(niov);
+	if (!WARN_ON_ONCE(pp->state[idx] != XSK_PP_POOL ||
+			  pp->reuse_cnt == pp->area.num_niovs)) {
+		pp->state[idx] = XSK_PP_REUSE;
+		pp->reuse[pp->reuse_cnt++] = idx;
+	}
+	spin_unlock_bh(&pp->lock);
+
+	return false;
+}
+
+static int xsk_pp_nl_fill(void *mp_priv, struct sk_buff *rsp,
+			  struct netdev_rx_queue *rxq)
+{
+	return 0;
+}
+
+const struct memory_provider_ops xsk_pp_ops = {
+	.init		= xsk_pp_init,
+	.destroy	= xsk_pp_destroy,
+	.alloc_netmems	= xsk_pp_alloc_netmems,
+	.release_netmem	= xsk_pp_release_netmem,
+	.nl_fill	= xsk_pp_nl_fill,
+	.caps		= MP_CAP_READABLE,
+};