xref: /openbmc/linux/net/bpf/test_run.c (revision 1f012283)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2017 Facebook
3  */
4 #include <linux/bpf.h>
5 #include <linux/btf.h>
6 #include <linux/btf_ids.h>
7 #include <linux/slab.h>
8 #include <linux/vmalloc.h>
9 #include <linux/etherdevice.h>
10 #include <linux/filter.h>
11 #include <linux/rcupdate_trace.h>
12 #include <linux/sched/signal.h>
13 #include <net/bpf_sk_storage.h>
14 #include <net/sock.h>
15 #include <net/tcp.h>
16 #include <net/net_namespace.h>
17 #include <linux/error-injection.h>
18 #include <linux/smp.h>
19 #include <linux/sock_diag.h>
20 #include <net/xdp.h>
21 
22 #define CREATE_TRACE_POINTS
23 #include <trace/events/bpf_test_run.h>
24 
25 struct bpf_test_timer {
26 	enum { NO_PREEMPT, NO_MIGRATE } mode;
27 	u32 i;
28 	u64 time_start, time_spent;
29 };
30 
31 static void bpf_test_timer_enter(struct bpf_test_timer *t)
32 	__acquires(rcu)
33 {
34 	rcu_read_lock();
35 	if (t->mode == NO_PREEMPT)
36 		preempt_disable();
37 	else
38 		migrate_disable();
39 
40 	t->time_start = ktime_get_ns();
41 }
42 
43 static void bpf_test_timer_leave(struct bpf_test_timer *t)
44 	__releases(rcu)
45 {
46 	t->time_start = 0;
47 
48 	if (t->mode == NO_PREEMPT)
49 		preempt_enable();
50 	else
51 		migrate_enable();
52 	rcu_read_unlock();
53 }
54 
55 static bool bpf_test_timer_continue(struct bpf_test_timer *t, u32 repeat, int *err, u32 *duration)
56 	__must_hold(rcu)
57 {
58 	t->i++;
59 	if (t->i >= repeat) {
60 		/* We're done. */
61 		t->time_spent += ktime_get_ns() - t->time_start;
62 		do_div(t->time_spent, t->i);
63 		*duration = t->time_spent > U32_MAX ? U32_MAX : (u32)t->time_spent;
64 		*err = 0;
65 		goto reset;
66 	}
67 
68 	if (signal_pending(current)) {
69 		/* During iteration: we've been cancelled, abort. */
70 		*err = -EINTR;
71 		goto reset;
72 	}
73 
74 	if (need_resched()) {
75 		/* During iteration: we need to reschedule between runs. */
76 		t->time_spent += ktime_get_ns() - t->time_start;
77 		bpf_test_timer_leave(t);
78 		cond_resched();
79 		bpf_test_timer_enter(t);
80 	}
81 
82 	/* Do another round. */
83 	return true;
84 
85 reset:
86 	t->i = 0;
87 	return false;
88 }
89 
90 static int bpf_test_run(struct bpf_prog *prog, void *ctx, u32 repeat,
91 			u32 *retval, u32 *time, bool xdp)
92 {
93 	struct bpf_prog_array_item item = {.prog = prog};
94 	struct bpf_run_ctx *old_ctx;
95 	struct bpf_cg_run_ctx run_ctx;
96 	struct bpf_test_timer t = { NO_MIGRATE };
97 	enum bpf_cgroup_storage_type stype;
98 	int ret;
99 
100 	for_each_cgroup_storage_type(stype) {
101 		item.cgroup_storage[stype] = bpf_cgroup_storage_alloc(prog, stype);
102 		if (IS_ERR(item.cgroup_storage[stype])) {
103 			item.cgroup_storage[stype] = NULL;
104 			for_each_cgroup_storage_type(stype)
105 				bpf_cgroup_storage_free(item.cgroup_storage[stype]);
106 			return -ENOMEM;
107 		}
108 	}
109 
110 	if (!repeat)
111 		repeat = 1;
112 
113 	bpf_test_timer_enter(&t);
114 	old_ctx = bpf_set_run_ctx(&run_ctx.run_ctx);
115 	do {
116 		run_ctx.prog_item = &item;
117 		if (xdp)
118 			*retval = bpf_prog_run_xdp(prog, ctx);
119 		else
120 			*retval = bpf_prog_run(prog, ctx);
121 	} while (bpf_test_timer_continue(&t, repeat, &ret, time));
122 	bpf_reset_run_ctx(old_ctx);
123 	bpf_test_timer_leave(&t);
124 
125 	for_each_cgroup_storage_type(stype)
126 		bpf_cgroup_storage_free(item.cgroup_storage[stype]);
127 
128 	return ret;
129 }
130 
131 static int bpf_test_finish(const union bpf_attr *kattr,
132 			   union bpf_attr __user *uattr, const void *data,
133 			   u32 size, u32 retval, u32 duration)
134 {
135 	void __user *data_out = u64_to_user_ptr(kattr->test.data_out);
136 	int err = -EFAULT;
137 	u32 copy_size = size;
138 
139 	/* Clamp copy if the user has provided a size hint, but copy the full
140 	 * buffer if not to retain old behaviour.
141 	 */
142 	if (kattr->test.data_size_out &&
143 	    copy_size > kattr->test.data_size_out) {
144 		copy_size = kattr->test.data_size_out;
145 		err = -ENOSPC;
146 	}
147 
148 	if (data_out && copy_to_user(data_out, data, copy_size))
149 		goto out;
150 	if (copy_to_user(&uattr->test.data_size_out, &size, sizeof(size)))
151 		goto out;
152 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval)))
153 		goto out;
154 	if (copy_to_user(&uattr->test.duration, &duration, sizeof(duration)))
155 		goto out;
156 	if (err != -ENOSPC)
157 		err = 0;
158 out:
159 	trace_bpf_test_finish(&err);
160 	return err;
161 }
162 
163 /* Integer types of various sizes and pointer combinations cover variety of
164  * architecture dependent calling conventions. 7+ can be supported in the
165  * future.
166  */
167 __diag_push();
168 __diag_ignore(GCC, 8, "-Wmissing-prototypes",
169 	      "Global functions as their definitions will be in vmlinux BTF");
170 int noinline bpf_fentry_test1(int a)
171 {
172 	return a + 1;
173 }
174 
175 int noinline bpf_fentry_test2(int a, u64 b)
176 {
177 	return a + b;
178 }
179 
180 int noinline bpf_fentry_test3(char a, int b, u64 c)
181 {
182 	return a + b + c;
183 }
184 
185 int noinline bpf_fentry_test4(void *a, char b, int c, u64 d)
186 {
187 	return (long)a + b + c + d;
188 }
189 
190 int noinline bpf_fentry_test5(u64 a, void *b, short c, int d, u64 e)
191 {
192 	return a + (long)b + c + d + e;
193 }
194 
195 int noinline bpf_fentry_test6(u64 a, void *b, short c, int d, void *e, u64 f)
196 {
197 	return a + (long)b + c + d + (long)e + f;
198 }
199 
200 struct bpf_fentry_test_t {
201 	struct bpf_fentry_test_t *a;
202 };
203 
204 int noinline bpf_fentry_test7(struct bpf_fentry_test_t *arg)
205 {
206 	return (long)arg;
207 }
208 
209 int noinline bpf_fentry_test8(struct bpf_fentry_test_t *arg)
210 {
211 	return (long)arg->a;
212 }
213 
214 int noinline bpf_modify_return_test(int a, int *b)
215 {
216 	*b += 1;
217 	return a + *b;
218 }
219 
220 u64 noinline bpf_kfunc_call_test1(struct sock *sk, u32 a, u64 b, u32 c, u64 d)
221 {
222 	return a + b + c + d;
223 }
224 
225 int noinline bpf_kfunc_call_test2(struct sock *sk, u32 a, u32 b)
226 {
227 	return a + b;
228 }
229 
230 struct sock * noinline bpf_kfunc_call_test3(struct sock *sk)
231 {
232 	return sk;
233 }
234 
235 __diag_pop();
236 
237 ALLOW_ERROR_INJECTION(bpf_modify_return_test, ERRNO);
238 
239 BTF_SET_START(test_sk_kfunc_ids)
240 BTF_ID(func, bpf_kfunc_call_test1)
241 BTF_ID(func, bpf_kfunc_call_test2)
242 BTF_ID(func, bpf_kfunc_call_test3)
243 BTF_SET_END(test_sk_kfunc_ids)
244 
245 bool bpf_prog_test_check_kfunc_call(u32 kfunc_id, struct module *owner)
246 {
247 	if (btf_id_set_contains(&test_sk_kfunc_ids, kfunc_id))
248 		return true;
249 	return bpf_check_mod_kfunc_call(&prog_test_kfunc_list, kfunc_id, owner);
250 }
251 
252 static void *bpf_test_init(const union bpf_attr *kattr, u32 size,
253 			   u32 headroom, u32 tailroom)
254 {
255 	void __user *data_in = u64_to_user_ptr(kattr->test.data_in);
256 	u32 user_size = kattr->test.data_size_in;
257 	void *data;
258 
259 	if (size < ETH_HLEN || size > PAGE_SIZE - headroom - tailroom)
260 		return ERR_PTR(-EINVAL);
261 
262 	if (user_size > size)
263 		return ERR_PTR(-EMSGSIZE);
264 
265 	data = kzalloc(size + headroom + tailroom, GFP_USER);
266 	if (!data)
267 		return ERR_PTR(-ENOMEM);
268 
269 	if (copy_from_user(data + headroom, data_in, user_size)) {
270 		kfree(data);
271 		return ERR_PTR(-EFAULT);
272 	}
273 
274 	return data;
275 }
276 
277 int bpf_prog_test_run_tracing(struct bpf_prog *prog,
278 			      const union bpf_attr *kattr,
279 			      union bpf_attr __user *uattr)
280 {
281 	struct bpf_fentry_test_t arg = {};
282 	u16 side_effect = 0, ret = 0;
283 	int b = 2, err = -EFAULT;
284 	u32 retval = 0;
285 
286 	if (kattr->test.flags || kattr->test.cpu)
287 		return -EINVAL;
288 
289 	switch (prog->expected_attach_type) {
290 	case BPF_TRACE_FENTRY:
291 	case BPF_TRACE_FEXIT:
292 		if (bpf_fentry_test1(1) != 2 ||
293 		    bpf_fentry_test2(2, 3) != 5 ||
294 		    bpf_fentry_test3(4, 5, 6) != 15 ||
295 		    bpf_fentry_test4((void *)7, 8, 9, 10) != 34 ||
296 		    bpf_fentry_test5(11, (void *)12, 13, 14, 15) != 65 ||
297 		    bpf_fentry_test6(16, (void *)17, 18, 19, (void *)20, 21) != 111 ||
298 		    bpf_fentry_test7((struct bpf_fentry_test_t *)0) != 0 ||
299 		    bpf_fentry_test8(&arg) != 0)
300 			goto out;
301 		break;
302 	case BPF_MODIFY_RETURN:
303 		ret = bpf_modify_return_test(1, &b);
304 		if (b != 2)
305 			side_effect = 1;
306 		break;
307 	default:
308 		goto out;
309 	}
310 
311 	retval = ((u32)side_effect << 16) | ret;
312 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval)))
313 		goto out;
314 
315 	err = 0;
316 out:
317 	trace_bpf_test_finish(&err);
318 	return err;
319 }
320 
321 struct bpf_raw_tp_test_run_info {
322 	struct bpf_prog *prog;
323 	void *ctx;
324 	u32 retval;
325 };
326 
327 static void
328 __bpf_prog_test_run_raw_tp(void *data)
329 {
330 	struct bpf_raw_tp_test_run_info *info = data;
331 
332 	rcu_read_lock();
333 	info->retval = bpf_prog_run(info->prog, info->ctx);
334 	rcu_read_unlock();
335 }
336 
337 int bpf_prog_test_run_raw_tp(struct bpf_prog *prog,
338 			     const union bpf_attr *kattr,
339 			     union bpf_attr __user *uattr)
340 {
341 	void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in);
342 	__u32 ctx_size_in = kattr->test.ctx_size_in;
343 	struct bpf_raw_tp_test_run_info info;
344 	int cpu = kattr->test.cpu, err = 0;
345 	int current_cpu;
346 
347 	/* doesn't support data_in/out, ctx_out, duration, or repeat */
348 	if (kattr->test.data_in || kattr->test.data_out ||
349 	    kattr->test.ctx_out || kattr->test.duration ||
350 	    kattr->test.repeat)
351 		return -EINVAL;
352 
353 	if (ctx_size_in < prog->aux->max_ctx_offset ||
354 	    ctx_size_in > MAX_BPF_FUNC_ARGS * sizeof(u64))
355 		return -EINVAL;
356 
357 	if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 && cpu != 0)
358 		return -EINVAL;
359 
360 	if (ctx_size_in) {
361 		info.ctx = memdup_user(ctx_in, ctx_size_in);
362 		if (IS_ERR(info.ctx))
363 			return PTR_ERR(info.ctx);
364 	} else {
365 		info.ctx = NULL;
366 	}
367 
368 	info.prog = prog;
369 
370 	current_cpu = get_cpu();
371 	if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 ||
372 	    cpu == current_cpu) {
373 		__bpf_prog_test_run_raw_tp(&info);
374 	} else if (cpu >= nr_cpu_ids || !cpu_online(cpu)) {
375 		/* smp_call_function_single() also checks cpu_online()
376 		 * after csd_lock(). However, since cpu is from user
377 		 * space, let's do an extra quick check to filter out
378 		 * invalid value before smp_call_function_single().
379 		 */
380 		err = -ENXIO;
381 	} else {
382 		err = smp_call_function_single(cpu, __bpf_prog_test_run_raw_tp,
383 					       &info, 1);
384 	}
385 	put_cpu();
386 
387 	if (!err &&
388 	    copy_to_user(&uattr->test.retval, &info.retval, sizeof(u32)))
389 		err = -EFAULT;
390 
391 	kfree(info.ctx);
392 	return err;
393 }
394 
395 static void *bpf_ctx_init(const union bpf_attr *kattr, u32 max_size)
396 {
397 	void __user *data_in = u64_to_user_ptr(kattr->test.ctx_in);
398 	void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out);
399 	u32 size = kattr->test.ctx_size_in;
400 	void *data;
401 	int err;
402 
403 	if (!data_in && !data_out)
404 		return NULL;
405 
406 	data = kzalloc(max_size, GFP_USER);
407 	if (!data)
408 		return ERR_PTR(-ENOMEM);
409 
410 	if (data_in) {
411 		err = bpf_check_uarg_tail_zero(USER_BPFPTR(data_in), max_size, size);
412 		if (err) {
413 			kfree(data);
414 			return ERR_PTR(err);
415 		}
416 
417 		size = min_t(u32, max_size, size);
418 		if (copy_from_user(data, data_in, size)) {
419 			kfree(data);
420 			return ERR_PTR(-EFAULT);
421 		}
422 	}
423 	return data;
424 }
425 
426 static int bpf_ctx_finish(const union bpf_attr *kattr,
427 			  union bpf_attr __user *uattr, const void *data,
428 			  u32 size)
429 {
430 	void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out);
431 	int err = -EFAULT;
432 	u32 copy_size = size;
433 
434 	if (!data || !data_out)
435 		return 0;
436 
437 	if (copy_size > kattr->test.ctx_size_out) {
438 		copy_size = kattr->test.ctx_size_out;
439 		err = -ENOSPC;
440 	}
441 
442 	if (copy_to_user(data_out, data, copy_size))
443 		goto out;
444 	if (copy_to_user(&uattr->test.ctx_size_out, &size, sizeof(size)))
445 		goto out;
446 	if (err != -ENOSPC)
447 		err = 0;
448 out:
449 	return err;
450 }
451 
452 /**
453  * range_is_zero - test whether buffer is initialized
454  * @buf: buffer to check
455  * @from: check from this position
456  * @to: check up until (excluding) this position
457  *
458  * This function returns true if the there is a non-zero byte
459  * in the buf in the range [from,to).
460  */
461 static inline bool range_is_zero(void *buf, size_t from, size_t to)
462 {
463 	return !memchr_inv((u8 *)buf + from, 0, to - from);
464 }
465 
466 static int convert___skb_to_skb(struct sk_buff *skb, struct __sk_buff *__skb)
467 {
468 	struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb;
469 
470 	if (!__skb)
471 		return 0;
472 
473 	/* make sure the fields we don't use are zeroed */
474 	if (!range_is_zero(__skb, 0, offsetof(struct __sk_buff, mark)))
475 		return -EINVAL;
476 
477 	/* mark is allowed */
478 
479 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, mark),
480 			   offsetof(struct __sk_buff, priority)))
481 		return -EINVAL;
482 
483 	/* priority is allowed */
484 	/* ingress_ifindex is allowed */
485 	/* ifindex is allowed */
486 
487 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, ifindex),
488 			   offsetof(struct __sk_buff, cb)))
489 		return -EINVAL;
490 
491 	/* cb is allowed */
492 
493 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, cb),
494 			   offsetof(struct __sk_buff, tstamp)))
495 		return -EINVAL;
496 
497 	/* tstamp is allowed */
498 	/* wire_len is allowed */
499 	/* gso_segs is allowed */
500 
501 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_segs),
502 			   offsetof(struct __sk_buff, gso_size)))
503 		return -EINVAL;
504 
505 	/* gso_size is allowed */
506 
507 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_size),
508 			   offsetof(struct __sk_buff, hwtstamp)))
509 		return -EINVAL;
510 
511 	/* hwtstamp is allowed */
512 
513 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, hwtstamp),
514 			   sizeof(struct __sk_buff)))
515 		return -EINVAL;
516 
517 	skb->mark = __skb->mark;
518 	skb->priority = __skb->priority;
519 	skb->skb_iif = __skb->ingress_ifindex;
520 	skb->tstamp = __skb->tstamp;
521 	memcpy(&cb->data, __skb->cb, QDISC_CB_PRIV_LEN);
522 
523 	if (__skb->wire_len == 0) {
524 		cb->pkt_len = skb->len;
525 	} else {
526 		if (__skb->wire_len < skb->len ||
527 		    __skb->wire_len > GSO_MAX_SIZE)
528 			return -EINVAL;
529 		cb->pkt_len = __skb->wire_len;
530 	}
531 
532 	if (__skb->gso_segs > GSO_MAX_SEGS)
533 		return -EINVAL;
534 	skb_shinfo(skb)->gso_segs = __skb->gso_segs;
535 	skb_shinfo(skb)->gso_size = __skb->gso_size;
536 	skb_shinfo(skb)->hwtstamps.hwtstamp = __skb->hwtstamp;
537 
538 	return 0;
539 }
540 
541 static void convert_skb_to___skb(struct sk_buff *skb, struct __sk_buff *__skb)
542 {
543 	struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb;
544 
545 	if (!__skb)
546 		return;
547 
548 	__skb->mark = skb->mark;
549 	__skb->priority = skb->priority;
550 	__skb->ingress_ifindex = skb->skb_iif;
551 	__skb->ifindex = skb->dev->ifindex;
552 	__skb->tstamp = skb->tstamp;
553 	memcpy(__skb->cb, &cb->data, QDISC_CB_PRIV_LEN);
554 	__skb->wire_len = cb->pkt_len;
555 	__skb->gso_segs = skb_shinfo(skb)->gso_segs;
556 	__skb->hwtstamp = skb_shinfo(skb)->hwtstamps.hwtstamp;
557 }
558 
559 static struct proto bpf_dummy_proto = {
560 	.name   = "bpf_dummy",
561 	.owner  = THIS_MODULE,
562 	.obj_size = sizeof(struct sock),
563 };
564 
565 int bpf_prog_test_run_skb(struct bpf_prog *prog, const union bpf_attr *kattr,
566 			  union bpf_attr __user *uattr)
567 {
568 	bool is_l2 = false, is_direct_pkt_access = false;
569 	struct net *net = current->nsproxy->net_ns;
570 	struct net_device *dev = net->loopback_dev;
571 	u32 size = kattr->test.data_size_in;
572 	u32 repeat = kattr->test.repeat;
573 	struct __sk_buff *ctx = NULL;
574 	u32 retval, duration;
575 	int hh_len = ETH_HLEN;
576 	struct sk_buff *skb;
577 	struct sock *sk;
578 	void *data;
579 	int ret;
580 
581 	if (kattr->test.flags || kattr->test.cpu)
582 		return -EINVAL;
583 
584 	data = bpf_test_init(kattr, size, NET_SKB_PAD + NET_IP_ALIGN,
585 			     SKB_DATA_ALIGN(sizeof(struct skb_shared_info)));
586 	if (IS_ERR(data))
587 		return PTR_ERR(data);
588 
589 	ctx = bpf_ctx_init(kattr, sizeof(struct __sk_buff));
590 	if (IS_ERR(ctx)) {
591 		kfree(data);
592 		return PTR_ERR(ctx);
593 	}
594 
595 	switch (prog->type) {
596 	case BPF_PROG_TYPE_SCHED_CLS:
597 	case BPF_PROG_TYPE_SCHED_ACT:
598 		is_l2 = true;
599 		fallthrough;
600 	case BPF_PROG_TYPE_LWT_IN:
601 	case BPF_PROG_TYPE_LWT_OUT:
602 	case BPF_PROG_TYPE_LWT_XMIT:
603 		is_direct_pkt_access = true;
604 		break;
605 	default:
606 		break;
607 	}
608 
609 	sk = sk_alloc(net, AF_UNSPEC, GFP_USER, &bpf_dummy_proto, 1);
610 	if (!sk) {
611 		kfree(data);
612 		kfree(ctx);
613 		return -ENOMEM;
614 	}
615 	sock_init_data(NULL, sk);
616 
617 	skb = build_skb(data, 0);
618 	if (!skb) {
619 		kfree(data);
620 		kfree(ctx);
621 		sk_free(sk);
622 		return -ENOMEM;
623 	}
624 	skb->sk = sk;
625 
626 	skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN);
627 	__skb_put(skb, size);
628 	if (ctx && ctx->ifindex > 1) {
629 		dev = dev_get_by_index(net, ctx->ifindex);
630 		if (!dev) {
631 			ret = -ENODEV;
632 			goto out;
633 		}
634 	}
635 	skb->protocol = eth_type_trans(skb, dev);
636 	skb_reset_network_header(skb);
637 
638 	switch (skb->protocol) {
639 	case htons(ETH_P_IP):
640 		sk->sk_family = AF_INET;
641 		if (sizeof(struct iphdr) <= skb_headlen(skb)) {
642 			sk->sk_rcv_saddr = ip_hdr(skb)->saddr;
643 			sk->sk_daddr = ip_hdr(skb)->daddr;
644 		}
645 		break;
646 #if IS_ENABLED(CONFIG_IPV6)
647 	case htons(ETH_P_IPV6):
648 		sk->sk_family = AF_INET6;
649 		if (sizeof(struct ipv6hdr) <= skb_headlen(skb)) {
650 			sk->sk_v6_rcv_saddr = ipv6_hdr(skb)->saddr;
651 			sk->sk_v6_daddr = ipv6_hdr(skb)->daddr;
652 		}
653 		break;
654 #endif
655 	default:
656 		break;
657 	}
658 
659 	if (is_l2)
660 		__skb_push(skb, hh_len);
661 	if (is_direct_pkt_access)
662 		bpf_compute_data_pointers(skb);
663 	ret = convert___skb_to_skb(skb, ctx);
664 	if (ret)
665 		goto out;
666 	ret = bpf_test_run(prog, skb, repeat, &retval, &duration, false);
667 	if (ret)
668 		goto out;
669 	if (!is_l2) {
670 		if (skb_headroom(skb) < hh_len) {
671 			int nhead = HH_DATA_ALIGN(hh_len - skb_headroom(skb));
672 
673 			if (pskb_expand_head(skb, nhead, 0, GFP_USER)) {
674 				ret = -ENOMEM;
675 				goto out;
676 			}
677 		}
678 		memset(__skb_push(skb, hh_len), 0, hh_len);
679 	}
680 	convert_skb_to___skb(skb, ctx);
681 
682 	size = skb->len;
683 	/* bpf program can never convert linear skb to non-linear */
684 	if (WARN_ON_ONCE(skb_is_nonlinear(skb)))
685 		size = skb_headlen(skb);
686 	ret = bpf_test_finish(kattr, uattr, skb->data, size, retval, duration);
687 	if (!ret)
688 		ret = bpf_ctx_finish(kattr, uattr, ctx,
689 				     sizeof(struct __sk_buff));
690 out:
691 	if (dev && dev != net->loopback_dev)
692 		dev_put(dev);
693 	kfree_skb(skb);
694 	sk_free(sk);
695 	kfree(ctx);
696 	return ret;
697 }
698 
699 static int xdp_convert_md_to_buff(struct xdp_md *xdp_md, struct xdp_buff *xdp)
700 {
701 	unsigned int ingress_ifindex, rx_queue_index;
702 	struct netdev_rx_queue *rxqueue;
703 	struct net_device *device;
704 
705 	if (!xdp_md)
706 		return 0;
707 
708 	if (xdp_md->egress_ifindex != 0)
709 		return -EINVAL;
710 
711 	ingress_ifindex = xdp_md->ingress_ifindex;
712 	rx_queue_index = xdp_md->rx_queue_index;
713 
714 	if (!ingress_ifindex && rx_queue_index)
715 		return -EINVAL;
716 
717 	if (ingress_ifindex) {
718 		device = dev_get_by_index(current->nsproxy->net_ns,
719 					  ingress_ifindex);
720 		if (!device)
721 			return -ENODEV;
722 
723 		if (rx_queue_index >= device->real_num_rx_queues)
724 			goto free_dev;
725 
726 		rxqueue = __netif_get_rx_queue(device, rx_queue_index);
727 
728 		if (!xdp_rxq_info_is_reg(&rxqueue->xdp_rxq))
729 			goto free_dev;
730 
731 		xdp->rxq = &rxqueue->xdp_rxq;
732 		/* The device is now tracked in the xdp->rxq for later
733 		 * dev_put()
734 		 */
735 	}
736 
737 	xdp->data = xdp->data_meta + xdp_md->data;
738 	return 0;
739 
740 free_dev:
741 	dev_put(device);
742 	return -EINVAL;
743 }
744 
745 static void xdp_convert_buff_to_md(struct xdp_buff *xdp, struct xdp_md *xdp_md)
746 {
747 	if (!xdp_md)
748 		return;
749 
750 	xdp_md->data = xdp->data - xdp->data_meta;
751 	xdp_md->data_end = xdp->data_end - xdp->data_meta;
752 
753 	if (xdp_md->ingress_ifindex)
754 		dev_put(xdp->rxq->dev);
755 }
756 
757 int bpf_prog_test_run_xdp(struct bpf_prog *prog, const union bpf_attr *kattr,
758 			  union bpf_attr __user *uattr)
759 {
760 	u32 tailroom = SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
761 	u32 headroom = XDP_PACKET_HEADROOM;
762 	u32 size = kattr->test.data_size_in;
763 	u32 repeat = kattr->test.repeat;
764 	struct netdev_rx_queue *rxqueue;
765 	struct xdp_buff xdp = {};
766 	u32 retval, duration;
767 	struct xdp_md *ctx;
768 	u32 max_data_sz;
769 	void *data;
770 	int ret = -EINVAL;
771 
772 	if (prog->expected_attach_type == BPF_XDP_DEVMAP ||
773 	    prog->expected_attach_type == BPF_XDP_CPUMAP)
774 		return -EINVAL;
775 
776 	ctx = bpf_ctx_init(kattr, sizeof(struct xdp_md));
777 	if (IS_ERR(ctx))
778 		return PTR_ERR(ctx);
779 
780 	if (ctx) {
781 		/* There can't be user provided data before the meta data */
782 		if (ctx->data_meta || ctx->data_end != size ||
783 		    ctx->data > ctx->data_end ||
784 		    unlikely(xdp_metalen_invalid(ctx->data)))
785 			goto free_ctx;
786 		/* Meta data is allocated from the headroom */
787 		headroom -= ctx->data;
788 	}
789 
790 	/* XDP have extra tailroom as (most) drivers use full page */
791 	max_data_sz = 4096 - headroom - tailroom;
792 
793 	data = bpf_test_init(kattr, max_data_sz, headroom, tailroom);
794 	if (IS_ERR(data)) {
795 		ret = PTR_ERR(data);
796 		goto free_ctx;
797 	}
798 
799 	rxqueue = __netif_get_rx_queue(current->nsproxy->net_ns->loopback_dev, 0);
800 	xdp_init_buff(&xdp, headroom + max_data_sz + tailroom,
801 		      &rxqueue->xdp_rxq);
802 	xdp_prepare_buff(&xdp, data, headroom, size, true);
803 
804 	ret = xdp_convert_md_to_buff(ctx, &xdp);
805 	if (ret)
806 		goto free_data;
807 
808 	if (repeat > 1)
809 		bpf_prog_change_xdp(NULL, prog);
810 	ret = bpf_test_run(prog, &xdp, repeat, &retval, &duration, true);
811 	/* We convert the xdp_buff back to an xdp_md before checking the return
812 	 * code so the reference count of any held netdevice will be decremented
813 	 * even if the test run failed.
814 	 */
815 	xdp_convert_buff_to_md(&xdp, ctx);
816 	if (ret)
817 		goto out;
818 
819 	if (xdp.data_meta != data + headroom ||
820 	    xdp.data_end != xdp.data_meta + size)
821 		size = xdp.data_end - xdp.data_meta;
822 
823 	ret = bpf_test_finish(kattr, uattr, xdp.data_meta, size, retval,
824 			      duration);
825 	if (!ret)
826 		ret = bpf_ctx_finish(kattr, uattr, ctx,
827 				     sizeof(struct xdp_md));
828 
829 out:
830 	if (repeat > 1)
831 		bpf_prog_change_xdp(prog, NULL);
832 free_data:
833 	kfree(data);
834 free_ctx:
835 	kfree(ctx);
836 	return ret;
837 }
838 
839 static int verify_user_bpf_flow_keys(struct bpf_flow_keys *ctx)
840 {
841 	/* make sure the fields we don't use are zeroed */
842 	if (!range_is_zero(ctx, 0, offsetof(struct bpf_flow_keys, flags)))
843 		return -EINVAL;
844 
845 	/* flags is allowed */
846 
847 	if (!range_is_zero(ctx, offsetofend(struct bpf_flow_keys, flags),
848 			   sizeof(struct bpf_flow_keys)))
849 		return -EINVAL;
850 
851 	return 0;
852 }
853 
854 int bpf_prog_test_run_flow_dissector(struct bpf_prog *prog,
855 				     const union bpf_attr *kattr,
856 				     union bpf_attr __user *uattr)
857 {
858 	struct bpf_test_timer t = { NO_PREEMPT };
859 	u32 size = kattr->test.data_size_in;
860 	struct bpf_flow_dissector ctx = {};
861 	u32 repeat = kattr->test.repeat;
862 	struct bpf_flow_keys *user_ctx;
863 	struct bpf_flow_keys flow_keys;
864 	const struct ethhdr *eth;
865 	unsigned int flags = 0;
866 	u32 retval, duration;
867 	void *data;
868 	int ret;
869 
870 	if (prog->type != BPF_PROG_TYPE_FLOW_DISSECTOR)
871 		return -EINVAL;
872 
873 	if (kattr->test.flags || kattr->test.cpu)
874 		return -EINVAL;
875 
876 	if (size < ETH_HLEN)
877 		return -EINVAL;
878 
879 	data = bpf_test_init(kattr, size, 0, 0);
880 	if (IS_ERR(data))
881 		return PTR_ERR(data);
882 
883 	eth = (struct ethhdr *)data;
884 
885 	if (!repeat)
886 		repeat = 1;
887 
888 	user_ctx = bpf_ctx_init(kattr, sizeof(struct bpf_flow_keys));
889 	if (IS_ERR(user_ctx)) {
890 		kfree(data);
891 		return PTR_ERR(user_ctx);
892 	}
893 	if (user_ctx) {
894 		ret = verify_user_bpf_flow_keys(user_ctx);
895 		if (ret)
896 			goto out;
897 		flags = user_ctx->flags;
898 	}
899 
900 	ctx.flow_keys = &flow_keys;
901 	ctx.data = data;
902 	ctx.data_end = (__u8 *)data + size;
903 
904 	bpf_test_timer_enter(&t);
905 	do {
906 		retval = bpf_flow_dissect(prog, &ctx, eth->h_proto, ETH_HLEN,
907 					  size, flags);
908 	} while (bpf_test_timer_continue(&t, repeat, &ret, &duration));
909 	bpf_test_timer_leave(&t);
910 
911 	if (ret < 0)
912 		goto out;
913 
914 	ret = bpf_test_finish(kattr, uattr, &flow_keys, sizeof(flow_keys),
915 			      retval, duration);
916 	if (!ret)
917 		ret = bpf_ctx_finish(kattr, uattr, user_ctx,
918 				     sizeof(struct bpf_flow_keys));
919 
920 out:
921 	kfree(user_ctx);
922 	kfree(data);
923 	return ret;
924 }
925 
926 int bpf_prog_test_run_sk_lookup(struct bpf_prog *prog, const union bpf_attr *kattr,
927 				union bpf_attr __user *uattr)
928 {
929 	struct bpf_test_timer t = { NO_PREEMPT };
930 	struct bpf_prog_array *progs = NULL;
931 	struct bpf_sk_lookup_kern ctx = {};
932 	u32 repeat = kattr->test.repeat;
933 	struct bpf_sk_lookup *user_ctx;
934 	u32 retval, duration;
935 	int ret = -EINVAL;
936 
937 	if (prog->type != BPF_PROG_TYPE_SK_LOOKUP)
938 		return -EINVAL;
939 
940 	if (kattr->test.flags || kattr->test.cpu)
941 		return -EINVAL;
942 
943 	if (kattr->test.data_in || kattr->test.data_size_in || kattr->test.data_out ||
944 	    kattr->test.data_size_out)
945 		return -EINVAL;
946 
947 	if (!repeat)
948 		repeat = 1;
949 
950 	user_ctx = bpf_ctx_init(kattr, sizeof(*user_ctx));
951 	if (IS_ERR(user_ctx))
952 		return PTR_ERR(user_ctx);
953 
954 	if (!user_ctx)
955 		return -EINVAL;
956 
957 	if (user_ctx->sk)
958 		goto out;
959 
960 	if (!range_is_zero(user_ctx, offsetofend(typeof(*user_ctx), local_port), sizeof(*user_ctx)))
961 		goto out;
962 
963 	if (user_ctx->local_port > U16_MAX || user_ctx->remote_port > U16_MAX) {
964 		ret = -ERANGE;
965 		goto out;
966 	}
967 
968 	ctx.family = (u16)user_ctx->family;
969 	ctx.protocol = (u16)user_ctx->protocol;
970 	ctx.dport = (u16)user_ctx->local_port;
971 	ctx.sport = (__force __be16)user_ctx->remote_port;
972 
973 	switch (ctx.family) {
974 	case AF_INET:
975 		ctx.v4.daddr = (__force __be32)user_ctx->local_ip4;
976 		ctx.v4.saddr = (__force __be32)user_ctx->remote_ip4;
977 		break;
978 
979 #if IS_ENABLED(CONFIG_IPV6)
980 	case AF_INET6:
981 		ctx.v6.daddr = (struct in6_addr *)user_ctx->local_ip6;
982 		ctx.v6.saddr = (struct in6_addr *)user_ctx->remote_ip6;
983 		break;
984 #endif
985 
986 	default:
987 		ret = -EAFNOSUPPORT;
988 		goto out;
989 	}
990 
991 	progs = bpf_prog_array_alloc(1, GFP_KERNEL);
992 	if (!progs) {
993 		ret = -ENOMEM;
994 		goto out;
995 	}
996 
997 	progs->items[0].prog = prog;
998 
999 	bpf_test_timer_enter(&t);
1000 	do {
1001 		ctx.selected_sk = NULL;
1002 		retval = BPF_PROG_SK_LOOKUP_RUN_ARRAY(progs, ctx, bpf_prog_run);
1003 	} while (bpf_test_timer_continue(&t, repeat, &ret, &duration));
1004 	bpf_test_timer_leave(&t);
1005 
1006 	if (ret < 0)
1007 		goto out;
1008 
1009 	user_ctx->cookie = 0;
1010 	if (ctx.selected_sk) {
1011 		if (ctx.selected_sk->sk_reuseport && !ctx.no_reuseport) {
1012 			ret = -EOPNOTSUPP;
1013 			goto out;
1014 		}
1015 
1016 		user_ctx->cookie = sock_gen_cookie(ctx.selected_sk);
1017 	}
1018 
1019 	ret = bpf_test_finish(kattr, uattr, NULL, 0, retval, duration);
1020 	if (!ret)
1021 		ret = bpf_ctx_finish(kattr, uattr, user_ctx, sizeof(*user_ctx));
1022 
1023 out:
1024 	bpf_prog_array_free(progs);
1025 	kfree(user_ctx);
1026 	return ret;
1027 }
1028 
1029 int bpf_prog_test_run_syscall(struct bpf_prog *prog,
1030 			      const union bpf_attr *kattr,
1031 			      union bpf_attr __user *uattr)
1032 {
1033 	void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in);
1034 	__u32 ctx_size_in = kattr->test.ctx_size_in;
1035 	void *ctx = NULL;
1036 	u32 retval;
1037 	int err = 0;
1038 
1039 	/* doesn't support data_in/out, ctx_out, duration, or repeat or flags */
1040 	if (kattr->test.data_in || kattr->test.data_out ||
1041 	    kattr->test.ctx_out || kattr->test.duration ||
1042 	    kattr->test.repeat || kattr->test.flags)
1043 		return -EINVAL;
1044 
1045 	if (ctx_size_in < prog->aux->max_ctx_offset ||
1046 	    ctx_size_in > U16_MAX)
1047 		return -EINVAL;
1048 
1049 	if (ctx_size_in) {
1050 		ctx = memdup_user(ctx_in, ctx_size_in);
1051 		if (IS_ERR(ctx))
1052 			return PTR_ERR(ctx);
1053 	}
1054 
1055 	rcu_read_lock_trace();
1056 	retval = bpf_prog_run_pin_on_cpu(prog, ctx);
1057 	rcu_read_unlock_trace();
1058 
1059 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(u32))) {
1060 		err = -EFAULT;
1061 		goto out;
1062 	}
1063 	if (ctx_size_in)
1064 		if (copy_to_user(ctx_in, ctx, ctx_size_in))
1065 			err = -EFAULT;
1066 out:
1067 	kfree(ctx);
1068 	return err;
1069 }
1070