Commit 1c1efc2a authored by Magnus Karlsson's avatar Magnus Karlsson Committed by Daniel Borkmann

xsk: Create and free buffer pool independently from umem

Create and free the buffer pool independently from the umem. Move
these operations that are performed on the buffer pool from the
umem create and destroy functions to new create and destroy
functions just for the buffer pool. This so that in later commits
we can instantiate multiple buffer pools per umem when sharing a
umem between HW queues and/or devices. We also erradicate the
back pointer from the umem to the buffer pool as this will not
work when we introduce the possibility to have multiple buffer
pools per umem.
Signed-off-by: default avatarMagnus Karlsson <magnus.karlsson@intel.com>
Signed-off-by: default avatarDaniel Borkmann <daniel@iogearbox.net>
Acked-by: default avatarBjörn Töpel <bjorn.topel@intel.com>
Link: https://lore.kernel.org/bpf/1598603189-32145-4-git-send-email-magnus.karlsson@intel.com
parent c4655761
...@@ -20,13 +20,12 @@ struct xdp_buff; ...@@ -20,13 +20,12 @@ struct xdp_buff;
struct xdp_umem { struct xdp_umem {
struct xsk_queue *fq; struct xsk_queue *fq;
struct xsk_queue *cq; struct xsk_queue *cq;
struct xsk_buff_pool *pool;
u64 size; u64 size;
u32 headroom; u32 headroom;
u32 chunk_size; u32 chunk_size;
u32 chunks;
struct user_struct *user; struct user_struct *user;
refcount_t users; refcount_t users;
struct work_struct work;
struct page **pgs; struct page **pgs;
u32 npgs; u32 npgs;
u16 queue_id; u16 queue_id;
......
...@@ -14,6 +14,7 @@ struct xdp_rxq_info; ...@@ -14,6 +14,7 @@ struct xdp_rxq_info;
struct xsk_queue; struct xsk_queue;
struct xdp_desc; struct xdp_desc;
struct xdp_umem; struct xdp_umem;
struct xdp_sock;
struct device; struct device;
struct page; struct page;
...@@ -46,16 +47,22 @@ struct xsk_buff_pool { ...@@ -46,16 +47,22 @@ struct xsk_buff_pool {
struct xdp_umem *umem; struct xdp_umem *umem;
void *addrs; void *addrs;
struct device *dev; struct device *dev;
refcount_t users;
struct work_struct work;
struct xdp_buff_xsk *free_heads[]; struct xdp_buff_xsk *free_heads[];
}; };
/* AF_XDP core. */ /* AF_XDP core. */
struct xsk_buff_pool *xp_create(struct xdp_umem *umem, u32 chunks, struct xsk_buff_pool *xp_create_and_assign_umem(struct xdp_sock *xs,
u32 chunk_size, u32 headroom, u64 size, struct xdp_umem *umem);
bool unaligned); int xp_assign_dev(struct xsk_buff_pool *pool, struct net_device *dev,
u16 queue_id, u16 flags);
void xp_set_fq(struct xsk_buff_pool *pool, struct xsk_queue *fq); void xp_set_fq(struct xsk_buff_pool *pool, struct xsk_queue *fq);
void xp_destroy(struct xsk_buff_pool *pool); void xp_destroy(struct xsk_buff_pool *pool);
void xp_release(struct xdp_buff_xsk *xskb); void xp_release(struct xdp_buff_xsk *xskb);
void xp_get_pool(struct xsk_buff_pool *pool);
void xp_put_pool(struct xsk_buff_pool *pool);
void xp_clear_dev(struct xsk_buff_pool *pool);
/* AF_XDP, and XDP core. */ /* AF_XDP, and XDP core. */
void xp_free(struct xdp_buff_xsk *xskb); void xp_free(struct xdp_buff_xsk *xskb);
......
...@@ -47,160 +47,41 @@ void xdp_del_sk_umem(struct xdp_umem *umem, struct xdp_sock *xs) ...@@ -47,160 +47,41 @@ void xdp_del_sk_umem(struct xdp_umem *umem, struct xdp_sock *xs)
spin_unlock_irqrestore(&umem->xsk_tx_list_lock, flags); spin_unlock_irqrestore(&umem->xsk_tx_list_lock, flags);
} }
/* The umem is stored both in the _rx struct and the _tx struct as we do static void xdp_umem_unpin_pages(struct xdp_umem *umem)
* not know if the device has more tx queues than rx, or the opposite.
* This might also change during run time.
*/
static int xsk_reg_pool_at_qid(struct net_device *dev,
struct xsk_buff_pool *pool,
u16 queue_id)
{
if (queue_id >= max_t(unsigned int,
dev->real_num_rx_queues,
dev->real_num_tx_queues))
return -EINVAL;
if (queue_id < dev->real_num_rx_queues)
dev->_rx[queue_id].pool = pool;
if (queue_id < dev->real_num_tx_queues)
dev->_tx[queue_id].pool = pool;
return 0;
}
struct xsk_buff_pool *xsk_get_pool_from_qid(struct net_device *dev,
u16 queue_id)
{ {
if (queue_id < dev->real_num_rx_queues) unpin_user_pages_dirty_lock(umem->pgs, umem->npgs, true);
return dev->_rx[queue_id].pool;
if (queue_id < dev->real_num_tx_queues)
return dev->_tx[queue_id].pool;
return NULL; kfree(umem->pgs);
umem->pgs = NULL;
} }
EXPORT_SYMBOL(xsk_get_pool_from_qid);
static void xsk_clear_pool_at_qid(struct net_device *dev, u16 queue_id) static void xdp_umem_unaccount_pages(struct xdp_umem *umem)
{ {
if (queue_id < dev->real_num_rx_queues) if (umem->user) {
dev->_rx[queue_id].pool = NULL; atomic_long_sub(umem->npgs, &umem->user->locked_vm);
if (queue_id < dev->real_num_tx_queues) free_uid(umem->user);
dev->_tx[queue_id].pool = NULL; }
} }
int xdp_umem_assign_dev(struct xdp_umem *umem, struct net_device *dev, void xdp_umem_assign_dev(struct xdp_umem *umem, struct net_device *dev,
u16 queue_id, u16 flags) u16 queue_id)
{ {
bool force_zc, force_copy;
struct netdev_bpf bpf;
int err = 0;
ASSERT_RTNL();
force_zc = flags & XDP_ZEROCOPY;
force_copy = flags & XDP_COPY;
if (force_zc && force_copy)
return -EINVAL;
if (xsk_get_pool_from_qid(dev, queue_id))
return -EBUSY;
err = xsk_reg_pool_at_qid(dev, umem->pool, queue_id);
if (err)
return err;
umem->dev = dev; umem->dev = dev;
umem->queue_id = queue_id; umem->queue_id = queue_id;
if (flags & XDP_USE_NEED_WAKEUP) {
umem->flags |= XDP_UMEM_USES_NEED_WAKEUP;
/* Tx needs to be explicitly woken up the first time.
* Also for supporting drivers that do not implement this
* feature. They will always have to call sendto().
*/
xsk_set_tx_need_wakeup(umem->pool);
}
dev_hold(dev); dev_hold(dev);
if (force_copy)
/* For copy-mode, we are done. */
return 0;
if (!dev->netdev_ops->ndo_bpf || !dev->netdev_ops->ndo_xsk_wakeup) {
err = -EOPNOTSUPP;
goto err_unreg_umem;
}
bpf.command = XDP_SETUP_XSK_POOL;
bpf.xsk.pool = umem->pool;
bpf.xsk.queue_id = queue_id;
err = dev->netdev_ops->ndo_bpf(dev, &bpf);
if (err)
goto err_unreg_umem;
umem->zc = true;
return 0;
err_unreg_umem:
if (!force_zc)
err = 0; /* fallback to copy mode */
if (err)
xsk_clear_pool_at_qid(dev, queue_id);
return err;
} }
void xdp_umem_clear_dev(struct xdp_umem *umem) void xdp_umem_clear_dev(struct xdp_umem *umem)
{ {
struct netdev_bpf bpf;
int err;
ASSERT_RTNL();
if (!umem->dev)
return;
if (umem->zc) {
bpf.command = XDP_SETUP_XSK_POOL;
bpf.xsk.pool = NULL;
bpf.xsk.queue_id = umem->queue_id;
err = umem->dev->netdev_ops->ndo_bpf(umem->dev, &bpf);
if (err)
WARN(1, "failed to disable umem!\n");
}
xsk_clear_pool_at_qid(umem->dev, umem->queue_id);
dev_put(umem->dev); dev_put(umem->dev);
umem->dev = NULL; umem->dev = NULL;
umem->zc = false; umem->zc = false;
} }
static void xdp_umem_unpin_pages(struct xdp_umem *umem)
{
unpin_user_pages_dirty_lock(umem->pgs, umem->npgs, true);
kfree(umem->pgs);
umem->pgs = NULL;
}
static void xdp_umem_unaccount_pages(struct xdp_umem *umem)
{
if (umem->user) {
atomic_long_sub(umem->npgs, &umem->user->locked_vm);
free_uid(umem->user);
}
}
static void xdp_umem_release(struct xdp_umem *umem) static void xdp_umem_release(struct xdp_umem *umem)
{ {
rtnl_lock();
xdp_umem_clear_dev(umem); xdp_umem_clear_dev(umem);
rtnl_unlock();
ida_simple_remove(&umem_ida, umem->id); ida_simple_remove(&umem_ida, umem->id);
...@@ -214,20 +95,12 @@ static void xdp_umem_release(struct xdp_umem *umem) ...@@ -214,20 +95,12 @@ static void xdp_umem_release(struct xdp_umem *umem)
umem->cq = NULL; umem->cq = NULL;
} }
xp_destroy(umem->pool);
xdp_umem_unpin_pages(umem); xdp_umem_unpin_pages(umem);
xdp_umem_unaccount_pages(umem); xdp_umem_unaccount_pages(umem);
kfree(umem); kfree(umem);
} }
static void xdp_umem_release_deferred(struct work_struct *work)
{
struct xdp_umem *umem = container_of(work, struct xdp_umem, work);
xdp_umem_release(umem);
}
void xdp_get_umem(struct xdp_umem *umem) void xdp_get_umem(struct xdp_umem *umem)
{ {
refcount_inc(&umem->users); refcount_inc(&umem->users);
...@@ -238,10 +111,8 @@ void xdp_put_umem(struct xdp_umem *umem) ...@@ -238,10 +111,8 @@ void xdp_put_umem(struct xdp_umem *umem)
if (!umem) if (!umem)
return; return;
if (refcount_dec_and_test(&umem->users)) { if (refcount_dec_and_test(&umem->users))
INIT_WORK(&umem->work, xdp_umem_release_deferred); xdp_umem_release(umem);
schedule_work(&umem->work);
}
} }
static int xdp_umem_pin_pages(struct xdp_umem *umem, unsigned long address) static int xdp_umem_pin_pages(struct xdp_umem *umem, unsigned long address)
...@@ -357,6 +228,7 @@ static int xdp_umem_reg(struct xdp_umem *umem, struct xdp_umem_reg *mr) ...@@ -357,6 +228,7 @@ static int xdp_umem_reg(struct xdp_umem *umem, struct xdp_umem_reg *mr)
umem->size = size; umem->size = size;
umem->headroom = headroom; umem->headroom = headroom;
umem->chunk_size = chunk_size; umem->chunk_size = chunk_size;
umem->chunks = chunks;
umem->npgs = (u32)npgs; umem->npgs = (u32)npgs;
umem->pgs = NULL; umem->pgs = NULL;
umem->user = NULL; umem->user = NULL;
...@@ -374,16 +246,8 @@ static int xdp_umem_reg(struct xdp_umem *umem, struct xdp_umem_reg *mr) ...@@ -374,16 +246,8 @@ static int xdp_umem_reg(struct xdp_umem *umem, struct xdp_umem_reg *mr)
if (err) if (err)
goto out_account; goto out_account;
umem->pool = xp_create(umem, chunks, chunk_size, headroom, size,
unaligned_chunks);
if (!umem->pool) {
err = -ENOMEM;
goto out_pin;
}
return 0; return 0;
out_pin:
xdp_umem_unpin_pages(umem);
out_account: out_account:
xdp_umem_unaccount_pages(umem); xdp_umem_unaccount_pages(umem);
return err; return err;
......
...@@ -8,8 +8,8 @@ ...@@ -8,8 +8,8 @@
#include <net/xdp_sock_drv.h> #include <net/xdp_sock_drv.h>
int xdp_umem_assign_dev(struct xdp_umem *umem, struct net_device *dev, void xdp_umem_assign_dev(struct xdp_umem *umem, struct net_device *dev,
u16 queue_id, u16 flags); u16 queue_id);
void xdp_umem_clear_dev(struct xdp_umem *umem); void xdp_umem_clear_dev(struct xdp_umem *umem);
bool xdp_umem_validate_queues(struct xdp_umem *umem); bool xdp_umem_validate_queues(struct xdp_umem *umem);
void xdp_get_umem(struct xdp_umem *umem); void xdp_get_umem(struct xdp_umem *umem);
......
...@@ -105,6 +105,46 @@ bool xsk_uses_need_wakeup(struct xsk_buff_pool *pool) ...@@ -105,6 +105,46 @@ bool xsk_uses_need_wakeup(struct xsk_buff_pool *pool)
} }
EXPORT_SYMBOL(xsk_uses_need_wakeup); EXPORT_SYMBOL(xsk_uses_need_wakeup);
struct xsk_buff_pool *xsk_get_pool_from_qid(struct net_device *dev,
u16 queue_id)
{
if (queue_id < dev->real_num_rx_queues)
return dev->_rx[queue_id].pool;
if (queue_id < dev->real_num_tx_queues)
return dev->_tx[queue_id].pool;
return NULL;
}
EXPORT_SYMBOL(xsk_get_pool_from_qid);
void xsk_clear_pool_at_qid(struct net_device *dev, u16 queue_id)
{
if (queue_id < dev->real_num_rx_queues)
dev->_rx[queue_id].pool = NULL;
if (queue_id < dev->real_num_tx_queues)
dev->_tx[queue_id].pool = NULL;
}
/* The buffer pool is stored both in the _rx struct and the _tx struct as we do
* not know if the device has more tx queues than rx, or the opposite.
* This might also change during run time.
*/
int xsk_reg_pool_at_qid(struct net_device *dev, struct xsk_buff_pool *pool,
u16 queue_id)
{
if (queue_id >= max_t(unsigned int,
dev->real_num_rx_queues,
dev->real_num_tx_queues))
return -EINVAL;
if (queue_id < dev->real_num_rx_queues)
dev->_rx[queue_id].pool = pool;
if (queue_id < dev->real_num_tx_queues)
dev->_tx[queue_id].pool = pool;
return 0;
}
void xp_release(struct xdp_buff_xsk *xskb) void xp_release(struct xdp_buff_xsk *xskb)
{ {
xskb->pool->free_heads[xskb->pool->free_heads_cnt++] = xskb; xskb->pool->free_heads[xskb->pool->free_heads_cnt++] = xskb;
...@@ -281,7 +321,7 @@ bool xsk_tx_peek_desc(struct xsk_buff_pool *pool, struct xdp_desc *desc) ...@@ -281,7 +321,7 @@ bool xsk_tx_peek_desc(struct xsk_buff_pool *pool, struct xdp_desc *desc)
rcu_read_lock(); rcu_read_lock();
list_for_each_entry_rcu(xs, &umem->xsk_tx_list, list) { list_for_each_entry_rcu(xs, &umem->xsk_tx_list, list) {
if (!xskq_cons_peek_desc(xs->tx, desc, umem)) { if (!xskq_cons_peek_desc(xs->tx, desc, pool)) {
xs->tx->queue_empty_descs++; xs->tx->queue_empty_descs++;
continue; continue;
} }
...@@ -349,7 +389,7 @@ static int xsk_generic_xmit(struct sock *sk) ...@@ -349,7 +389,7 @@ static int xsk_generic_xmit(struct sock *sk)
if (xs->queue_id >= xs->dev->real_num_tx_queues) if (xs->queue_id >= xs->dev->real_num_tx_queues)
goto out; goto out;
while (xskq_cons_peek_desc(xs->tx, &desc, xs->umem)) { while (xskq_cons_peek_desc(xs->tx, &desc, xs->pool)) {
char *buffer; char *buffer;
u64 addr; u64 addr;
u32 len; u32 len;
...@@ -667,6 +707,9 @@ static int xsk_bind(struct socket *sock, struct sockaddr *addr, int addr_len) ...@@ -667,6 +707,9 @@ static int xsk_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
goto out_unlock; goto out_unlock;
} }
/* Share the buffer pool with the other socket. */
xp_get_pool(umem_xs->pool);
xs->pool = umem_xs->pool;
xdp_get_umem(umem_xs->umem); xdp_get_umem(umem_xs->umem);
WRITE_ONCE(xs->umem, umem_xs->umem); WRITE_ONCE(xs->umem, umem_xs->umem);
sockfd_put(sock); sockfd_put(sock);
...@@ -675,9 +718,21 @@ static int xsk_bind(struct socket *sock, struct sockaddr *addr, int addr_len) ...@@ -675,9 +718,21 @@ static int xsk_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
goto out_unlock; goto out_unlock;
} else { } else {
/* This xsk has its own umem. */ /* This xsk has its own umem. */
err = xdp_umem_assign_dev(xs->umem, dev, qid, flags); xdp_umem_assign_dev(xs->umem, dev, qid);
if (err) xs->pool = xp_create_and_assign_umem(xs, xs->umem);
if (!xs->pool) {
err = -ENOMEM;
xdp_umem_clear_dev(xs->umem);
goto out_unlock; goto out_unlock;
}
err = xp_assign_dev(xs->pool, dev, qid, flags);
if (err) {
xp_destroy(xs->pool);
xs->pool = NULL;
xdp_umem_clear_dev(xs->umem);
goto out_unlock;
}
} }
xs->dev = dev; xs->dev = dev;
...@@ -769,8 +824,6 @@ static int xsk_setsockopt(struct socket *sock, int level, int optname, ...@@ -769,8 +824,6 @@ static int xsk_setsockopt(struct socket *sock, int level, int optname,
return PTR_ERR(umem); return PTR_ERR(umem);
} }
xs->pool = umem->pool;
/* Make sure umem is ready before it can be seen by others */ /* Make sure umem is ready before it can be seen by others */
smp_wmb(); smp_wmb();
WRITE_ONCE(xs->umem, umem); WRITE_ONCE(xs->umem, umem);
...@@ -800,7 +853,7 @@ static int xsk_setsockopt(struct socket *sock, int level, int optname, ...@@ -800,7 +853,7 @@ static int xsk_setsockopt(struct socket *sock, int level, int optname,
&xs->umem->cq; &xs->umem->cq;
err = xsk_init_queue(entries, q, true); err = xsk_init_queue(entries, q, true);
if (optname == XDP_UMEM_FILL_RING) if (optname == XDP_UMEM_FILL_RING)
xp_set_fq(xs->umem->pool, *q); xp_set_fq(xs->pool, *q);
mutex_unlock(&xs->mutex); mutex_unlock(&xs->mutex);
return err; return err;
} }
...@@ -1028,7 +1081,8 @@ static int xsk_notifier(struct notifier_block *this, ...@@ -1028,7 +1081,8 @@ static int xsk_notifier(struct notifier_block *this,
xsk_unbind_dev(xs); xsk_unbind_dev(xs);
/* Clear device references in umem. */ /* Clear device references. */
xp_clear_dev(xs->pool);
xdp_umem_clear_dev(xs->umem); xdp_umem_clear_dev(xs->umem);
} }
mutex_unlock(&xs->mutex); mutex_unlock(&xs->mutex);
...@@ -1073,7 +1127,7 @@ static void xsk_destruct(struct sock *sk) ...@@ -1073,7 +1127,7 @@ static void xsk_destruct(struct sock *sk)
if (!sock_flag(sk, SOCK_DEAD)) if (!sock_flag(sk, SOCK_DEAD))
return; return;
xdp_put_umem(xs->umem); xp_put_pool(xs->pool);
sk_refcnt_debug_dec(sk); sk_refcnt_debug_dec(sk);
} }
...@@ -1081,8 +1135,8 @@ static void xsk_destruct(struct sock *sk) ...@@ -1081,8 +1135,8 @@ static void xsk_destruct(struct sock *sk)
static int xsk_create(struct net *net, struct socket *sock, int protocol, static int xsk_create(struct net *net, struct socket *sock, int protocol,
int kern) int kern)
{ {
struct sock *sk;
struct xdp_sock *xs; struct xdp_sock *xs;
struct sock *sk;
if (!ns_capable(net->user_ns, CAP_NET_RAW)) if (!ns_capable(net->user_ns, CAP_NET_RAW))
return -EPERM; return -EPERM;
......
...@@ -51,5 +51,8 @@ void xsk_map_try_sock_delete(struct xsk_map *map, struct xdp_sock *xs, ...@@ -51,5 +51,8 @@ void xsk_map_try_sock_delete(struct xsk_map *map, struct xdp_sock *xs,
struct xdp_sock **map_entry); struct xdp_sock **map_entry);
int xsk_map_inc(struct xsk_map *map); int xsk_map_inc(struct xsk_map *map);
void xsk_map_put(struct xsk_map *map); void xsk_map_put(struct xsk_map *map);
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);
#endif /* XSK_H_ */ #endif /* XSK_H_ */
...@@ -2,8 +2,14 @@ ...@@ -2,8 +2,14 @@
#include <net/xsk_buff_pool.h> #include <net/xsk_buff_pool.h>
#include <net/xdp_sock.h> #include <net/xdp_sock.h>
#include <net/xdp_sock_drv.h>
#include <linux/dma-direct.h>
#include <linux/dma-noncoherent.h>
#include <linux/swiotlb.h>
#include "xsk_queue.h" #include "xsk_queue.h"
#include "xdp_umem.h"
#include "xsk.h"
static void xp_addr_unmap(struct xsk_buff_pool *pool) static void xp_addr_unmap(struct xsk_buff_pool *pool)
{ {
...@@ -29,38 +35,40 @@ void xp_destroy(struct xsk_buff_pool *pool) ...@@ -29,38 +35,40 @@ void xp_destroy(struct xsk_buff_pool *pool)
kvfree(pool); kvfree(pool);
} }
struct xsk_buff_pool *xp_create(struct xdp_umem *umem, u32 chunks, struct xsk_buff_pool *xp_create_and_assign_umem(struct xdp_sock *xs,
u32 chunk_size, u32 headroom, u64 size, struct xdp_umem *umem)
bool unaligned)
{ {
struct xsk_buff_pool *pool; struct xsk_buff_pool *pool;
struct xdp_buff_xsk *xskb; struct xdp_buff_xsk *xskb;
int err; int err;
u32 i; u32 i;
pool = kvzalloc(struct_size(pool, free_heads, chunks), GFP_KERNEL); pool = kvzalloc(struct_size(pool, free_heads, umem->chunks),
GFP_KERNEL);
if (!pool) if (!pool)
goto out; goto out;
pool->heads = kvcalloc(chunks, sizeof(*pool->heads), GFP_KERNEL); pool->heads = kvcalloc(umem->chunks, sizeof(*pool->heads), GFP_KERNEL);
if (!pool->heads) if (!pool->heads)
goto out; goto out;
pool->chunk_mask = ~((u64)chunk_size - 1); pool->chunk_mask = ~((u64)umem->chunk_size - 1);
pool->addrs_cnt = size; pool->addrs_cnt = umem->size;
pool->heads_cnt = chunks; pool->heads_cnt = umem->chunks;
pool->free_heads_cnt = chunks; pool->free_heads_cnt = umem->chunks;
pool->headroom = headroom; pool->headroom = umem->headroom;
pool->chunk_size = chunk_size; pool->chunk_size = umem->chunk_size;
pool->unaligned = unaligned; pool->unaligned = umem->flags & XDP_UMEM_UNALIGNED_CHUNK_FLAG;
pool->frame_len = chunk_size - headroom - XDP_PACKET_HEADROOM; pool->frame_len = umem->chunk_size - umem->headroom -
XDP_PACKET_HEADROOM;
pool->umem = umem; pool->umem = umem;
INIT_LIST_HEAD(&pool->free_list); INIT_LIST_HEAD(&pool->free_list);
refcount_set(&pool->users, 1);
for (i = 0; i < pool->free_heads_cnt; i++) { for (i = 0; i < pool->free_heads_cnt; i++) {
xskb = &pool->heads[i]; xskb = &pool->heads[i];
xskb->pool = pool; xskb->pool = pool;
xskb->xdp.frame_sz = chunk_size - headroom; xskb->xdp.frame_sz = umem->chunk_size - umem->headroom;
pool->free_heads[i] = xskb; pool->free_heads[i] = xskb;
} }
...@@ -87,6 +95,120 @@ void xp_set_rxq_info(struct xsk_buff_pool *pool, struct xdp_rxq_info *rxq) ...@@ -87,6 +95,120 @@ void xp_set_rxq_info(struct xsk_buff_pool *pool, struct xdp_rxq_info *rxq)
} }
EXPORT_SYMBOL(xp_set_rxq_info); EXPORT_SYMBOL(xp_set_rxq_info);
int xp_assign_dev(struct xsk_buff_pool *pool, struct net_device *dev,
u16 queue_id, u16 flags)
{
struct xdp_umem *umem = pool->umem;
bool force_zc, force_copy;
struct netdev_bpf bpf;
int err = 0;
ASSERT_RTNL();
force_zc = flags & XDP_ZEROCOPY;
force_copy = flags & XDP_COPY;
if (force_zc && force_copy)
return -EINVAL;
if (xsk_get_pool_from_qid(dev, queue_id))
return -EBUSY;
err = xsk_reg_pool_at_qid(dev, pool, queue_id);
if (err)
return err;
if (flags & XDP_USE_NEED_WAKEUP) {
umem->flags |= XDP_UMEM_USES_NEED_WAKEUP;
/* Tx needs to be explicitly woken up the first time.
* Also for supporting drivers that do not implement this
* feature. They will always have to call sendto().
*/
umem->need_wakeup = XDP_WAKEUP_TX;
}
if (force_copy)
/* For copy-mode, we are done. */
return 0;
if (!dev->netdev_ops->ndo_bpf || !dev->netdev_ops->ndo_xsk_wakeup) {
err = -EOPNOTSUPP;
goto err_unreg_pool;
}
bpf.command = XDP_SETUP_XSK_POOL;
bpf.xsk.pool = pool;
bpf.xsk.queue_id = queue_id;
err = dev->netdev_ops->ndo_bpf(dev, &bpf);
if (err)
goto err_unreg_pool;
umem->zc = true;
return 0;
err_unreg_pool:
if (!force_zc)
err = 0; /* fallback to copy mode */
if (err)
xsk_clear_pool_at_qid(dev, queue_id);
return err;
}
void xp_clear_dev(struct xsk_buff_pool *pool)
{
struct xdp_umem *umem = pool->umem;
struct netdev_bpf bpf;
int err;
ASSERT_RTNL();
if (!umem->dev)
return;
if (umem->zc) {
bpf.command = XDP_SETUP_XSK_POOL;
bpf.xsk.pool = NULL;
bpf.xsk.queue_id = umem->queue_id;
err = umem->dev->netdev_ops->ndo_bpf(umem->dev, &bpf);
if (err)
WARN(1, "failed to disable umem!\n");
}
xsk_clear_pool_at_qid(umem->dev, umem->queue_id);
}
static void xp_release_deferred(struct work_struct *work)
{
struct xsk_buff_pool *pool = container_of(work, struct xsk_buff_pool,
work);
rtnl_lock();
xp_clear_dev(pool);
rtnl_unlock();
xdp_put_umem(pool->umem);
xp_destroy(pool);
}
void xp_get_pool(struct xsk_buff_pool *pool)
{
refcount_inc(&pool->users);
}
void xp_put_pool(struct xsk_buff_pool *pool)
{
if (!pool)
return;
if (refcount_dec_and_test(&pool->users)) {
INIT_WORK(&pool->work, xp_release_deferred);
schedule_work(&pool->work);
}
}
void xp_dma_unmap(struct xsk_buff_pool *pool, unsigned long attrs) void xp_dma_unmap(struct xsk_buff_pool *pool, unsigned long attrs)
{ {
dma_addr_t *dma; dma_addr_t *dma;
......
...@@ -166,9 +166,9 @@ static inline bool xp_validate_desc(struct xsk_buff_pool *pool, ...@@ -166,9 +166,9 @@ static inline bool xp_validate_desc(struct xsk_buff_pool *pool,
static inline bool xskq_cons_is_valid_desc(struct xsk_queue *q, static inline bool xskq_cons_is_valid_desc(struct xsk_queue *q,
struct xdp_desc *d, struct xdp_desc *d,
struct xdp_umem *umem) struct xsk_buff_pool *pool)
{ {
if (!xp_validate_desc(umem->pool, d)) { if (!xp_validate_desc(pool, d)) {
q->invalid_descs++; q->invalid_descs++;
return false; return false;
} }
...@@ -177,14 +177,14 @@ static inline bool xskq_cons_is_valid_desc(struct xsk_queue *q, ...@@ -177,14 +177,14 @@ static inline bool xskq_cons_is_valid_desc(struct xsk_queue *q,
static inline bool xskq_cons_read_desc(struct xsk_queue *q, static inline bool xskq_cons_read_desc(struct xsk_queue *q,
struct xdp_desc *desc, struct xdp_desc *desc,
struct xdp_umem *umem) struct xsk_buff_pool *pool)
{ {
while (q->cached_cons != q->cached_prod) { while (q->cached_cons != q->cached_prod) {
struct xdp_rxtx_ring *ring = (struct xdp_rxtx_ring *)q->ring; struct xdp_rxtx_ring *ring = (struct xdp_rxtx_ring *)q->ring;
u32 idx = q->cached_cons & q->ring_mask; u32 idx = q->cached_cons & q->ring_mask;
*desc = ring->desc[idx]; *desc = ring->desc[idx];
if (xskq_cons_is_valid_desc(q, desc, umem)) if (xskq_cons_is_valid_desc(q, desc, pool))
return true; return true;
q->cached_cons++; q->cached_cons++;
...@@ -236,11 +236,11 @@ static inline bool xskq_cons_peek_addr_unchecked(struct xsk_queue *q, u64 *addr) ...@@ -236,11 +236,11 @@ static inline bool xskq_cons_peek_addr_unchecked(struct xsk_queue *q, u64 *addr)
static inline bool xskq_cons_peek_desc(struct xsk_queue *q, static inline bool xskq_cons_peek_desc(struct xsk_queue *q,
struct xdp_desc *desc, struct xdp_desc *desc,
struct xdp_umem *umem) struct xsk_buff_pool *pool)
{ {
if (q->cached_prod == q->cached_cons) if (q->cached_prod == q->cached_cons)
xskq_cons_get_entries(q); xskq_cons_get_entries(q);
return xskq_cons_read_desc(q, desc, umem); return xskq_cons_read_desc(q, desc, pool);
} }
static inline void xskq_cons_release(struct xsk_queue *q) static inline void xskq_cons_release(struct xsk_queue *q)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment