|
@@ -0,0 +1,317 @@
|
|
|
+/* SPDX-License-Identifier: GPL-2.0
|
|
|
+ *
|
|
|
+ * page_pool.c
|
|
|
+ * Author: Jesper Dangaard Brouer <netoptimizer@brouer.com>
|
|
|
+ * Copyright (C) 2016 Red Hat, Inc.
|
|
|
+ */
|
|
|
+#include <linux/types.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/slab.h>
|
|
|
+
|
|
|
+#include <net/page_pool.h>
|
|
|
+#include <linux/dma-direction.h>
|
|
|
+#include <linux/dma-mapping.h>
|
|
|
+#include <linux/page-flags.h>
|
|
|
+#include <linux/mm.h> /* for __put_page() */
|
|
|
+
|
|
|
+static int page_pool_init(struct page_pool *pool,
|
|
|
+ const struct page_pool_params *params)
|
|
|
+{
|
|
|
+ unsigned int ring_qsize = 1024; /* Default */
|
|
|
+
|
|
|
+ memcpy(&pool->p, params, sizeof(pool->p));
|
|
|
+
|
|
|
+ /* Validate only known flags were used */
|
|
|
+ if (pool->p.flags & ~(PP_FLAG_ALL))
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ if (pool->p.pool_size)
|
|
|
+ ring_qsize = pool->p.pool_size;
|
|
|
+
|
|
|
+ /* Sanity limit mem that can be pinned down */
|
|
|
+ if (ring_qsize > 32768)
|
|
|
+ return -E2BIG;
|
|
|
+
|
|
|
+ /* DMA direction is either DMA_FROM_DEVICE or DMA_BIDIRECTIONAL.
|
|
|
+ * DMA_BIDIRECTIONAL is for allowing page used for DMA sending,
|
|
|
+ * which is the XDP_TX use-case.
|
|
|
+ */
|
|
|
+ if ((pool->p.dma_dir != DMA_FROM_DEVICE) &&
|
|
|
+ (pool->p.dma_dir != DMA_BIDIRECTIONAL))
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ if (ptr_ring_init(&pool->ring, ring_qsize, GFP_KERNEL) < 0)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+struct page_pool *page_pool_create(const struct page_pool_params *params)
|
|
|
+{
|
|
|
+ struct page_pool *pool;
|
|
|
+ int err = 0;
|
|
|
+
|
|
|
+ pool = kzalloc_node(sizeof(*pool), GFP_KERNEL, params->nid);
|
|
|
+ if (!pool)
|
|
|
+ return ERR_PTR(-ENOMEM);
|
|
|
+
|
|
|
+ err = page_pool_init(pool, params);
|
|
|
+ if (err < 0) {
|
|
|
+ pr_warn("%s() gave up with errno %d\n", __func__, err);
|
|
|
+ kfree(pool);
|
|
|
+ return ERR_PTR(err);
|
|
|
+ }
|
|
|
+ return pool;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(page_pool_create);
|
|
|
+
|
|
|
+/* fast path */
|
|
|
+static struct page *__page_pool_get_cached(struct page_pool *pool)
|
|
|
+{
|
|
|
+ struct ptr_ring *r = &pool->ring;
|
|
|
+ struct page *page;
|
|
|
+
|
|
|
+ /* Quicker fallback, avoid locks when ring is empty */
|
|
|
+ if (__ptr_ring_empty(r))
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ /* Test for safe-context, caller should provide this guarantee */
|
|
|
+ if (likely(in_serving_softirq())) {
|
|
|
+ if (likely(pool->alloc.count)) {
|
|
|
+ /* Fast-path */
|
|
|
+ page = pool->alloc.cache[--pool->alloc.count];
|
|
|
+ return page;
|
|
|
+ }
|
|
|
+ /* Slower-path: Alloc array empty, time to refill
|
|
|
+ *
|
|
|
+ * Open-coded bulk ptr_ring consumer.
|
|
|
+ *
|
|
|
+ * Discussion: the ring consumer lock is not really
|
|
|
+ * needed due to the softirq/NAPI protection, but
|
|
|
+ * later need the ability to reclaim pages on the
|
|
|
+ * ring. Thus, keeping the locks.
|
|
|
+ */
|
|
|
+ spin_lock(&r->consumer_lock);
|
|
|
+ while ((page = __ptr_ring_consume(r))) {
|
|
|
+ if (pool->alloc.count == PP_ALLOC_CACHE_REFILL)
|
|
|
+ break;
|
|
|
+ pool->alloc.cache[pool->alloc.count++] = page;
|
|
|
+ }
|
|
|
+ spin_unlock(&r->consumer_lock);
|
|
|
+ return page;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Slow-path: Get page from locked ring queue */
|
|
|
+ page = ptr_ring_consume(&pool->ring);
|
|
|
+ return page;
|
|
|
+}
|
|
|
+
|
|
|
+/* slow path */
|
|
|
+noinline
|
|
|
+static struct page *__page_pool_alloc_pages_slow(struct page_pool *pool,
|
|
|
+ gfp_t _gfp)
|
|
|
+{
|
|
|
+ struct page *page;
|
|
|
+ gfp_t gfp = _gfp;
|
|
|
+ dma_addr_t dma;
|
|
|
+
|
|
|
+ /* We could always set __GFP_COMP, and avoid this branch, as
|
|
|
+ * prep_new_page() can handle order-0 with __GFP_COMP.
|
|
|
+ */
|
|
|
+ if (pool->p.order)
|
|
|
+ gfp |= __GFP_COMP;
|
|
|
+
|
|
|
+ /* FUTURE development:
|
|
|
+ *
|
|
|
+ * Current slow-path essentially falls back to single page
|
|
|
+ * allocations, which doesn't improve performance. This code
|
|
|
+ * need bulk allocation support from the page allocator code.
|
|
|
+ */
|
|
|
+
|
|
|
+ /* Cache was empty, do real allocation */
|
|
|
+ page = alloc_pages_node(pool->p.nid, gfp, pool->p.order);
|
|
|
+ if (!page)
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ if (!(pool->p.flags & PP_FLAG_DMA_MAP))
|
|
|
+ goto skip_dma_map;
|
|
|
+
|
|
|
+ /* Setup DMA mapping: use page->private for DMA-addr
|
|
|
+ * This mapping is kept for lifetime of page, until leaving pool.
|
|
|
+ */
|
|
|
+ dma = dma_map_page(pool->p.dev, page, 0,
|
|
|
+ (PAGE_SIZE << pool->p.order),
|
|
|
+ pool->p.dma_dir);
|
|
|
+ if (dma_mapping_error(pool->p.dev, dma)) {
|
|
|
+ put_page(page);
|
|
|
+ return NULL;
|
|
|
+ }
|
|
|
+ set_page_private(page, dma); /* page->private = dma; */
|
|
|
+
|
|
|
+skip_dma_map:
|
|
|
+ /* When page just alloc'ed is should/must have refcnt 1. */
|
|
|
+ return page;
|
|
|
+}
|
|
|
+
|
|
|
+/* For using page_pool replace: alloc_pages() API calls, but provide
|
|
|
+ * synchronization guarantee for allocation side.
|
|
|
+ */
|
|
|
+struct page *page_pool_alloc_pages(struct page_pool *pool, gfp_t gfp)
|
|
|
+{
|
|
|
+ struct page *page;
|
|
|
+
|
|
|
+ /* Fast-path: Get a page from cache */
|
|
|
+ page = __page_pool_get_cached(pool);
|
|
|
+ if (page)
|
|
|
+ return page;
|
|
|
+
|
|
|
+ /* Slow-path: cache empty, do real allocation */
|
|
|
+ page = __page_pool_alloc_pages_slow(pool, gfp);
|
|
|
+ return page;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(page_pool_alloc_pages);
|
|
|
+
|
|
|
+/* Cleanup page_pool state from page */
|
|
|
+static void __page_pool_clean_page(struct page_pool *pool,
|
|
|
+ struct page *page)
|
|
|
+{
|
|
|
+ if (!(pool->p.flags & PP_FLAG_DMA_MAP))
|
|
|
+ return;
|
|
|
+
|
|
|
+ /* DMA unmap */
|
|
|
+ dma_unmap_page(pool->p.dev, page_private(page),
|
|
|
+ PAGE_SIZE << pool->p.order, pool->p.dma_dir);
|
|
|
+ set_page_private(page, 0);
|
|
|
+}
|
|
|
+
|
|
|
+/* Return a page to the page allocator, cleaning up our state */
|
|
|
+static void __page_pool_return_page(struct page_pool *pool, struct page *page)
|
|
|
+{
|
|
|
+ __page_pool_clean_page(pool, page);
|
|
|
+ put_page(page);
|
|
|
+ /* An optimization would be to call __free_pages(page, pool->p.order)
|
|
|
+ * knowing page is not part of page-cache (thus avoiding a
|
|
|
+ * __page_cache_release() call).
|
|
|
+ */
|
|
|
+}
|
|
|
+
|
|
|
+static bool __page_pool_recycle_into_ring(struct page_pool *pool,
|
|
|
+ struct page *page)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+ /* BH protection not needed if current is serving softirq */
|
|
|
+ if (in_serving_softirq())
|
|
|
+ ret = ptr_ring_produce(&pool->ring, page);
|
|
|
+ else
|
|
|
+ ret = ptr_ring_produce_bh(&pool->ring, page);
|
|
|
+
|
|
|
+ return (ret == 0) ? true : false;
|
|
|
+}
|
|
|
+
|
|
|
+/* Only allow direct recycling in special circumstances, into the
|
|
|
+ * alloc side cache. E.g. during RX-NAPI processing for XDP_DROP use-case.
|
|
|
+ *
|
|
|
+ * Caller must provide appropriate safe context.
|
|
|
+ */
|
|
|
+static bool __page_pool_recycle_direct(struct page *page,
|
|
|
+ struct page_pool *pool)
|
|
|
+{
|
|
|
+ if (unlikely(pool->alloc.count == PP_ALLOC_CACHE_SIZE))
|
|
|
+ return false;
|
|
|
+
|
|
|
+ /* Caller MUST have verified/know (page_ref_count(page) == 1) */
|
|
|
+ pool->alloc.cache[pool->alloc.count++] = page;
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
+void __page_pool_put_page(struct page_pool *pool,
|
|
|
+ struct page *page, bool allow_direct)
|
|
|
+{
|
|
|
+ /* This allocator is optimized for the XDP mode that uses
|
|
|
+ * one-frame-per-page, but have fallbacks that act like the
|
|
|
+ * regular page allocator APIs.
|
|
|
+ *
|
|
|
+ * refcnt == 1 means page_pool owns page, and can recycle it.
|
|
|
+ */
|
|
|
+ if (likely(page_ref_count(page) == 1)) {
|
|
|
+ /* Read barrier done in page_ref_count / READ_ONCE */
|
|
|
+
|
|
|
+ if (allow_direct && in_serving_softirq())
|
|
|
+ if (__page_pool_recycle_direct(page, pool))
|
|
|
+ return;
|
|
|
+
|
|
|
+ if (!__page_pool_recycle_into_ring(pool, page)) {
|
|
|
+ /* Cache full, fallback to free pages */
|
|
|
+ __page_pool_return_page(pool, page);
|
|
|
+ }
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ /* Fallback/non-XDP mode: API user have elevated refcnt.
|
|
|
+ *
|
|
|
+ * Many drivers split up the page into fragments, and some
|
|
|
+ * want to keep doing this to save memory and do refcnt based
|
|
|
+ * recycling. Support this use case too, to ease drivers
|
|
|
+ * switching between XDP/non-XDP.
|
|
|
+ *
|
|
|
+ * In-case page_pool maintains the DMA mapping, API user must
|
|
|
+ * call page_pool_put_page once. In this elevated refcnt
|
|
|
+ * case, the DMA is unmapped/released, as driver is likely
|
|
|
+ * doing refcnt based recycle tricks, meaning another process
|
|
|
+ * will be invoking put_page.
|
|
|
+ */
|
|
|
+ __page_pool_clean_page(pool, page);
|
|
|
+ put_page(page);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(__page_pool_put_page);
|
|
|
+
|
|
|
+static void __page_pool_empty_ring(struct page_pool *pool)
|
|
|
+{
|
|
|
+ struct page *page;
|
|
|
+
|
|
|
+ /* Empty recycle ring */
|
|
|
+ while ((page = ptr_ring_consume(&pool->ring))) {
|
|
|
+ /* Verify the refcnt invariant of cached pages */
|
|
|
+ if (!(page_ref_count(page) == 1))
|
|
|
+ pr_crit("%s() page_pool refcnt %d violation\n",
|
|
|
+ __func__, page_ref_count(page));
|
|
|
+
|
|
|
+ __page_pool_return_page(pool, page);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void __page_pool_destroy_rcu(struct rcu_head *rcu)
|
|
|
+{
|
|
|
+ struct page_pool *pool;
|
|
|
+
|
|
|
+ pool = container_of(rcu, struct page_pool, rcu);
|
|
|
+
|
|
|
+ WARN(pool->alloc.count, "API usage violation");
|
|
|
+
|
|
|
+ __page_pool_empty_ring(pool);
|
|
|
+ ptr_ring_cleanup(&pool->ring, NULL);
|
|
|
+ kfree(pool);
|
|
|
+}
|
|
|
+
|
|
|
+/* Cleanup and release resources */
|
|
|
+void page_pool_destroy(struct page_pool *pool)
|
|
|
+{
|
|
|
+ struct page *page;
|
|
|
+
|
|
|
+ /* Empty alloc cache, assume caller made sure this is
|
|
|
+ * no-longer in use, and page_pool_alloc_pages() cannot be
|
|
|
+ * call concurrently.
|
|
|
+ */
|
|
|
+ while (pool->alloc.count) {
|
|
|
+ page = pool->alloc.cache[--pool->alloc.count];
|
|
|
+ __page_pool_return_page(pool, page);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* No more consumers should exist, but producers could still
|
|
|
+ * be in-flight.
|
|
|
+ */
|
|
|
+ __page_pool_empty_ring(pool);
|
|
|
+
|
|
|
+ /* An xdp_mem_allocator can still ref page_pool pointer */
|
|
|
+ call_rcu(&pool->rcu, __page_pool_destroy_rcu);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(page_pool_destroy);
|