1 #include <linux/bpf.h>
2 #include <linux/btf.h>
3 #include <linux/err.h>
4 #include <linux/irq_work.h>
5 #include <linux/slab.h>
6 #include <linux/filter.h>
7 #include <linux/mm.h>
8 #include <linux/vmalloc.h>
9 #include <linux/wait.h>
10 #include <linux/poll.h>
11 #include <linux/kmemleak.h>
12 #include <uapi/linux/btf.h>
13 #include <linux/btf_ids.h>
14 
15 #define RINGBUF_CREATE_FLAG_MASK (BPF_F_NUMA_NODE)
16 
17 /* non-mmap()'able part of bpf_ringbuf (everything up to consumer page) */
18 #define RINGBUF_PGOFF \
19 	(offsetof(struct bpf_ringbuf, consumer_pos) >> PAGE_SHIFT)
20 /* consumer page and producer page */
21 #define RINGBUF_POS_PAGES 2
22 #define RINGBUF_NR_META_PAGES (RINGBUF_PGOFF + RINGBUF_POS_PAGES)
23 
24 #define RINGBUF_MAX_RECORD_SZ (UINT_MAX/4)
25 
26 struct bpf_ringbuf {
27 	wait_queue_head_t waitq;
28 	struct irq_work work;
29 	u64 mask;
30 	struct page **pages;
31 	int nr_pages;
32 	spinlock_t spinlock ____cacheline_aligned_in_smp;
33 	/* For user-space producer ring buffers, an atomic_t busy bit is used
34 	 * to synchronize access to the ring buffers in the kernel, rather than
35 	 * the spinlock that is used for kernel-producer ring buffers. This is
36 	 * done because the ring buffer must hold a lock across a BPF program's
37 	 * callback:
38 	 *
39 	 *    __bpf_user_ringbuf_peek() // lock acquired
40 	 * -> program callback_fn()
41 	 * -> __bpf_user_ringbuf_sample_release() // lock released
42 	 *
43 	 * It is unsafe and incorrect to hold an IRQ spinlock across what could
44 	 * be a long execution window, so we instead simply disallow concurrent
45 	 * access to the ring buffer by kernel consumers, and return -EBUSY from
46 	 * __bpf_user_ringbuf_peek() if the busy bit is held by another task.
47 	 */
48 	atomic_t busy ____cacheline_aligned_in_smp;
49 	/* Consumer and producer counters are put into separate pages to
50 	 * allow each position to be mapped with different permissions.
51 	 * This prevents a user-space application from modifying the
52 	 * position and ruining in-kernel tracking. The permissions of the
53 	 * pages depend on who is producing samples: user-space or the
54 	 * kernel.
55 	 *
56 	 * Kernel-producer
57 	 * ---------------
58 	 * The producer position and data pages are mapped as r/o in
59 	 * userspace. For this approach, bits in the header of samples are
60 	 * used to signal to user-space, and to other producers, whether a
61 	 * sample is currently being written.
62 	 *
63 	 * User-space producer
64 	 * -------------------
65 	 * Only the page containing the consumer position is mapped r/o in
66 	 * user-space. User-space producers also use bits of the header to
67 	 * communicate to the kernel, but the kernel must carefully check and
68 	 * validate each sample to ensure that they're correctly formatted, and
69 	 * fully contained within the ring buffer.
70 	 */
71 	unsigned long consumer_pos __aligned(PAGE_SIZE);
72 	unsigned long producer_pos __aligned(PAGE_SIZE);
73 	char data[] __aligned(PAGE_SIZE);
74 };
75 
76 struct bpf_ringbuf_map {
77 	struct bpf_map map;
78 	struct bpf_ringbuf *rb;
79 };
80 
81 /* 8-byte ring buffer record header structure */
82 struct bpf_ringbuf_hdr {
83 	u32 len;
84 	u32 pg_off;
85 };
86 
bpf_ringbuf_area_alloc(size_t data_sz,int numa_node)87 static struct bpf_ringbuf *bpf_ringbuf_area_alloc(size_t data_sz, int numa_node)
88 {
89 	const gfp_t flags = GFP_KERNEL_ACCOUNT | __GFP_RETRY_MAYFAIL |
90 			    __GFP_NOWARN | __GFP_ZERO;
91 	int nr_meta_pages = RINGBUF_NR_META_PAGES;
92 	int nr_data_pages = data_sz >> PAGE_SHIFT;
93 	int nr_pages = nr_meta_pages + nr_data_pages;
94 	struct page **pages, *page;
95 	struct bpf_ringbuf *rb;
96 	size_t array_size;
97 	int i;
98 
99 	/* Each data page is mapped twice to allow "virtual"
100 	 * continuous read of samples wrapping around the end of ring
101 	 * buffer area:
102 	 * ------------------------------------------------------
103 	 * | meta pages |  real data pages  |  same data pages  |
104 	 * ------------------------------------------------------
105 	 * |            | 1 2 3 4 5 6 7 8 9 | 1 2 3 4 5 6 7 8 9 |
106 	 * ------------------------------------------------------
107 	 * |            | TA             DA | TA             DA |
108 	 * ------------------------------------------------------
109 	 *                               ^^^^^^^
110 	 *                                  |
111 	 * Here, no need to worry about special handling of wrapped-around
112 	 * data due to double-mapped data pages. This works both in kernel and
113 	 * when mmap()'ed in user-space, simplifying both kernel and
114 	 * user-space implementations significantly.
115 	 */
116 	array_size = (nr_meta_pages + 2 * nr_data_pages) * sizeof(*pages);
117 	pages = bpf_map_area_alloc(array_size, numa_node);
118 	if (!pages)
119 		return NULL;
120 
121 	for (i = 0; i < nr_pages; i++) {
122 		page = alloc_pages_node(numa_node, flags, 0);
123 		if (!page) {
124 			nr_pages = i;
125 			goto err_free_pages;
126 		}
127 		pages[i] = page;
128 		if (i >= nr_meta_pages)
129 			pages[nr_data_pages + i] = page;
130 	}
131 
132 	rb = vmap(pages, nr_meta_pages + 2 * nr_data_pages,
133 		  VM_MAP | VM_USERMAP, PAGE_KERNEL);
134 	if (rb) {
135 		kmemleak_not_leak(pages);
136 		rb->pages = pages;
137 		rb->nr_pages = nr_pages;
138 		return rb;
139 	}
140 
141 err_free_pages:
142 	for (i = 0; i < nr_pages; i++)
143 		__free_page(pages[i]);
144 	bpf_map_area_free(pages);
145 	return NULL;
146 }
147 
bpf_ringbuf_notify(struct irq_work * work)148 static void bpf_ringbuf_notify(struct irq_work *work)
149 {
150 	struct bpf_ringbuf *rb = container_of(work, struct bpf_ringbuf, work);
151 
152 	wake_up_all(&rb->waitq);
153 }
154 
155 /* Maximum size of ring buffer area is limited by 32-bit page offset within
156  * record header, counted in pages. Reserve 8 bits for extensibility, and
157  * take into account few extra pages for consumer/producer pages and
158  * non-mmap()'able parts, the current maximum size would be:
159  *
160  *     (((1ULL << 24) - RINGBUF_POS_PAGES - RINGBUF_PGOFF) * PAGE_SIZE)
161  *
162  * This gives 64GB limit, which seems plenty for single ring buffer. Now
163  * considering that the maximum value of data_sz is (4GB - 1), there
164  * will be no overflow, so just note the size limit in the comments.
165  */
bpf_ringbuf_alloc(size_t data_sz,int numa_node)166 static struct bpf_ringbuf *bpf_ringbuf_alloc(size_t data_sz, int numa_node)
167 {
168 	struct bpf_ringbuf *rb;
169 
170 	rb = bpf_ringbuf_area_alloc(data_sz, numa_node);
171 	if (!rb)
172 		return NULL;
173 
174 	spin_lock_init(&rb->spinlock);
175 	atomic_set(&rb->busy, 0);
176 	init_waitqueue_head(&rb->waitq);
177 	init_irq_work(&rb->work, bpf_ringbuf_notify);
178 
179 	rb->mask = data_sz - 1;
180 	rb->consumer_pos = 0;
181 	rb->producer_pos = 0;
182 
183 	return rb;
184 }
185 
ringbuf_map_alloc(union bpf_attr * attr)186 static struct bpf_map *ringbuf_map_alloc(union bpf_attr *attr)
187 {
188 	struct bpf_ringbuf_map *rb_map;
189 
190 	if (attr->map_flags & ~RINGBUF_CREATE_FLAG_MASK)
191 		return ERR_PTR(-EINVAL);
192 
193 	if (attr->key_size || attr->value_size ||
194 	    !is_power_of_2(attr->max_entries) ||
195 	    !PAGE_ALIGNED(attr->max_entries))
196 		return ERR_PTR(-EINVAL);
197 
198 	rb_map = bpf_map_area_alloc(sizeof(*rb_map), NUMA_NO_NODE);
199 	if (!rb_map)
200 		return ERR_PTR(-ENOMEM);
201 
202 	bpf_map_init_from_attr(&rb_map->map, attr);
203 
204 	rb_map->rb = bpf_ringbuf_alloc(attr->max_entries, rb_map->map.numa_node);
205 	if (!rb_map->rb) {
206 		bpf_map_area_free(rb_map);
207 		return ERR_PTR(-ENOMEM);
208 	}
209 
210 	return &rb_map->map;
211 }
212 
bpf_ringbuf_free(struct bpf_ringbuf * rb)213 static void bpf_ringbuf_free(struct bpf_ringbuf *rb)
214 {
215 	/* copy pages pointer and nr_pages to local variable, as we are going
216 	 * to unmap rb itself with vunmap() below
217 	 */
218 	struct page **pages = rb->pages;
219 	int i, nr_pages = rb->nr_pages;
220 
221 	vunmap(rb);
222 	for (i = 0; i < nr_pages; i++)
223 		__free_page(pages[i]);
224 	bpf_map_area_free(pages);
225 }
226 
ringbuf_map_free(struct bpf_map * map)227 static void ringbuf_map_free(struct bpf_map *map)
228 {
229 	struct bpf_ringbuf_map *rb_map;
230 
231 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
232 	bpf_ringbuf_free(rb_map->rb);
233 	bpf_map_area_free(rb_map);
234 }
235 
ringbuf_map_lookup_elem(struct bpf_map * map,void * key)236 static void *ringbuf_map_lookup_elem(struct bpf_map *map, void *key)
237 {
238 	return ERR_PTR(-ENOTSUPP);
239 }
240 
ringbuf_map_update_elem(struct bpf_map * map,void * key,void * value,u64 flags)241 static long ringbuf_map_update_elem(struct bpf_map *map, void *key, void *value,
242 				    u64 flags)
243 {
244 	return -ENOTSUPP;
245 }
246 
ringbuf_map_delete_elem(struct bpf_map * map,void * key)247 static long ringbuf_map_delete_elem(struct bpf_map *map, void *key)
248 {
249 	return -ENOTSUPP;
250 }
251 
ringbuf_map_get_next_key(struct bpf_map * map,void * key,void * next_key)252 static int ringbuf_map_get_next_key(struct bpf_map *map, void *key,
253 				    void *next_key)
254 {
255 	return -ENOTSUPP;
256 }
257 
ringbuf_map_mmap_kern(struct bpf_map * map,struct vm_area_struct * vma)258 static int ringbuf_map_mmap_kern(struct bpf_map *map, struct vm_area_struct *vma)
259 {
260 	struct bpf_ringbuf_map *rb_map;
261 
262 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
263 
264 	if (vma->vm_flags & VM_WRITE) {
265 		/* allow writable mapping for the consumer_pos only */
266 		if (vma->vm_pgoff != 0 || vma->vm_end - vma->vm_start != PAGE_SIZE)
267 			return -EPERM;
268 	} else {
269 		vm_flags_clear(vma, VM_MAYWRITE);
270 	}
271 	/* remap_vmalloc_range() checks size and offset constraints */
272 	return remap_vmalloc_range(vma, rb_map->rb,
273 				   vma->vm_pgoff + RINGBUF_PGOFF);
274 }
275 
ringbuf_map_mmap_user(struct bpf_map * map,struct vm_area_struct * vma)276 static int ringbuf_map_mmap_user(struct bpf_map *map, struct vm_area_struct *vma)
277 {
278 	struct bpf_ringbuf_map *rb_map;
279 
280 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
281 
282 	if (vma->vm_flags & VM_WRITE) {
283 		if (vma->vm_pgoff == 0)
284 			/* Disallow writable mappings to the consumer pointer,
285 			 * and allow writable mappings to both the producer
286 			 * position, and the ring buffer data itself.
287 			 */
288 			return -EPERM;
289 	} else {
290 		vm_flags_clear(vma, VM_MAYWRITE);
291 	}
292 	/* remap_vmalloc_range() checks size and offset constraints */
293 	return remap_vmalloc_range(vma, rb_map->rb, vma->vm_pgoff + RINGBUF_PGOFF);
294 }
295 
ringbuf_avail_data_sz(struct bpf_ringbuf * rb)296 static unsigned long ringbuf_avail_data_sz(struct bpf_ringbuf *rb)
297 {
298 	unsigned long cons_pos, prod_pos;
299 
300 	cons_pos = smp_load_acquire(&rb->consumer_pos);
301 	prod_pos = smp_load_acquire(&rb->producer_pos);
302 	return prod_pos - cons_pos;
303 }
304 
ringbuf_total_data_sz(const struct bpf_ringbuf * rb)305 static u32 ringbuf_total_data_sz(const struct bpf_ringbuf *rb)
306 {
307 	return rb->mask + 1;
308 }
309 
ringbuf_map_poll_kern(struct bpf_map * map,struct file * filp,struct poll_table_struct * pts)310 static __poll_t ringbuf_map_poll_kern(struct bpf_map *map, struct file *filp,
311 				      struct poll_table_struct *pts)
312 {
313 	struct bpf_ringbuf_map *rb_map;
314 
315 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
316 	poll_wait(filp, &rb_map->rb->waitq, pts);
317 
318 	if (ringbuf_avail_data_sz(rb_map->rb))
319 		return EPOLLIN | EPOLLRDNORM;
320 	return 0;
321 }
322 
ringbuf_map_poll_user(struct bpf_map * map,struct file * filp,struct poll_table_struct * pts)323 static __poll_t ringbuf_map_poll_user(struct bpf_map *map, struct file *filp,
324 				      struct poll_table_struct *pts)
325 {
326 	struct bpf_ringbuf_map *rb_map;
327 
328 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
329 	poll_wait(filp, &rb_map->rb->waitq, pts);
330 
331 	if (ringbuf_avail_data_sz(rb_map->rb) < ringbuf_total_data_sz(rb_map->rb))
332 		return EPOLLOUT | EPOLLWRNORM;
333 	return 0;
334 }
335 
ringbuf_map_mem_usage(const struct bpf_map * map)336 static u64 ringbuf_map_mem_usage(const struct bpf_map *map)
337 {
338 	struct bpf_ringbuf *rb;
339 	int nr_data_pages;
340 	int nr_meta_pages;
341 	u64 usage = sizeof(struct bpf_ringbuf_map);
342 
343 	rb = container_of(map, struct bpf_ringbuf_map, map)->rb;
344 	usage += (u64)rb->nr_pages << PAGE_SHIFT;
345 	nr_meta_pages = RINGBUF_NR_META_PAGES;
346 	nr_data_pages = map->max_entries >> PAGE_SHIFT;
347 	usage += (nr_meta_pages + 2 * nr_data_pages) * sizeof(struct page *);
348 	return usage;
349 }
350 
351 BTF_ID_LIST_SINGLE(ringbuf_map_btf_ids, struct, bpf_ringbuf_map)
352 const struct bpf_map_ops ringbuf_map_ops = {
353 	.map_meta_equal = bpf_map_meta_equal,
354 	.map_alloc = ringbuf_map_alloc,
355 	.map_free = ringbuf_map_free,
356 	.map_mmap = ringbuf_map_mmap_kern,
357 	.map_poll = ringbuf_map_poll_kern,
358 	.map_lookup_elem = ringbuf_map_lookup_elem,
359 	.map_update_elem = ringbuf_map_update_elem,
360 	.map_delete_elem = ringbuf_map_delete_elem,
361 	.map_get_next_key = ringbuf_map_get_next_key,
362 	.map_mem_usage = ringbuf_map_mem_usage,
363 	.map_btf_id = &ringbuf_map_btf_ids[0],
364 };
365 
366 BTF_ID_LIST_SINGLE(user_ringbuf_map_btf_ids, struct, bpf_ringbuf_map)
367 const struct bpf_map_ops user_ringbuf_map_ops = {
368 	.map_meta_equal = bpf_map_meta_equal,
369 	.map_alloc = ringbuf_map_alloc,
370 	.map_free = ringbuf_map_free,
371 	.map_mmap = ringbuf_map_mmap_user,
372 	.map_poll = ringbuf_map_poll_user,
373 	.map_lookup_elem = ringbuf_map_lookup_elem,
374 	.map_update_elem = ringbuf_map_update_elem,
375 	.map_delete_elem = ringbuf_map_delete_elem,
376 	.map_get_next_key = ringbuf_map_get_next_key,
377 	.map_mem_usage = ringbuf_map_mem_usage,
378 	.map_btf_id = &user_ringbuf_map_btf_ids[0],
379 };
380 
381 /* Given pointer to ring buffer record metadata and struct bpf_ringbuf itself,
382  * calculate offset from record metadata to ring buffer in pages, rounded
383  * down. This page offset is stored as part of record metadata and allows to
384  * restore struct bpf_ringbuf * from record pointer. This page offset is
385  * stored at offset 4 of record metadata header.
386  */
bpf_ringbuf_rec_pg_off(struct bpf_ringbuf * rb,struct bpf_ringbuf_hdr * hdr)387 static size_t bpf_ringbuf_rec_pg_off(struct bpf_ringbuf *rb,
388 				     struct bpf_ringbuf_hdr *hdr)
389 {
390 	return ((void *)hdr - (void *)rb) >> PAGE_SHIFT;
391 }
392 
393 /* Given pointer to ring buffer record header, restore pointer to struct
394  * bpf_ringbuf itself by using page offset stored at offset 4
395  */
396 static struct bpf_ringbuf *
bpf_ringbuf_restore_from_rec(struct bpf_ringbuf_hdr * hdr)397 bpf_ringbuf_restore_from_rec(struct bpf_ringbuf_hdr *hdr)
398 {
399 	unsigned long addr = (unsigned long)(void *)hdr;
400 	unsigned long off = (unsigned long)hdr->pg_off << PAGE_SHIFT;
401 
402 	return (void*)((addr & PAGE_MASK) - off);
403 }
404 
__bpf_ringbuf_reserve(struct bpf_ringbuf * rb,u64 size)405 static void *__bpf_ringbuf_reserve(struct bpf_ringbuf *rb, u64 size)
406 {
407 	unsigned long cons_pos, prod_pos, new_prod_pos, flags;
408 	u32 len, pg_off;
409 	struct bpf_ringbuf_hdr *hdr;
410 
411 	if (unlikely(size > RINGBUF_MAX_RECORD_SZ))
412 		return NULL;
413 
414 	len = round_up(size + BPF_RINGBUF_HDR_SZ, 8);
415 	if (len > ringbuf_total_data_sz(rb))
416 		return NULL;
417 
418 	cons_pos = smp_load_acquire(&rb->consumer_pos);
419 
420 	if (in_nmi()) {
421 		if (!spin_trylock_irqsave(&rb->spinlock, flags))
422 			return NULL;
423 	} else {
424 		spin_lock_irqsave(&rb->spinlock, flags);
425 	}
426 
427 	prod_pos = rb->producer_pos;
428 	new_prod_pos = prod_pos + len;
429 
430 	/* check for out of ringbuf space by ensuring producer position
431 	 * doesn't advance more than (ringbuf_size - 1) ahead
432 	 */
433 	if (new_prod_pos - cons_pos > rb->mask) {
434 		spin_unlock_irqrestore(&rb->spinlock, flags);
435 		return NULL;
436 	}
437 
438 	hdr = (void *)rb->data + (prod_pos & rb->mask);
439 	pg_off = bpf_ringbuf_rec_pg_off(rb, hdr);
440 	hdr->len = size | BPF_RINGBUF_BUSY_BIT;
441 	hdr->pg_off = pg_off;
442 
443 	/* pairs with consumer's smp_load_acquire() */
444 	smp_store_release(&rb->producer_pos, new_prod_pos);
445 
446 	spin_unlock_irqrestore(&rb->spinlock, flags);
447 
448 	return (void *)hdr + BPF_RINGBUF_HDR_SZ;
449 }
450 
BPF_CALL_3(bpf_ringbuf_reserve,struct bpf_map *,map,u64,size,u64,flags)451 BPF_CALL_3(bpf_ringbuf_reserve, struct bpf_map *, map, u64, size, u64, flags)
452 {
453 	struct bpf_ringbuf_map *rb_map;
454 
455 	if (unlikely(flags))
456 		return 0;
457 
458 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
459 	return (unsigned long)__bpf_ringbuf_reserve(rb_map->rb, size);
460 }
461 
462 const struct bpf_func_proto bpf_ringbuf_reserve_proto = {
463 	.func		= bpf_ringbuf_reserve,
464 	.ret_type	= RET_PTR_TO_RINGBUF_MEM_OR_NULL,
465 	.arg1_type	= ARG_CONST_MAP_PTR,
466 	.arg2_type	= ARG_CONST_ALLOC_SIZE_OR_ZERO,
467 	.arg3_type	= ARG_ANYTHING,
468 };
469 
bpf_ringbuf_commit(void * sample,u64 flags,bool discard)470 static void bpf_ringbuf_commit(void *sample, u64 flags, bool discard)
471 {
472 	unsigned long rec_pos, cons_pos;
473 	struct bpf_ringbuf_hdr *hdr;
474 	struct bpf_ringbuf *rb;
475 	u32 new_len;
476 
477 	hdr = sample - BPF_RINGBUF_HDR_SZ;
478 	rb = bpf_ringbuf_restore_from_rec(hdr);
479 	new_len = hdr->len ^ BPF_RINGBUF_BUSY_BIT;
480 	if (discard)
481 		new_len |= BPF_RINGBUF_DISCARD_BIT;
482 
483 	/* update record header with correct final size prefix */
484 	xchg(&hdr->len, new_len);
485 
486 	/* if consumer caught up and is waiting for our record, notify about
487 	 * new data availability
488 	 */
489 	rec_pos = (void *)hdr - (void *)rb->data;
490 	cons_pos = smp_load_acquire(&rb->consumer_pos) & rb->mask;
491 
492 	if (flags & BPF_RB_FORCE_WAKEUP)
493 		irq_work_queue(&rb->work);
494 	else if (cons_pos == rec_pos && !(flags & BPF_RB_NO_WAKEUP))
495 		irq_work_queue(&rb->work);
496 }
497 
BPF_CALL_2(bpf_ringbuf_submit,void *,sample,u64,flags)498 BPF_CALL_2(bpf_ringbuf_submit, void *, sample, u64, flags)
499 {
500 	bpf_ringbuf_commit(sample, flags, false /* discard */);
501 	return 0;
502 }
503 
504 const struct bpf_func_proto bpf_ringbuf_submit_proto = {
505 	.func		= bpf_ringbuf_submit,
506 	.ret_type	= RET_VOID,
507 	.arg1_type	= ARG_PTR_TO_RINGBUF_MEM | OBJ_RELEASE,
508 	.arg2_type	= ARG_ANYTHING,
509 };
510 
BPF_CALL_2(bpf_ringbuf_discard,void *,sample,u64,flags)511 BPF_CALL_2(bpf_ringbuf_discard, void *, sample, u64, flags)
512 {
513 	bpf_ringbuf_commit(sample, flags, true /* discard */);
514 	return 0;
515 }
516 
517 const struct bpf_func_proto bpf_ringbuf_discard_proto = {
518 	.func		= bpf_ringbuf_discard,
519 	.ret_type	= RET_VOID,
520 	.arg1_type	= ARG_PTR_TO_RINGBUF_MEM | OBJ_RELEASE,
521 	.arg2_type	= ARG_ANYTHING,
522 };
523 
BPF_CALL_4(bpf_ringbuf_output,struct bpf_map *,map,void *,data,u64,size,u64,flags)524 BPF_CALL_4(bpf_ringbuf_output, struct bpf_map *, map, void *, data, u64, size,
525 	   u64, flags)
526 {
527 	struct bpf_ringbuf_map *rb_map;
528 	void *rec;
529 
530 	if (unlikely(flags & ~(BPF_RB_NO_WAKEUP | BPF_RB_FORCE_WAKEUP)))
531 		return -EINVAL;
532 
533 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
534 	rec = __bpf_ringbuf_reserve(rb_map->rb, size);
535 	if (!rec)
536 		return -EAGAIN;
537 
538 	memcpy(rec, data, size);
539 	bpf_ringbuf_commit(rec, flags, false /* discard */);
540 	return 0;
541 }
542 
543 const struct bpf_func_proto bpf_ringbuf_output_proto = {
544 	.func		= bpf_ringbuf_output,
545 	.ret_type	= RET_INTEGER,
546 	.arg1_type	= ARG_CONST_MAP_PTR,
547 	.arg2_type	= ARG_PTR_TO_MEM | MEM_RDONLY,
548 	.arg3_type	= ARG_CONST_SIZE_OR_ZERO,
549 	.arg4_type	= ARG_ANYTHING,
550 };
551 
BPF_CALL_2(bpf_ringbuf_query,struct bpf_map *,map,u64,flags)552 BPF_CALL_2(bpf_ringbuf_query, struct bpf_map *, map, u64, flags)
553 {
554 	struct bpf_ringbuf *rb;
555 
556 	rb = container_of(map, struct bpf_ringbuf_map, map)->rb;
557 
558 	switch (flags) {
559 	case BPF_RB_AVAIL_DATA:
560 		return ringbuf_avail_data_sz(rb);
561 	case BPF_RB_RING_SIZE:
562 		return ringbuf_total_data_sz(rb);
563 	case BPF_RB_CONS_POS:
564 		return smp_load_acquire(&rb->consumer_pos);
565 	case BPF_RB_PROD_POS:
566 		return smp_load_acquire(&rb->producer_pos);
567 	default:
568 		return 0;
569 	}
570 }
571 
572 const struct bpf_func_proto bpf_ringbuf_query_proto = {
573 	.func		= bpf_ringbuf_query,
574 	.ret_type	= RET_INTEGER,
575 	.arg1_type	= ARG_CONST_MAP_PTR,
576 	.arg2_type	= ARG_ANYTHING,
577 };
578 
BPF_CALL_4(bpf_ringbuf_reserve_dynptr,struct bpf_map *,map,u32,size,u64,flags,struct bpf_dynptr_kern *,ptr)579 BPF_CALL_4(bpf_ringbuf_reserve_dynptr, struct bpf_map *, map, u32, size, u64, flags,
580 	   struct bpf_dynptr_kern *, ptr)
581 {
582 	struct bpf_ringbuf_map *rb_map;
583 	void *sample;
584 	int err;
585 
586 	if (unlikely(flags)) {
587 		bpf_dynptr_set_null(ptr);
588 		return -EINVAL;
589 	}
590 
591 	err = bpf_dynptr_check_size(size);
592 	if (err) {
593 		bpf_dynptr_set_null(ptr);
594 		return err;
595 	}
596 
597 	rb_map = container_of(map, struct bpf_ringbuf_map, map);
598 
599 	sample = __bpf_ringbuf_reserve(rb_map->rb, size);
600 	if (!sample) {
601 		bpf_dynptr_set_null(ptr);
602 		return -EINVAL;
603 	}
604 
605 	bpf_dynptr_init(ptr, sample, BPF_DYNPTR_TYPE_RINGBUF, 0, size);
606 
607 	return 0;
608 }
609 
610 const struct bpf_func_proto bpf_ringbuf_reserve_dynptr_proto = {
611 	.func		= bpf_ringbuf_reserve_dynptr,
612 	.ret_type	= RET_INTEGER,
613 	.arg1_type	= ARG_CONST_MAP_PTR,
614 	.arg2_type	= ARG_ANYTHING,
615 	.arg3_type	= ARG_ANYTHING,
616 	.arg4_type	= ARG_PTR_TO_DYNPTR | DYNPTR_TYPE_RINGBUF | MEM_UNINIT,
617 };
618 
BPF_CALL_2(bpf_ringbuf_submit_dynptr,struct bpf_dynptr_kern *,ptr,u64,flags)619 BPF_CALL_2(bpf_ringbuf_submit_dynptr, struct bpf_dynptr_kern *, ptr, u64, flags)
620 {
621 	if (!ptr->data)
622 		return 0;
623 
624 	bpf_ringbuf_commit(ptr->data, flags, false /* discard */);
625 
626 	bpf_dynptr_set_null(ptr);
627 
628 	return 0;
629 }
630 
631 const struct bpf_func_proto bpf_ringbuf_submit_dynptr_proto = {
632 	.func		= bpf_ringbuf_submit_dynptr,
633 	.ret_type	= RET_VOID,
634 	.arg1_type	= ARG_PTR_TO_DYNPTR | DYNPTR_TYPE_RINGBUF | OBJ_RELEASE,
635 	.arg2_type	= ARG_ANYTHING,
636 };
637 
BPF_CALL_2(bpf_ringbuf_discard_dynptr,struct bpf_dynptr_kern *,ptr,u64,flags)638 BPF_CALL_2(bpf_ringbuf_discard_dynptr, struct bpf_dynptr_kern *, ptr, u64, flags)
639 {
640 	if (!ptr->data)
641 		return 0;
642 
643 	bpf_ringbuf_commit(ptr->data, flags, true /* discard */);
644 
645 	bpf_dynptr_set_null(ptr);
646 
647 	return 0;
648 }
649 
650 const struct bpf_func_proto bpf_ringbuf_discard_dynptr_proto = {
651 	.func		= bpf_ringbuf_discard_dynptr,
652 	.ret_type	= RET_VOID,
653 	.arg1_type	= ARG_PTR_TO_DYNPTR | DYNPTR_TYPE_RINGBUF | OBJ_RELEASE,
654 	.arg2_type	= ARG_ANYTHING,
655 };
656 
__bpf_user_ringbuf_peek(struct bpf_ringbuf * rb,void ** sample,u32 * size)657 static int __bpf_user_ringbuf_peek(struct bpf_ringbuf *rb, void **sample, u32 *size)
658 {
659 	int err;
660 	u32 hdr_len, sample_len, total_len, flags, *hdr;
661 	u64 cons_pos, prod_pos;
662 
663 	/* Synchronizes with smp_store_release() in user-space producer. */
664 	prod_pos = smp_load_acquire(&rb->producer_pos);
665 	if (prod_pos % 8)
666 		return -EINVAL;
667 
668 	/* Synchronizes with smp_store_release() in __bpf_user_ringbuf_sample_release() */
669 	cons_pos = smp_load_acquire(&rb->consumer_pos);
670 	if (cons_pos >= prod_pos)
671 		return -ENODATA;
672 
673 	hdr = (u32 *)((uintptr_t)rb->data + (uintptr_t)(cons_pos & rb->mask));
674 	/* Synchronizes with smp_store_release() in user-space producer. */
675 	hdr_len = smp_load_acquire(hdr);
676 	flags = hdr_len & (BPF_RINGBUF_BUSY_BIT | BPF_RINGBUF_DISCARD_BIT);
677 	sample_len = hdr_len & ~flags;
678 	total_len = round_up(sample_len + BPF_RINGBUF_HDR_SZ, 8);
679 
680 	/* The sample must fit within the region advertised by the producer position. */
681 	if (total_len > prod_pos - cons_pos)
682 		return -EINVAL;
683 
684 	/* The sample must fit within the data region of the ring buffer. */
685 	if (total_len > ringbuf_total_data_sz(rb))
686 		return -E2BIG;
687 
688 	/* The sample must fit into a struct bpf_dynptr. */
689 	err = bpf_dynptr_check_size(sample_len);
690 	if (err)
691 		return -E2BIG;
692 
693 	if (flags & BPF_RINGBUF_DISCARD_BIT) {
694 		/* If the discard bit is set, the sample should be skipped.
695 		 *
696 		 * Update the consumer pos, and return -EAGAIN so the caller
697 		 * knows to skip this sample and try to read the next one.
698 		 */
699 		smp_store_release(&rb->consumer_pos, cons_pos + total_len);
700 		return -EAGAIN;
701 	}
702 
703 	if (flags & BPF_RINGBUF_BUSY_BIT)
704 		return -ENODATA;
705 
706 	*sample = (void *)((uintptr_t)rb->data +
707 			   (uintptr_t)((cons_pos + BPF_RINGBUF_HDR_SZ) & rb->mask));
708 	*size = sample_len;
709 	return 0;
710 }
711 
__bpf_user_ringbuf_sample_release(struct bpf_ringbuf * rb,size_t size,u64 flags)712 static void __bpf_user_ringbuf_sample_release(struct bpf_ringbuf *rb, size_t size, u64 flags)
713 {
714 	u64 consumer_pos;
715 	u32 rounded_size = round_up(size + BPF_RINGBUF_HDR_SZ, 8);
716 
717 	/* Using smp_load_acquire() is unnecessary here, as the busy-bit
718 	 * prevents another task from writing to consumer_pos after it was read
719 	 * by this task with smp_load_acquire() in __bpf_user_ringbuf_peek().
720 	 */
721 	consumer_pos = rb->consumer_pos;
722 	 /* Synchronizes with smp_load_acquire() in user-space producer. */
723 	smp_store_release(&rb->consumer_pos, consumer_pos + rounded_size);
724 }
725 
BPF_CALL_4(bpf_user_ringbuf_drain,struct bpf_map *,map,void *,callback_fn,void *,callback_ctx,u64,flags)726 BPF_CALL_4(bpf_user_ringbuf_drain, struct bpf_map *, map,
727 	   void *, callback_fn, void *, callback_ctx, u64, flags)
728 {
729 	struct bpf_ringbuf *rb;
730 	long samples, discarded_samples = 0, ret = 0;
731 	bpf_callback_t callback = (bpf_callback_t)callback_fn;
732 	u64 wakeup_flags = BPF_RB_NO_WAKEUP | BPF_RB_FORCE_WAKEUP;
733 	int busy = 0;
734 
735 	if (unlikely(flags & ~wakeup_flags))
736 		return -EINVAL;
737 
738 	rb = container_of(map, struct bpf_ringbuf_map, map)->rb;
739 
740 	/* If another consumer is already consuming a sample, wait for them to finish. */
741 	if (!atomic_try_cmpxchg(&rb->busy, &busy, 1))
742 		return -EBUSY;
743 
744 	for (samples = 0; samples < BPF_MAX_USER_RINGBUF_SAMPLES && ret == 0; samples++) {
745 		int err;
746 		u32 size;
747 		void *sample;
748 		struct bpf_dynptr_kern dynptr;
749 
750 		err = __bpf_user_ringbuf_peek(rb, &sample, &size);
751 		if (err) {
752 			if (err == -ENODATA) {
753 				break;
754 			} else if (err == -EAGAIN) {
755 				discarded_samples++;
756 				continue;
757 			} else {
758 				ret = err;
759 				goto schedule_work_return;
760 			}
761 		}
762 
763 		bpf_dynptr_init(&dynptr, sample, BPF_DYNPTR_TYPE_LOCAL, 0, size);
764 		ret = callback((uintptr_t)&dynptr, (uintptr_t)callback_ctx, 0, 0, 0);
765 		__bpf_user_ringbuf_sample_release(rb, size, flags);
766 	}
767 	ret = samples - discarded_samples;
768 
769 schedule_work_return:
770 	/* Prevent the clearing of the busy-bit from being reordered before the
771 	 * storing of any rb consumer or producer positions.
772 	 */
773 	smp_mb__before_atomic();
774 	atomic_set(&rb->busy, 0);
775 
776 	if (flags & BPF_RB_FORCE_WAKEUP)
777 		irq_work_queue(&rb->work);
778 	else if (!(flags & BPF_RB_NO_WAKEUP) && samples > 0)
779 		irq_work_queue(&rb->work);
780 	return ret;
781 }
782 
783 const struct bpf_func_proto bpf_user_ringbuf_drain_proto = {
784 	.func		= bpf_user_ringbuf_drain,
785 	.ret_type	= RET_INTEGER,
786 	.arg1_type	= ARG_CONST_MAP_PTR,
787 	.arg2_type	= ARG_PTR_TO_FUNC,
788 	.arg3_type	= ARG_PTR_TO_STACK_OR_NULL,
789 	.arg4_type	= ARG_ANYTHING,
790 };
791