xref: /linux/net/xdp/xsk_buff_pool.c (revision fece8420e76fe53ee84f0439f18d026b4c7641da)
1 // SPDX-License-Identifier: GPL-2.0
2 
3 #include <linux/netdevice.h>
4 #include <net/netdev_lock.h>
5 #include <net/xsk_buff_pool.h>
6 #include <net/xdp_sock.h>
7 #include <net/xdp_sock_drv.h>
8 
9 #include "xsk_queue.h"
10 #include "xdp_umem.h"
11 #include "xsk.h"
12 
13 #define ETH_PAD_LEN (ETH_HLEN + 2 * VLAN_HLEN  + ETH_FCS_LEN)
14 
15 void xp_add_xsk(struct xsk_buff_pool *pool, struct xdp_sock *xs)
16 {
17 	if (!xs->tx)
18 		return;
19 
20 	spin_lock(&pool->xsk_tx_list_lock);
21 	list_add_rcu(&xs->tx_list, &pool->xsk_tx_list);
22 	spin_unlock(&pool->xsk_tx_list_lock);
23 }
24 
25 void xp_del_xsk(struct xsk_buff_pool *pool, struct xdp_sock *xs)
26 {
27 	if (!xs->tx)
28 		return;
29 
30 	spin_lock(&pool->xsk_tx_list_lock);
31 	list_del_rcu(&xs->tx_list);
32 	spin_unlock(&pool->xsk_tx_list_lock);
33 }
34 
35 void xp_destroy(struct xsk_buff_pool *pool)
36 {
37 	if (!pool)
38 		return;
39 
40 	kvfree(pool->tx_descs);
41 	kvfree(pool->heads);
42 	kvfree(pool);
43 }
44 
45 int xp_alloc_tx_descs(struct xsk_buff_pool *pool, struct xdp_sock *xs,
46 		      u32 max_segs)
47 {
48 	u32 nentries = max(xs->tx->nentries, max_segs);
49 
50 	pool->tx_descs = kvzalloc_objs(*pool->tx_descs, nentries);
51 	if (!pool->tx_descs)
52 		return -ENOMEM;
53 
54 	pool->tx_descs_nentries = nentries;
55 	return 0;
56 }
57 
58 struct xsk_buff_pool *xp_create_and_assign_umem(struct xdp_sock *xs,
59 						struct xdp_umem *umem,
60 						u32 max_segs)
61 {
62 	bool unaligned = umem->flags & XDP_UMEM_UNALIGNED_CHUNK_FLAG;
63 	struct xsk_buff_pool *pool;
64 	struct xdp_buff_xsk *xskb;
65 	u32 i, entries;
66 
67 	entries = unaligned ? umem->chunks : 0;
68 	pool = kvzalloc_flex(*pool, free_heads, entries);
69 	if (!pool)
70 		goto out;
71 
72 	pool->heads = kvzalloc_objs(*pool->heads, umem->chunks);
73 	if (!pool->heads)
74 		goto out;
75 
76 	if (xs->tx)
77 		if (xp_alloc_tx_descs(pool, xs, max_segs))
78 			goto out;
79 
80 	pool->chunk_mask = ~((u64)umem->chunk_size - 1);
81 	pool->addrs_cnt = umem->size;
82 	pool->heads_cnt = umem->chunks;
83 	pool->free_heads_cnt = umem->chunks;
84 	pool->headroom = umem->headroom;
85 	pool->chunk_size = umem->chunk_size;
86 	pool->chunk_shift = ffs(umem->chunk_size) - 1;
87 	pool->unaligned = unaligned;
88 	pool->frame_len = umem->chunk_size - umem->headroom -
89 		XDP_PACKET_HEADROOM;
90 	pool->umem = umem;
91 	pool->addrs = umem->addrs;
92 	pool->tx_metadata_len = umem->tx_metadata_len;
93 	pool->tx_sw_csum = umem->flags & XDP_UMEM_TX_SW_CSUM;
94 	spin_lock_init(&pool->rx_lock);
95 	INIT_LIST_HEAD(&pool->free_list);
96 	INIT_LIST_HEAD(&pool->xskb_list);
97 	INIT_LIST_HEAD(&pool->xsk_tx_list);
98 	spin_lock_init(&pool->xsk_tx_list_lock);
99 	spin_lock_init(&pool->cq_prod_lock);
100 	spin_lock_init(&xs->cq_tmp->cq_cached_prod_lock);
101 	refcount_set(&pool->users, 1);
102 
103 	pool->fq = xs->fq_tmp;
104 	pool->cq = xs->cq_tmp;
105 
106 	for (i = 0; i < pool->free_heads_cnt; i++) {
107 		xskb = &pool->heads[i];
108 		xskb->pool = pool;
109 		xskb->xdp.frame_sz = umem->chunk_size - umem->headroom;
110 		INIT_LIST_HEAD(&xskb->list_node);
111 		if (pool->unaligned)
112 			pool->free_heads[i] = xskb;
113 		else
114 			xp_init_xskb_addr(xskb, pool, (u64)i * pool->chunk_size);
115 	}
116 
117 	return pool;
118 
119 out:
120 	xp_destroy(pool);
121 	return NULL;
122 }
123 
124 void xp_set_rxq_info(struct xsk_buff_pool *pool, struct xdp_rxq_info *rxq)
125 {
126 	u32 i;
127 
128 	for (i = 0; i < pool->heads_cnt; i++)
129 		pool->heads[i].xdp.rxq = rxq;
130 }
131 EXPORT_SYMBOL(xp_set_rxq_info);
132 
133 void xp_fill_cb(struct xsk_buff_pool *pool, struct xsk_cb_desc *desc)
134 {
135 	u32 i;
136 
137 	for (i = 0; i < pool->heads_cnt; i++) {
138 		struct xdp_buff_xsk *xskb = &pool->heads[i];
139 
140 		memcpy(xskb->cb + desc->off, desc->src, desc->bytes);
141 	}
142 }
143 EXPORT_SYMBOL(xp_fill_cb);
144 
145 static void xp_disable_drv_zc(struct xsk_buff_pool *pool)
146 {
147 	struct netdev_bpf bpf;
148 	int err;
149 
150 	ASSERT_RTNL();
151 
152 	if (pool->umem->zc) {
153 		bpf.command = XDP_SETUP_XSK_POOL;
154 		bpf.xsk.pool = NULL;
155 		bpf.xsk.queue_id = pool->queue_id;
156 
157 		err = pool->netdev->netdev_ops->ndo_bpf(pool->netdev, &bpf);
158 
159 		if (err)
160 			WARN(1, "Failed to disable zero-copy!\n");
161 	}
162 }
163 
164 int xp_assign_dev(struct xsk_buff_pool *pool,
165 		  struct net_device *netdev, u16 queue_id, u16 flags)
166 {
167 	u32 needed = netdev->mtu + ETH_PAD_LEN;
168 	u32 segs = netdev->xdp_zc_max_segs;
169 	bool mbuf = flags & XDP_USE_SG;
170 	bool force_zc, force_copy;
171 	struct netdev_bpf bpf;
172 	u32 frame_size;
173 	int err = 0;
174 
175 	netdev_assert_locked_ops_compat(netdev);
176 
177 	force_zc = flags & XDP_ZEROCOPY;
178 	force_copy = flags & XDP_COPY;
179 
180 	if (force_zc && force_copy)
181 		return -EINVAL;
182 
183 	if (pool->tx_sw_csum && (netdev->priv_flags & IFF_TX_SKB_NO_LINEAR))
184 		return -EOPNOTSUPP;
185 
186 	if (xsk_get_pool_from_qid(netdev, queue_id))
187 		return -EBUSY;
188 
189 	pool->netdev = netdev;
190 	pool->queue_id = queue_id;
191 	err = xsk_reg_pool_at_qid(netdev, pool, queue_id);
192 	if (err)
193 		return err;
194 
195 	if (mbuf)
196 		pool->umem->flags |= XDP_UMEM_SG_FLAG;
197 
198 	if (flags & XDP_USE_NEED_WAKEUP)
199 		pool->uses_need_wakeup = true;
200 	/* Tx needs to be explicitly woken up the first time.  Also
201 	 * for supporting drivers that do not implement this
202 	 * feature. They will always have to call sendto() or poll().
203 	 */
204 	pool->cached_need_wakeup = XDP_WAKEUP_TX;
205 
206 	dev_hold(netdev);
207 	/*
208 	 * Socket removal precedes the final pool put. Keep the pool visible to
209 	 * NETDEV_UNREGISTER even while release work is waiting for process thaw.
210 	 */
211 	hlist_add_head(&pool->dev_node, &netdev->xsk_pools);
212 
213 	if (force_copy)
214 		/* For copy-mode, we are done. */
215 		return 0;
216 
217 	if ((netdev->xdp_features & NETDEV_XDP_ACT_XSK) != NETDEV_XDP_ACT_XSK) {
218 		err = -EOPNOTSUPP;
219 		goto err_unreg_pool;
220 	}
221 
222 	if (mbuf) {
223 		if (segs == 1) {
224 			err = -EOPNOTSUPP;
225 			goto err_unreg_pool;
226 		}
227 	} else {
228 		segs = 1;
229 	}
230 
231 	/* open-code xsk_pool_get_rx_frame_size() as pool->dev is not
232 	 * set yet at this point; we are before getting down to driver
233 	 */
234 	frame_size = __xsk_pool_get_rx_frame_size(pool) -
235 		     xsk_pool_get_tailroom(mbuf);
236 	frame_size = ALIGN_DOWN(frame_size, 128);
237 
238 	if (needed > frame_size * segs) {
239 		err = -EINVAL;
240 		goto err_unreg_pool;
241 	}
242 
243 	if (dev_get_min_mp_channel_count(netdev)) {
244 		err = -EBUSY;
245 		goto err_unreg_pool;
246 	}
247 
248 	bpf.command = XDP_SETUP_XSK_POOL;
249 	bpf.xsk.pool = pool;
250 	bpf.xsk.queue_id = queue_id;
251 
252 	err = netdev->netdev_ops->ndo_bpf(netdev, &bpf);
253 	if (err)
254 		goto err_unreg_pool;
255 
256 	if (!pool->dma_pages) {
257 		WARN(1, "Driver did not DMA map zero-copy buffers");
258 		err = -EINVAL;
259 		goto err_unreg_xsk;
260 	}
261 	pool->umem->zc = true;
262 	pool->xdp_zc_max_segs = netdev->xdp_zc_max_segs;
263 	return 0;
264 
265 err_unreg_xsk:
266 	xp_disable_drv_zc(pool);
267 err_unreg_pool:
268 	if (!force_zc)
269 		err = 0; /* fallback to copy mode */
270 	if (err) {
271 		xsk_clear_pool_at_qid(netdev, queue_id);
272 		hlist_del(&pool->dev_node);
273 		pool->netdev = NULL;
274 		dev_put(netdev);
275 	}
276 	return err;
277 }
278 
279 int xp_assign_dev_shared(struct xsk_buff_pool *pool, struct xdp_sock *umem_xs,
280 			 struct net_device *dev, u16 queue_id)
281 {
282 	u16 flags;
283 	struct xdp_umem *umem = umem_xs->umem;
284 
285 	flags = umem->zc ? XDP_ZEROCOPY : XDP_COPY;
286 
287 	if (umem->flags & XDP_UMEM_SG_FLAG)
288 		flags |= XDP_USE_SG;
289 
290 	if (umem_xs->pool->uses_need_wakeup)
291 		flags |= XDP_USE_NEED_WAKEUP;
292 
293 	return xp_assign_dev(pool, dev, queue_id, flags);
294 }
295 
296 static void __xp_clear_dev(struct xsk_buff_pool *pool)
297 {
298 	struct net_device *netdev = pool->netdev;
299 
300 	netdev_assert_locked_ops_compat(netdev);
301 	xp_disable_drv_zc(pool);
302 	xsk_clear_pool_at_qid(netdev, pool->queue_id);
303 	hlist_del(&pool->dev_node);
304 	pool->netdev = NULL;
305 	dev_put(netdev);
306 }
307 
308 void xp_clear_dev(struct xsk_buff_pool *pool)
309 {
310 	struct net_device *netdev = pool->netdev;
311 
312 	if (!netdev)
313 		return;
314 
315 	netdev_lock_ops(netdev);
316 	__xp_clear_dev(pool);
317 	netdev_unlock_ops(netdev);
318 }
319 
320 void xp_clear_dev_all(struct net_device *dev)
321 {
322 	struct xsk_buff_pool *pool;
323 	struct hlist_node *next;
324 
325 	netdev_lock_ops(dev);
326 	hlist_for_each_entry_safe(pool, next, &dev->xsk_pools, dev_node)
327 		__xp_clear_dev(pool);
328 	netdev_unlock_ops(dev);
329 }
330 
331 static void xp_release_deferred(struct work_struct *work)
332 {
333 	struct xsk_buff_pool *pool = container_of(work, struct xsk_buff_pool,
334 						  work);
335 
336 	rtnl_lock();
337 	xp_clear_dev(pool);
338 	rtnl_unlock();
339 
340 	if (pool->fq) {
341 		xskq_destroy(pool->fq);
342 		pool->fq = NULL;
343 	}
344 
345 	if (pool->cq) {
346 		xskq_destroy(pool->cq);
347 		pool->cq = NULL;
348 	}
349 
350 	xdp_put_umem(pool->umem, false);
351 	xp_destroy(pool);
352 }
353 
354 void xp_get_pool(struct xsk_buff_pool *pool)
355 {
356 	refcount_inc(&pool->users);
357 }
358 
359 bool xp_put_pool(struct xsk_buff_pool *pool)
360 {
361 	if (!pool)
362 		return false;
363 
364 	if (refcount_dec_and_test(&pool->users)) {
365 		INIT_WORK(&pool->work, xp_release_deferred);
366 		/*
367 		 * Teardown calls ndo_bpf(), which may need powered hardware.
368 		 * RTNL alone does not exclude the device's system PM callbacks.
369 		 */
370 		queue_work(system_freezable_wq, &pool->work);
371 		return true;
372 	}
373 
374 	return false;
375 }
376 
377 static struct xsk_dma_map *xp_find_dma_map(struct xsk_buff_pool *pool)
378 {
379 	struct xsk_dma_map *dma_map;
380 
381 	list_for_each_entry(dma_map, &pool->umem->xsk_dma_list, list) {
382 		if (dma_map->netdev == pool->netdev)
383 			return dma_map;
384 	}
385 
386 	return NULL;
387 }
388 
389 static struct xsk_dma_map *xp_create_dma_map(struct device *dev, struct net_device *netdev,
390 					     u32 nr_pages, struct xdp_umem *umem)
391 {
392 	struct xsk_dma_map *dma_map;
393 
394 	dma_map = kzalloc_obj(*dma_map);
395 	if (!dma_map)
396 		return NULL;
397 
398 	dma_map->dma_pages = kvzalloc_objs(*dma_map->dma_pages, nr_pages);
399 	if (!dma_map->dma_pages) {
400 		kfree(dma_map);
401 		return NULL;
402 	}
403 
404 	dma_map->netdev = netdev;
405 	dma_map->dev = dev;
406 	dma_map->dma_pages_cnt = nr_pages;
407 	refcount_set(&dma_map->users, 1);
408 	list_add(&dma_map->list, &umem->xsk_dma_list);
409 	return dma_map;
410 }
411 
412 static void xp_destroy_dma_map(struct xsk_dma_map *dma_map)
413 {
414 	list_del(&dma_map->list);
415 	kvfree(dma_map->dma_pages);
416 	kfree(dma_map);
417 }
418 
419 static void __xp_dma_unmap(struct xsk_dma_map *dma_map, unsigned long attrs)
420 {
421 	dma_addr_t *dma;
422 	u32 i;
423 
424 	for (i = 0; i < dma_map->dma_pages_cnt; i++) {
425 		dma = &dma_map->dma_pages[i];
426 		if (*dma) {
427 			*dma &= ~XSK_NEXT_PG_CONTIG_MASK;
428 			dma_unmap_page_attrs(dma_map->dev, *dma, PAGE_SIZE,
429 					     DMA_BIDIRECTIONAL, attrs);
430 			*dma = 0;
431 		}
432 	}
433 
434 	xp_destroy_dma_map(dma_map);
435 }
436 
437 void xp_dma_unmap(struct xsk_buff_pool *pool, unsigned long attrs)
438 {
439 	struct xsk_dma_map *dma_map;
440 
441 	if (!pool->dma_pages)
442 		return;
443 
444 	dma_map = xp_find_dma_map(pool);
445 	if (!dma_map) {
446 		WARN(1, "Could not find dma_map for device");
447 		return;
448 	}
449 
450 	if (refcount_dec_and_test(&dma_map->users))
451 		__xp_dma_unmap(dma_map, attrs);
452 
453 	kvfree(pool->dma_pages);
454 	pool->dma_pages = NULL;
455 	pool->dma_pages_cnt = 0;
456 	pool->dev = NULL;
457 }
458 EXPORT_SYMBOL(xp_dma_unmap);
459 
460 static void xp_check_dma_contiguity(struct xsk_dma_map *dma_map)
461 {
462 	u32 i;
463 
464 	for (i = 0; i < dma_map->dma_pages_cnt - 1; i++) {
465 		if (dma_map->dma_pages[i] + PAGE_SIZE == dma_map->dma_pages[i + 1])
466 			dma_map->dma_pages[i] |= XSK_NEXT_PG_CONTIG_MASK;
467 		else
468 			dma_map->dma_pages[i] &= ~XSK_NEXT_PG_CONTIG_MASK;
469 	}
470 }
471 
472 static int xp_init_dma_info(struct xsk_buff_pool *pool, struct xsk_dma_map *dma_map)
473 {
474 	if (!pool->unaligned) {
475 		u32 i;
476 
477 		for (i = 0; i < pool->heads_cnt; i++) {
478 			struct xdp_buff_xsk *xskb = &pool->heads[i];
479 			u64 orig_addr;
480 
481 			orig_addr = xskb->xdp.data_hard_start - pool->addrs - pool->headroom;
482 			xp_init_xskb_dma(xskb, pool, dma_map->dma_pages, orig_addr);
483 		}
484 	}
485 
486 	pool->dma_pages = kvzalloc_objs(*pool->dma_pages,
487 					dma_map->dma_pages_cnt);
488 	if (!pool->dma_pages)
489 		return -ENOMEM;
490 
491 	pool->dev = dma_map->dev;
492 	pool->dma_pages_cnt = dma_map->dma_pages_cnt;
493 	memcpy(pool->dma_pages, dma_map->dma_pages,
494 	       pool->dma_pages_cnt * sizeof(*pool->dma_pages));
495 
496 	return 0;
497 }
498 
499 int xp_dma_map(struct xsk_buff_pool *pool, struct device *dev,
500 	       unsigned long attrs, struct page **pages, u32 nr_pages)
501 {
502 	struct xsk_dma_map *dma_map;
503 	dma_addr_t dma;
504 	int err;
505 	u32 i;
506 
507 	dma_map = xp_find_dma_map(pool);
508 	if (dma_map) {
509 		err = xp_init_dma_info(pool, dma_map);
510 		if (err)
511 			return err;
512 
513 		refcount_inc(&dma_map->users);
514 		return 0;
515 	}
516 
517 	dma_map = xp_create_dma_map(dev, pool->netdev, nr_pages, pool->umem);
518 	if (!dma_map)
519 		return -ENOMEM;
520 
521 	for (i = 0; i < dma_map->dma_pages_cnt; i++) {
522 		dma = dma_map_page_attrs(dev, pages[i], 0, PAGE_SIZE,
523 					 DMA_BIDIRECTIONAL, attrs);
524 		if (dma_mapping_error(dev, dma)) {
525 			__xp_dma_unmap(dma_map, attrs);
526 			return -ENOMEM;
527 		}
528 		dma_map->dma_pages[i] = dma;
529 	}
530 
531 	if (pool->unaligned)
532 		xp_check_dma_contiguity(dma_map);
533 
534 	err = xp_init_dma_info(pool, dma_map);
535 	if (err) {
536 		__xp_dma_unmap(dma_map, attrs);
537 		return err;
538 	}
539 
540 	return 0;
541 }
542 EXPORT_SYMBOL(xp_dma_map);
543 
544 static bool xp_addr_crosses_non_contig_pg(struct xsk_buff_pool *pool,
545 					  u64 addr)
546 {
547 	return xp_desc_crosses_non_contig_pg(pool, addr, pool->chunk_size);
548 }
549 
550 static bool xp_check_unaligned(struct xsk_buff_pool *pool, u64 *addr)
551 {
552 	*addr = xp_unaligned_extract_addr(*addr);
553 	if (*addr >= pool->addrs_cnt ||
554 	    *addr + pool->chunk_size > pool->addrs_cnt ||
555 	    xp_addr_crosses_non_contig_pg(pool, *addr))
556 		return false;
557 	return true;
558 }
559 
560 static bool xp_check_aligned(struct xsk_buff_pool *pool, u64 *addr)
561 {
562 	*addr = xp_aligned_extract_addr(pool, *addr);
563 	return *addr < pool->addrs_cnt;
564 }
565 
566 static struct xdp_buff_xsk *xp_get_xskb(struct xsk_buff_pool *pool, u64 addr)
567 {
568 	struct xdp_buff_xsk *xskb;
569 
570 	if (pool->unaligned) {
571 		xskb = pool->free_heads[--pool->free_heads_cnt];
572 		xp_init_xskb_addr(xskb, pool, addr);
573 		if (pool->dma_pages)
574 			xp_init_xskb_dma(xskb, pool, pool->dma_pages, addr);
575 	} else {
576 		xskb = &pool->heads[xp_aligned_extract_idx(pool, addr)];
577 	}
578 
579 	return xskb;
580 }
581 
582 static struct xdp_buff_xsk *__xp_alloc(struct xsk_buff_pool *pool)
583 {
584 	struct xdp_buff_xsk *xskb;
585 	u64 addr;
586 	bool ok;
587 
588 	if (pool->free_heads_cnt == 0)
589 		return NULL;
590 
591 	for (;;) {
592 		if (!xskq_cons_peek_addr_unchecked(pool->fq, &addr)) {
593 			pool->fq->queue_empty_descs++;
594 			return NULL;
595 		}
596 
597 		ok = pool->unaligned ? xp_check_unaligned(pool, &addr) :
598 		     xp_check_aligned(pool, &addr);
599 		if (!ok) {
600 			pool->fq->invalid_descs++;
601 			xskq_cons_release(pool->fq);
602 			continue;
603 		}
604 		break;
605 	}
606 
607 	xskb = xp_get_xskb(pool, addr);
608 
609 	xskq_cons_release(pool->fq);
610 	return xskb;
611 }
612 
613 struct xdp_buff *xp_alloc(struct xsk_buff_pool *pool)
614 {
615 	struct xdp_buff_xsk *xskb;
616 
617 	if (!pool->free_list_cnt) {
618 		xskb = __xp_alloc(pool);
619 		if (!xskb)
620 			return NULL;
621 	} else {
622 		pool->free_list_cnt--;
623 		xskb = list_first_entry(&pool->free_list, struct xdp_buff_xsk,
624 					list_node);
625 		list_del_init(&xskb->list_node);
626 	}
627 
628 	xskb->xdp.data = xskb->xdp.data_hard_start + XDP_PACKET_HEADROOM;
629 	xskb->xdp.data_meta = xskb->xdp.data;
630 	xskb->xdp.flags = 0;
631 
632 	if (pool->dev)
633 		xp_dma_sync_for_device(pool, xskb->dma, pool->frame_len);
634 
635 	return &xskb->xdp;
636 }
637 EXPORT_SYMBOL(xp_alloc);
638 
639 static u32 xp_alloc_new_from_fq(struct xsk_buff_pool *pool, struct xdp_buff **xdp, u32 max)
640 {
641 	u32 i, cached_cons, nb_entries;
642 
643 	if (max > pool->free_heads_cnt)
644 		max = pool->free_heads_cnt;
645 	max = xskq_cons_nb_entries(pool->fq, max);
646 
647 	cached_cons = pool->fq->cached_cons;
648 	nb_entries = max;
649 	i = max;
650 	while (i--) {
651 		struct xdp_buff_xsk *xskb;
652 		u64 addr;
653 		bool ok;
654 
655 		__xskq_cons_read_addr_unchecked(pool->fq, cached_cons++, &addr);
656 
657 		ok = pool->unaligned ? xp_check_unaligned(pool, &addr) :
658 			xp_check_aligned(pool, &addr);
659 		if (unlikely(!ok)) {
660 			pool->fq->invalid_descs++;
661 			nb_entries--;
662 			continue;
663 		}
664 
665 		xskb = xp_get_xskb(pool, addr);
666 
667 		*xdp = &xskb->xdp;
668 		xdp++;
669 	}
670 
671 	xskq_cons_release_n(pool->fq, max);
672 	return nb_entries;
673 }
674 
675 static u32 xp_alloc_reused(struct xsk_buff_pool *pool, struct xdp_buff **xdp, u32 nb_entries)
676 {
677 	struct xdp_buff_xsk *xskb;
678 	u32 i;
679 
680 	nb_entries = min_t(u32, nb_entries, pool->free_list_cnt);
681 
682 	i = nb_entries;
683 	while (i--) {
684 		xskb = list_first_entry(&pool->free_list, struct xdp_buff_xsk, list_node);
685 		list_del_init(&xskb->list_node);
686 
687 		*xdp = &xskb->xdp;
688 		xdp++;
689 	}
690 	pool->free_list_cnt -= nb_entries;
691 
692 	return nb_entries;
693 }
694 
695 static u32 xp_alloc_slow(struct xsk_buff_pool *pool, struct xdp_buff **xdp,
696 			 u32 max)
697 {
698 	int i;
699 
700 	for (i = 0; i < max; i++) {
701 		struct xdp_buff *buff;
702 
703 		buff = xp_alloc(pool);
704 		if (unlikely(!buff))
705 			return i;
706 		*xdp = buff;
707 		xdp++;
708 	}
709 
710 	return max;
711 }
712 
713 u32 xp_alloc_batch(struct xsk_buff_pool *pool, struct xdp_buff **xdp, u32 max)
714 {
715 	u32 nb_entries1 = 0, nb_entries2;
716 
717 	if (unlikely(pool->dev && dma_dev_need_sync(pool->dev)))
718 		return xp_alloc_slow(pool, xdp, max);
719 
720 	if (unlikely(pool->free_list_cnt)) {
721 		nb_entries1 = xp_alloc_reused(pool, xdp, max);
722 		if (nb_entries1 == max)
723 			return nb_entries1;
724 
725 		max -= nb_entries1;
726 		xdp += nb_entries1;
727 	}
728 
729 	nb_entries2 = xp_alloc_new_from_fq(pool, xdp, max);
730 	if (!nb_entries2)
731 		pool->fq->queue_empty_descs++;
732 
733 	return nb_entries1 + nb_entries2;
734 }
735 EXPORT_SYMBOL(xp_alloc_batch);
736 
737 bool xp_can_alloc(struct xsk_buff_pool *pool, u32 count)
738 {
739 	u32 req_count, avail_count;
740 
741 	if (pool->free_list_cnt >= count)
742 		return true;
743 
744 	req_count = count - pool->free_list_cnt;
745 	avail_count = xskq_cons_nb_entries(pool->fq, req_count);
746 	if (!avail_count)
747 		pool->fq->queue_empty_descs++;
748 
749 	return avail_count >= req_count;
750 }
751 EXPORT_SYMBOL(xp_can_alloc);
752 
753 void xp_free(struct xdp_buff_xsk *xskb)
754 {
755 	if (!list_empty(&xskb->list_node))
756 		return;
757 
758 	xskb->pool->free_list_cnt++;
759 	list_add(&xskb->list_node, &xskb->pool->free_list);
760 }
761 EXPORT_SYMBOL(xp_free);
762 
763 static u64 __xp_raw_get_addr(const struct xsk_buff_pool *pool, u64 addr)
764 {
765 	return pool->unaligned ? xp_unaligned_add_offset_to_addr(addr) : addr;
766 }
767 
768 static void *__xp_raw_get_data(const struct xsk_buff_pool *pool, u64 addr)
769 {
770 	return pool->addrs + addr;
771 }
772 
773 void *xp_raw_get_data(struct xsk_buff_pool *pool, u64 addr)
774 {
775 	return __xp_raw_get_data(pool, __xp_raw_get_addr(pool, addr));
776 }
777 EXPORT_SYMBOL(xp_raw_get_data);
778 
779 static dma_addr_t __xp_raw_get_dma(const struct xsk_buff_pool *pool, u64 addr)
780 {
781 	return (pool->dma_pages[addr >> PAGE_SHIFT] &
782 		~XSK_NEXT_PG_CONTIG_MASK) +
783 		(addr & ~PAGE_MASK);
784 }
785 
786 dma_addr_t xp_raw_get_dma(struct xsk_buff_pool *pool, u64 addr)
787 {
788 	return __xp_raw_get_dma(pool, __xp_raw_get_addr(pool, addr));
789 }
790 EXPORT_SYMBOL(xp_raw_get_dma);
791 
792 /**
793  * xp_raw_get_ctx - get &xdp_desc context
794  * @pool: XSk buff pool desc address belongs to
795  * @addr: desc address (from userspace)
796  * @options: desc options (from userspace)
797  *
798  * Helper for getting desc's DMA address and metadata pointer, if present.
799  * Saves one call on hotpath and double calculation of the actual address.
800  * Metadata is validated later by xsk_tx_metadata_request().
801  *
802  * Return: new &xdp_desc_ctx struct containing desc's DMA address and metadata
803  * pointer, if it is present (initialized to %NULL otherwise).
804  */
805 struct xdp_desc_ctx xp_raw_get_ctx(const struct xsk_buff_pool *pool, u64 addr,
806 				   u32 options)
807 {
808 	struct xdp_desc_ctx ret;
809 
810 	addr = __xp_raw_get_addr(pool, addr);
811 
812 	ret.dma = __xp_raw_get_dma(pool, addr);
813 	ret.meta = __xsk_buff_get_metadata(pool, __xp_raw_get_data(pool, addr),
814 					   options);
815 
816 	return ret;
817 }
818 EXPORT_SYMBOL(xp_raw_get_ctx);
819