xref: /openbmc/linux/net/bpf/test_run.c (revision 5e9cf77d81f9ba51019157dc55a3b73dc89a7cf4)
125763b3cSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
21cf1cae9SAlexei Starovoitov /* Copyright (c) 2017 Facebook
31cf1cae9SAlexei Starovoitov  */
41cf1cae9SAlexei Starovoitov #include <linux/bpf.h>
5c48e51c8SKumar Kartikeya Dwivedi #include <linux/btf.h>
67bd1590dSMartin KaFai Lau #include <linux/btf_ids.h>
71cf1cae9SAlexei Starovoitov #include <linux/slab.h>
8b202d844SKumar Kartikeya Dwivedi #include <linux/init.h>
91cf1cae9SAlexei Starovoitov #include <linux/vmalloc.h>
101cf1cae9SAlexei Starovoitov #include <linux/etherdevice.h>
111cf1cae9SAlexei Starovoitov #include <linux/filter.h>
1287b7b533SYonghong Song #include <linux/rcupdate_trace.h>
131cf1cae9SAlexei Starovoitov #include <linux/sched/signal.h>
146ac99e8fSMartin KaFai Lau #include <net/bpf_sk_storage.h>
152cb494a3SSong Liu #include <net/sock.h>
162cb494a3SSong Liu #include <net/tcp.h>
177c32e8f8SLorenz Bauer #include <net/net_namespace.h>
18b530e9e1SToke Høiland-Jørgensen #include <net/page_pool.h>
193d08b6f2SKP Singh #include <linux/error-injection.h>
201b4d60ecSSong Liu #include <linux/smp.h>
217c32e8f8SLorenz Bauer #include <linux/sock_diag.h>
222b99ef22SFlorian Westphal #include <linux/netfilter.h>
2347316f4aSZvi Effron #include <net/xdp.h>
242b99ef22SFlorian Westphal #include <net/netfilter/nf_bpf_link.h>
251cf1cae9SAlexei Starovoitov 
26e950e843SMatt Mullins #define CREATE_TRACE_POINTS
27e950e843SMatt Mullins #include <trace/events/bpf_test_run.h>
28e950e843SMatt Mullins 
29607b9cc9SLorenz Bauer struct bpf_test_timer {
30607b9cc9SLorenz Bauer 	enum { NO_PREEMPT, NO_MIGRATE } mode;
31607b9cc9SLorenz Bauer 	u32 i;
32607b9cc9SLorenz Bauer 	u64 time_start, time_spent;
33607b9cc9SLorenz Bauer };
34607b9cc9SLorenz Bauer 
35607b9cc9SLorenz Bauer static void bpf_test_timer_enter(struct bpf_test_timer *t)
36607b9cc9SLorenz Bauer 	__acquires(rcu)
37607b9cc9SLorenz Bauer {
38607b9cc9SLorenz Bauer 	rcu_read_lock();
39607b9cc9SLorenz Bauer 	if (t->mode == NO_PREEMPT)
40607b9cc9SLorenz Bauer 		preempt_disable();
41607b9cc9SLorenz Bauer 	else
42607b9cc9SLorenz Bauer 		migrate_disable();
43607b9cc9SLorenz Bauer 
44607b9cc9SLorenz Bauer 	t->time_start = ktime_get_ns();
45607b9cc9SLorenz Bauer }
46607b9cc9SLorenz Bauer 
47607b9cc9SLorenz Bauer static void bpf_test_timer_leave(struct bpf_test_timer *t)
48607b9cc9SLorenz Bauer 	__releases(rcu)
49607b9cc9SLorenz Bauer {
50607b9cc9SLorenz Bauer 	t->time_start = 0;
51607b9cc9SLorenz Bauer 
52607b9cc9SLorenz Bauer 	if (t->mode == NO_PREEMPT)
53607b9cc9SLorenz Bauer 		preempt_enable();
54607b9cc9SLorenz Bauer 	else
55607b9cc9SLorenz Bauer 		migrate_enable();
56607b9cc9SLorenz Bauer 	rcu_read_unlock();
57607b9cc9SLorenz Bauer }
58607b9cc9SLorenz Bauer 
59b530e9e1SToke Høiland-Jørgensen static bool bpf_test_timer_continue(struct bpf_test_timer *t, int iterations,
60b530e9e1SToke Høiland-Jørgensen 				    u32 repeat, int *err, u32 *duration)
61607b9cc9SLorenz Bauer 	__must_hold(rcu)
62607b9cc9SLorenz Bauer {
63b530e9e1SToke Høiland-Jørgensen 	t->i += iterations;
64607b9cc9SLorenz Bauer 	if (t->i >= repeat) {
65607b9cc9SLorenz Bauer 		/* We're done. */
66607b9cc9SLorenz Bauer 		t->time_spent += ktime_get_ns() - t->time_start;
67607b9cc9SLorenz Bauer 		do_div(t->time_spent, t->i);
68607b9cc9SLorenz Bauer 		*duration = t->time_spent > U32_MAX ? U32_MAX : (u32)t->time_spent;
69607b9cc9SLorenz Bauer 		*err = 0;
70607b9cc9SLorenz Bauer 		goto reset;
71607b9cc9SLorenz Bauer 	}
72607b9cc9SLorenz Bauer 
73607b9cc9SLorenz Bauer 	if (signal_pending(current)) {
74607b9cc9SLorenz Bauer 		/* During iteration: we've been cancelled, abort. */
75607b9cc9SLorenz Bauer 		*err = -EINTR;
76607b9cc9SLorenz Bauer 		goto reset;
77607b9cc9SLorenz Bauer 	}
78607b9cc9SLorenz Bauer 
79607b9cc9SLorenz Bauer 	if (need_resched()) {
80607b9cc9SLorenz Bauer 		/* During iteration: we need to reschedule between runs. */
81607b9cc9SLorenz Bauer 		t->time_spent += ktime_get_ns() - t->time_start;
82607b9cc9SLorenz Bauer 		bpf_test_timer_leave(t);
83607b9cc9SLorenz Bauer 		cond_resched();
84607b9cc9SLorenz Bauer 		bpf_test_timer_enter(t);
85607b9cc9SLorenz Bauer 	}
86607b9cc9SLorenz Bauer 
87607b9cc9SLorenz Bauer 	/* Do another round. */
88607b9cc9SLorenz Bauer 	return true;
89607b9cc9SLorenz Bauer 
90607b9cc9SLorenz Bauer reset:
91607b9cc9SLorenz Bauer 	t->i = 0;
92607b9cc9SLorenz Bauer 	return false;
93607b9cc9SLorenz Bauer }
94607b9cc9SLorenz Bauer 
95b530e9e1SToke Høiland-Jørgensen /* We put this struct at the head of each page with a context and frame
96b530e9e1SToke Høiland-Jørgensen  * initialised when the page is allocated, so we don't have to do this on each
97b530e9e1SToke Høiland-Jørgensen  * repetition of the test run.
98b530e9e1SToke Høiland-Jørgensen  */
99b530e9e1SToke Høiland-Jørgensen struct xdp_page_head {
100b530e9e1SToke Høiland-Jørgensen 	struct xdp_buff orig_ctx;
101b530e9e1SToke Høiland-Jørgensen 	struct xdp_buff ctx;
102294635a8SAlexander Lobakin 	union {
103294635a8SAlexander Lobakin 		/* ::data_hard_start starts here */
104294635a8SAlexander Lobakin 		DECLARE_FLEX_ARRAY(struct xdp_frame, frame);
105294635a8SAlexander Lobakin 		DECLARE_FLEX_ARRAY(u8, data);
106294635a8SAlexander Lobakin 	};
107b530e9e1SToke Høiland-Jørgensen };
108b530e9e1SToke Høiland-Jørgensen 
109b530e9e1SToke Høiland-Jørgensen struct xdp_test_data {
110b530e9e1SToke Høiland-Jørgensen 	struct xdp_buff *orig_ctx;
111b530e9e1SToke Høiland-Jørgensen 	struct xdp_rxq_info rxq;
112b530e9e1SToke Høiland-Jørgensen 	struct net_device *dev;
113b530e9e1SToke Høiland-Jørgensen 	struct page_pool *pp;
114b530e9e1SToke Høiland-Jørgensen 	struct xdp_frame **frames;
115b530e9e1SToke Høiland-Jørgensen 	struct sk_buff **skbs;
116425d2393SToke Høiland-Jørgensen 	struct xdp_mem_info mem;
117b530e9e1SToke Høiland-Jørgensen 	u32 batch_size;
118b530e9e1SToke Høiland-Jørgensen 	u32 frame_cnt;
119b530e9e1SToke Høiland-Jørgensen };
120b530e9e1SToke Høiland-Jørgensen 
121294635a8SAlexander Lobakin /* tools/testing/selftests/bpf/prog_tests/xdp_do_redirect.c:%MAX_PKT_SIZE
122294635a8SAlexander Lobakin  * must be updated accordingly this gets changed, otherwise BPF selftests
123294635a8SAlexander Lobakin  * will fail.
124294635a8SAlexander Lobakin  */
125b6f1f780SToke Høiland-Jørgensen #define TEST_XDP_FRAME_SIZE (PAGE_SIZE - sizeof(struct xdp_page_head))
126b530e9e1SToke Høiland-Jørgensen #define TEST_XDP_MAX_BATCH 256
127b530e9e1SToke Høiland-Jørgensen 
128b530e9e1SToke Høiland-Jørgensen static void xdp_test_run_init_page(struct page *page, void *arg)
129b530e9e1SToke Høiland-Jørgensen {
130b530e9e1SToke Høiland-Jørgensen 	struct xdp_page_head *head = phys_to_virt(page_to_phys(page));
131b530e9e1SToke Høiland-Jørgensen 	struct xdp_buff *new_ctx, *orig_ctx;
132b530e9e1SToke Høiland-Jørgensen 	u32 headroom = XDP_PACKET_HEADROOM;
133b530e9e1SToke Høiland-Jørgensen 	struct xdp_test_data *xdp = arg;
134b530e9e1SToke Høiland-Jørgensen 	size_t frm_len, meta_len;
135b530e9e1SToke Høiland-Jørgensen 	struct xdp_frame *frm;
136b530e9e1SToke Høiland-Jørgensen 	void *data;
137b530e9e1SToke Høiland-Jørgensen 
138b530e9e1SToke Høiland-Jørgensen 	orig_ctx = xdp->orig_ctx;
139b530e9e1SToke Høiland-Jørgensen 	frm_len = orig_ctx->data_end - orig_ctx->data_meta;
140b530e9e1SToke Høiland-Jørgensen 	meta_len = orig_ctx->data - orig_ctx->data_meta;
141b530e9e1SToke Høiland-Jørgensen 	headroom -= meta_len;
142b530e9e1SToke Høiland-Jørgensen 
143b530e9e1SToke Høiland-Jørgensen 	new_ctx = &head->ctx;
144294635a8SAlexander Lobakin 	frm = head->frame;
145294635a8SAlexander Lobakin 	data = head->data;
146b530e9e1SToke Høiland-Jørgensen 	memcpy(data + headroom, orig_ctx->data_meta, frm_len);
147b530e9e1SToke Høiland-Jørgensen 
148b530e9e1SToke Høiland-Jørgensen 	xdp_init_buff(new_ctx, TEST_XDP_FRAME_SIZE, &xdp->rxq);
149b530e9e1SToke Høiland-Jørgensen 	xdp_prepare_buff(new_ctx, data, headroom, frm_len, true);
150b530e9e1SToke Høiland-Jørgensen 	new_ctx->data = new_ctx->data_meta + meta_len;
151b530e9e1SToke Høiland-Jørgensen 
152b530e9e1SToke Høiland-Jørgensen 	xdp_update_frame_from_buff(new_ctx, frm);
153b530e9e1SToke Høiland-Jørgensen 	frm->mem = new_ctx->rxq->mem;
154b530e9e1SToke Høiland-Jørgensen 
155b530e9e1SToke Høiland-Jørgensen 	memcpy(&head->orig_ctx, new_ctx, sizeof(head->orig_ctx));
156b530e9e1SToke Høiland-Jørgensen }
157b530e9e1SToke Høiland-Jørgensen 
158b530e9e1SToke Høiland-Jørgensen static int xdp_test_run_setup(struct xdp_test_data *xdp, struct xdp_buff *orig_ctx)
159b530e9e1SToke Høiland-Jørgensen {
160b530e9e1SToke Høiland-Jørgensen 	struct page_pool *pp;
161b530e9e1SToke Høiland-Jørgensen 	int err = -ENOMEM;
162b530e9e1SToke Høiland-Jørgensen 	struct page_pool_params pp_params = {
163b530e9e1SToke Høiland-Jørgensen 		.order = 0,
164b530e9e1SToke Høiland-Jørgensen 		.flags = 0,
165b530e9e1SToke Høiland-Jørgensen 		.pool_size = xdp->batch_size,
166b530e9e1SToke Høiland-Jørgensen 		.nid = NUMA_NO_NODE,
167b530e9e1SToke Høiland-Jørgensen 		.init_callback = xdp_test_run_init_page,
168b530e9e1SToke Høiland-Jørgensen 		.init_arg = xdp,
169b530e9e1SToke Høiland-Jørgensen 	};
170b530e9e1SToke Høiland-Jørgensen 
171b530e9e1SToke Høiland-Jørgensen 	xdp->frames = kvmalloc_array(xdp->batch_size, sizeof(void *), GFP_KERNEL);
172b530e9e1SToke Høiland-Jørgensen 	if (!xdp->frames)
173b530e9e1SToke Høiland-Jørgensen 		return -ENOMEM;
174b530e9e1SToke Høiland-Jørgensen 
175b530e9e1SToke Høiland-Jørgensen 	xdp->skbs = kvmalloc_array(xdp->batch_size, sizeof(void *), GFP_KERNEL);
176b530e9e1SToke Høiland-Jørgensen 	if (!xdp->skbs)
177b530e9e1SToke Høiland-Jørgensen 		goto err_skbs;
178b530e9e1SToke Høiland-Jørgensen 
179b530e9e1SToke Høiland-Jørgensen 	pp = page_pool_create(&pp_params);
180b530e9e1SToke Høiland-Jørgensen 	if (IS_ERR(pp)) {
181b530e9e1SToke Høiland-Jørgensen 		err = PTR_ERR(pp);
182b530e9e1SToke Høiland-Jørgensen 		goto err_pp;
183b530e9e1SToke Høiland-Jørgensen 	}
184b530e9e1SToke Høiland-Jørgensen 
185b530e9e1SToke Høiland-Jørgensen 	/* will copy 'mem.id' into pp->xdp_mem_id */
186425d2393SToke Høiland-Jørgensen 	err = xdp_reg_mem_model(&xdp->mem, MEM_TYPE_PAGE_POOL, pp);
187b530e9e1SToke Høiland-Jørgensen 	if (err)
188b530e9e1SToke Høiland-Jørgensen 		goto err_mmodel;
189b530e9e1SToke Høiland-Jørgensen 
190b530e9e1SToke Høiland-Jørgensen 	xdp->pp = pp;
191b530e9e1SToke Høiland-Jørgensen 
192b530e9e1SToke Høiland-Jørgensen 	/* We create a 'fake' RXQ referencing the original dev, but with an
193b530e9e1SToke Høiland-Jørgensen 	 * xdp_mem_info pointing to our page_pool
194b530e9e1SToke Høiland-Jørgensen 	 */
195b530e9e1SToke Høiland-Jørgensen 	xdp_rxq_info_reg(&xdp->rxq, orig_ctx->rxq->dev, 0, 0);
196b530e9e1SToke Høiland-Jørgensen 	xdp->rxq.mem.type = MEM_TYPE_PAGE_POOL;
197b530e9e1SToke Høiland-Jørgensen 	xdp->rxq.mem.id = pp->xdp_mem_id;
198b530e9e1SToke Høiland-Jørgensen 	xdp->dev = orig_ctx->rxq->dev;
199b530e9e1SToke Høiland-Jørgensen 	xdp->orig_ctx = orig_ctx;
200b530e9e1SToke Høiland-Jørgensen 
201b530e9e1SToke Høiland-Jørgensen 	return 0;
202b530e9e1SToke Høiland-Jørgensen 
203b530e9e1SToke Høiland-Jørgensen err_mmodel:
204b530e9e1SToke Høiland-Jørgensen 	page_pool_destroy(pp);
205b530e9e1SToke Høiland-Jørgensen err_pp:
206743bec1bSYihao Han 	kvfree(xdp->skbs);
207b530e9e1SToke Høiland-Jørgensen err_skbs:
208743bec1bSYihao Han 	kvfree(xdp->frames);
209b530e9e1SToke Høiland-Jørgensen 	return err;
210b530e9e1SToke Høiland-Jørgensen }
211b530e9e1SToke Høiland-Jørgensen 
212b530e9e1SToke Høiland-Jørgensen static void xdp_test_run_teardown(struct xdp_test_data *xdp)
213b530e9e1SToke Høiland-Jørgensen {
214425d2393SToke Høiland-Jørgensen 	xdp_unreg_mem_model(&xdp->mem);
215b530e9e1SToke Høiland-Jørgensen 	page_pool_destroy(xdp->pp);
216b530e9e1SToke Høiland-Jørgensen 	kfree(xdp->frames);
217b530e9e1SToke Høiland-Jørgensen 	kfree(xdp->skbs);
218b530e9e1SToke Høiland-Jørgensen }
219b530e9e1SToke Høiland-Jørgensen 
220e5995bc7SAlexander Lobakin static bool frame_was_changed(const struct xdp_page_head *head)
221e5995bc7SAlexander Lobakin {
222e5995bc7SAlexander Lobakin 	/* xdp_scrub_frame() zeroes the data pointer, flags is the last field,
223e5995bc7SAlexander Lobakin 	 * i.e. has the highest chances to be overwritten. If those two are
224e5995bc7SAlexander Lobakin 	 * untouched, it's most likely safe to skip the context reset.
225e5995bc7SAlexander Lobakin 	 */
226c2865b11SJakub Kicinski 	return head->frame->data != head->orig_ctx.data ||
227c2865b11SJakub Kicinski 	       head->frame->flags != head->orig_ctx.flags;
228e5995bc7SAlexander Lobakin }
229e5995bc7SAlexander Lobakin 
230b530e9e1SToke Høiland-Jørgensen static bool ctx_was_changed(struct xdp_page_head *head)
231b530e9e1SToke Høiland-Jørgensen {
232b530e9e1SToke Høiland-Jørgensen 	return head->orig_ctx.data != head->ctx.data ||
233b530e9e1SToke Høiland-Jørgensen 		head->orig_ctx.data_meta != head->ctx.data_meta ||
234b530e9e1SToke Høiland-Jørgensen 		head->orig_ctx.data_end != head->ctx.data_end;
235b530e9e1SToke Høiland-Jørgensen }
236b530e9e1SToke Høiland-Jørgensen 
237b530e9e1SToke Høiland-Jørgensen static void reset_ctx(struct xdp_page_head *head)
238b530e9e1SToke Høiland-Jørgensen {
239e5995bc7SAlexander Lobakin 	if (likely(!frame_was_changed(head) && !ctx_was_changed(head)))
240b530e9e1SToke Høiland-Jørgensen 		return;
241b530e9e1SToke Høiland-Jørgensen 
242b530e9e1SToke Høiland-Jørgensen 	head->ctx.data = head->orig_ctx.data;
243b530e9e1SToke Høiland-Jørgensen 	head->ctx.data_meta = head->orig_ctx.data_meta;
244b530e9e1SToke Høiland-Jørgensen 	head->ctx.data_end = head->orig_ctx.data_end;
245294635a8SAlexander Lobakin 	xdp_update_frame_from_buff(&head->ctx, head->frame);
246b530e9e1SToke Høiland-Jørgensen }
247b530e9e1SToke Høiland-Jørgensen 
248b530e9e1SToke Høiland-Jørgensen static int xdp_recv_frames(struct xdp_frame **frames, int nframes,
249b530e9e1SToke Høiland-Jørgensen 			   struct sk_buff **skbs,
250b530e9e1SToke Høiland-Jørgensen 			   struct net_device *dev)
251b530e9e1SToke Høiland-Jørgensen {
252b530e9e1SToke Høiland-Jørgensen 	gfp_t gfp = __GFP_ZERO | GFP_ATOMIC;
253b530e9e1SToke Høiland-Jørgensen 	int i, n;
254b530e9e1SToke Høiland-Jørgensen 	LIST_HEAD(list);
255b530e9e1SToke Høiland-Jørgensen 
256025a785fSJakub Kicinski 	n = kmem_cache_alloc_bulk(skbuff_cache, gfp, nframes, (void **)skbs);
257b530e9e1SToke Høiland-Jørgensen 	if (unlikely(n == 0)) {
258b530e9e1SToke Høiland-Jørgensen 		for (i = 0; i < nframes; i++)
259b530e9e1SToke Høiland-Jørgensen 			xdp_return_frame(frames[i]);
260b530e9e1SToke Høiland-Jørgensen 		return -ENOMEM;
261b530e9e1SToke Høiland-Jørgensen 	}
262b530e9e1SToke Høiland-Jørgensen 
263b530e9e1SToke Høiland-Jørgensen 	for (i = 0; i < nframes; i++) {
264b530e9e1SToke Høiland-Jørgensen 		struct xdp_frame *xdpf = frames[i];
265b530e9e1SToke Høiland-Jørgensen 		struct sk_buff *skb = skbs[i];
266b530e9e1SToke Høiland-Jørgensen 
267b530e9e1SToke Høiland-Jørgensen 		skb = __xdp_build_skb_from_frame(xdpf, skb, dev);
268b530e9e1SToke Høiland-Jørgensen 		if (!skb) {
269b530e9e1SToke Høiland-Jørgensen 			xdp_return_frame(xdpf);
270b530e9e1SToke Høiland-Jørgensen 			continue;
271b530e9e1SToke Høiland-Jørgensen 		}
272b530e9e1SToke Høiland-Jørgensen 
273b530e9e1SToke Høiland-Jørgensen 		list_add_tail(&skb->list, &list);
274b530e9e1SToke Høiland-Jørgensen 	}
275b530e9e1SToke Høiland-Jørgensen 	netif_receive_skb_list(&list);
276b530e9e1SToke Høiland-Jørgensen 
277b530e9e1SToke Høiland-Jørgensen 	return 0;
278b530e9e1SToke Høiland-Jørgensen }
279b530e9e1SToke Høiland-Jørgensen 
280b530e9e1SToke Høiland-Jørgensen static int xdp_test_run_batch(struct xdp_test_data *xdp, struct bpf_prog *prog,
281b530e9e1SToke Høiland-Jørgensen 			      u32 repeat)
282b530e9e1SToke Høiland-Jørgensen {
283b530e9e1SToke Høiland-Jørgensen 	struct bpf_redirect_info *ri = this_cpu_ptr(&bpf_redirect_info);
284b530e9e1SToke Høiland-Jørgensen 	int err = 0, act, ret, i, nframes = 0, batch_sz;
285b530e9e1SToke Høiland-Jørgensen 	struct xdp_frame **frames = xdp->frames;
286b530e9e1SToke Høiland-Jørgensen 	struct xdp_page_head *head;
287b530e9e1SToke Høiland-Jørgensen 	struct xdp_frame *frm;
288b530e9e1SToke Høiland-Jørgensen 	bool redirect = false;
289b530e9e1SToke Høiland-Jørgensen 	struct xdp_buff *ctx;
290b530e9e1SToke Høiland-Jørgensen 	struct page *page;
291b530e9e1SToke Høiland-Jørgensen 
292b530e9e1SToke Høiland-Jørgensen 	batch_sz = min_t(u32, repeat, xdp->batch_size);
293b530e9e1SToke Høiland-Jørgensen 
294b530e9e1SToke Høiland-Jørgensen 	local_bh_disable();
295b530e9e1SToke Høiland-Jørgensen 	xdp_set_return_frame_no_direct();
296b530e9e1SToke Høiland-Jørgensen 
297b530e9e1SToke Høiland-Jørgensen 	for (i = 0; i < batch_sz; i++) {
298b530e9e1SToke Høiland-Jørgensen 		page = page_pool_dev_alloc_pages(xdp->pp);
299b530e9e1SToke Høiland-Jørgensen 		if (!page) {
300b530e9e1SToke Høiland-Jørgensen 			err = -ENOMEM;
301b530e9e1SToke Høiland-Jørgensen 			goto out;
302b530e9e1SToke Høiland-Jørgensen 		}
303b530e9e1SToke Høiland-Jørgensen 
304b530e9e1SToke Høiland-Jørgensen 		head = phys_to_virt(page_to_phys(page));
305b530e9e1SToke Høiland-Jørgensen 		reset_ctx(head);
306b530e9e1SToke Høiland-Jørgensen 		ctx = &head->ctx;
307294635a8SAlexander Lobakin 		frm = head->frame;
308b530e9e1SToke Høiland-Jørgensen 		xdp->frame_cnt++;
309b530e9e1SToke Høiland-Jørgensen 
310b530e9e1SToke Høiland-Jørgensen 		act = bpf_prog_run_xdp(prog, ctx);
311b530e9e1SToke Høiland-Jørgensen 
312b530e9e1SToke Høiland-Jørgensen 		/* if program changed pkt bounds we need to update the xdp_frame */
313b530e9e1SToke Høiland-Jørgensen 		if (unlikely(ctx_was_changed(head))) {
314b530e9e1SToke Høiland-Jørgensen 			ret = xdp_update_frame_from_buff(ctx, frm);
315b530e9e1SToke Høiland-Jørgensen 			if (ret) {
316b530e9e1SToke Høiland-Jørgensen 				xdp_return_buff(ctx);
317b530e9e1SToke Høiland-Jørgensen 				continue;
318b530e9e1SToke Høiland-Jørgensen 			}
319b530e9e1SToke Høiland-Jørgensen 		}
320b530e9e1SToke Høiland-Jørgensen 
321b530e9e1SToke Høiland-Jørgensen 		switch (act) {
322b530e9e1SToke Høiland-Jørgensen 		case XDP_TX:
323b530e9e1SToke Høiland-Jørgensen 			/* we can't do a real XDP_TX since we're not in the
324b530e9e1SToke Høiland-Jørgensen 			 * driver, so turn it into a REDIRECT back to the same
325b530e9e1SToke Høiland-Jørgensen 			 * index
326b530e9e1SToke Høiland-Jørgensen 			 */
327b530e9e1SToke Høiland-Jørgensen 			ri->tgt_index = xdp->dev->ifindex;
328b530e9e1SToke Høiland-Jørgensen 			ri->map_id = INT_MAX;
329b530e9e1SToke Høiland-Jørgensen 			ri->map_type = BPF_MAP_TYPE_UNSPEC;
330b530e9e1SToke Høiland-Jørgensen 			fallthrough;
331b530e9e1SToke Høiland-Jørgensen 		case XDP_REDIRECT:
332b530e9e1SToke Høiland-Jørgensen 			redirect = true;
333b530e9e1SToke Høiland-Jørgensen 			ret = xdp_do_redirect_frame(xdp->dev, ctx, frm, prog);
334b530e9e1SToke Høiland-Jørgensen 			if (ret)
335b530e9e1SToke Høiland-Jørgensen 				xdp_return_buff(ctx);
336b530e9e1SToke Høiland-Jørgensen 			break;
337b530e9e1SToke Høiland-Jørgensen 		case XDP_PASS:
338b530e9e1SToke Høiland-Jørgensen 			frames[nframes++] = frm;
339b530e9e1SToke Høiland-Jørgensen 			break;
340b530e9e1SToke Høiland-Jørgensen 		default:
341b530e9e1SToke Høiland-Jørgensen 			bpf_warn_invalid_xdp_action(NULL, prog, act);
342b530e9e1SToke Høiland-Jørgensen 			fallthrough;
343b530e9e1SToke Høiland-Jørgensen 		case XDP_DROP:
344b530e9e1SToke Høiland-Jørgensen 			xdp_return_buff(ctx);
345b530e9e1SToke Høiland-Jørgensen 			break;
346b530e9e1SToke Høiland-Jørgensen 		}
347b530e9e1SToke Høiland-Jørgensen 	}
348b530e9e1SToke Høiland-Jørgensen 
349b530e9e1SToke Høiland-Jørgensen out:
350b530e9e1SToke Høiland-Jørgensen 	if (redirect)
351b530e9e1SToke Høiland-Jørgensen 		xdp_do_flush();
352b530e9e1SToke Høiland-Jørgensen 	if (nframes) {
353b530e9e1SToke Høiland-Jørgensen 		ret = xdp_recv_frames(frames, nframes, xdp->skbs, xdp->dev);
354b530e9e1SToke Høiland-Jørgensen 		if (ret)
355b530e9e1SToke Høiland-Jørgensen 			err = ret;
356b530e9e1SToke Høiland-Jørgensen 	}
357b530e9e1SToke Høiland-Jørgensen 
358b530e9e1SToke Høiland-Jørgensen 	xdp_clear_return_frame_no_direct();
359b530e9e1SToke Høiland-Jørgensen 	local_bh_enable();
360b530e9e1SToke Høiland-Jørgensen 	return err;
361b530e9e1SToke Høiland-Jørgensen }
362b530e9e1SToke Høiland-Jørgensen 
363b530e9e1SToke Høiland-Jørgensen static int bpf_test_run_xdp_live(struct bpf_prog *prog, struct xdp_buff *ctx,
364b530e9e1SToke Høiland-Jørgensen 				 u32 repeat, u32 batch_size, u32 *time)
365b530e9e1SToke Høiland-Jørgensen 
366b530e9e1SToke Høiland-Jørgensen {
367b530e9e1SToke Høiland-Jørgensen 	struct xdp_test_data xdp = { .batch_size = batch_size };
368b530e9e1SToke Høiland-Jørgensen 	struct bpf_test_timer t = { .mode = NO_MIGRATE };
369b530e9e1SToke Høiland-Jørgensen 	int ret;
370b530e9e1SToke Høiland-Jørgensen 
371b530e9e1SToke Høiland-Jørgensen 	if (!repeat)
372b530e9e1SToke Høiland-Jørgensen 		repeat = 1;
373b530e9e1SToke Høiland-Jørgensen 
374b530e9e1SToke Høiland-Jørgensen 	ret = xdp_test_run_setup(&xdp, ctx);
375b530e9e1SToke Høiland-Jørgensen 	if (ret)
376b530e9e1SToke Høiland-Jørgensen 		return ret;
377b530e9e1SToke Høiland-Jørgensen 
378b530e9e1SToke Høiland-Jørgensen 	bpf_test_timer_enter(&t);
379b530e9e1SToke Høiland-Jørgensen 	do {
380b530e9e1SToke Høiland-Jørgensen 		xdp.frame_cnt = 0;
381b530e9e1SToke Høiland-Jørgensen 		ret = xdp_test_run_batch(&xdp, prog, repeat - t.i);
382b530e9e1SToke Høiland-Jørgensen 		if (unlikely(ret < 0))
383b530e9e1SToke Høiland-Jørgensen 			break;
384b530e9e1SToke Høiland-Jørgensen 	} while (bpf_test_timer_continue(&t, xdp.frame_cnt, repeat, &ret, time));
385b530e9e1SToke Høiland-Jørgensen 	bpf_test_timer_leave(&t);
386b530e9e1SToke Høiland-Jørgensen 
387b530e9e1SToke Høiland-Jørgensen 	xdp_test_run_teardown(&xdp);
388b530e9e1SToke Høiland-Jørgensen 	return ret;
389b530e9e1SToke Høiland-Jørgensen }
390b530e9e1SToke Høiland-Jørgensen 
391df1a2cb7SStanislav Fomichev static int bpf_test_run(struct bpf_prog *prog, void *ctx, u32 repeat,
392f23c4b39SBjörn Töpel 			u32 *retval, u32 *time, bool xdp)
3931cf1cae9SAlexei Starovoitov {
394c7603cfaSAndrii Nakryiko 	struct bpf_prog_array_item item = {.prog = prog};
395c7603cfaSAndrii Nakryiko 	struct bpf_run_ctx *old_ctx;
396c7603cfaSAndrii Nakryiko 	struct bpf_cg_run_ctx run_ctx;
397607b9cc9SLorenz Bauer 	struct bpf_test_timer t = { NO_MIGRATE };
3988bad74f9SRoman Gushchin 	enum bpf_cgroup_storage_type stype;
399607b9cc9SLorenz Bauer 	int ret;
4001cf1cae9SAlexei Starovoitov 
4018bad74f9SRoman Gushchin 	for_each_cgroup_storage_type(stype) {
402c7603cfaSAndrii Nakryiko 		item.cgroup_storage[stype] = bpf_cgroup_storage_alloc(prog, stype);
403c7603cfaSAndrii Nakryiko 		if (IS_ERR(item.cgroup_storage[stype])) {
404c7603cfaSAndrii Nakryiko 			item.cgroup_storage[stype] = NULL;
4058bad74f9SRoman Gushchin 			for_each_cgroup_storage_type(stype)
406c7603cfaSAndrii Nakryiko 				bpf_cgroup_storage_free(item.cgroup_storage[stype]);
4078bad74f9SRoman Gushchin 			return -ENOMEM;
4088bad74f9SRoman Gushchin 		}
4098bad74f9SRoman Gushchin 	}
410f42ee093SRoman Gushchin 
4111cf1cae9SAlexei Starovoitov 	if (!repeat)
4121cf1cae9SAlexei Starovoitov 		repeat = 1;
413df1a2cb7SStanislav Fomichev 
414607b9cc9SLorenz Bauer 	bpf_test_timer_enter(&t);
415c7603cfaSAndrii Nakryiko 	old_ctx = bpf_set_run_ctx(&run_ctx.run_ctx);
416607b9cc9SLorenz Bauer 	do {
417c7603cfaSAndrii Nakryiko 		run_ctx.prog_item = &item;
418af2d0d09SMartin KaFai Lau 		local_bh_disable();
419f23c4b39SBjörn Töpel 		if (xdp)
420f23c4b39SBjörn Töpel 			*retval = bpf_prog_run_xdp(prog, ctx);
421f23c4b39SBjörn Töpel 		else
422fb7dd8bcSAndrii Nakryiko 			*retval = bpf_prog_run(prog, ctx);
423af2d0d09SMartin KaFai Lau 		local_bh_enable();
424b530e9e1SToke Høiland-Jørgensen 	} while (bpf_test_timer_continue(&t, 1, repeat, &ret, time));
425c7603cfaSAndrii Nakryiko 	bpf_reset_run_ctx(old_ctx);
426607b9cc9SLorenz Bauer 	bpf_test_timer_leave(&t);
4271cf1cae9SAlexei Starovoitov 
4288bad74f9SRoman Gushchin 	for_each_cgroup_storage_type(stype)
429c7603cfaSAndrii Nakryiko 		bpf_cgroup_storage_free(item.cgroup_storage[stype]);
430f42ee093SRoman Gushchin 
431df1a2cb7SStanislav Fomichev 	return ret;
4321cf1cae9SAlexei Starovoitov }
4331cf1cae9SAlexei Starovoitov 
43478e52272SDavid Miller static int bpf_test_finish(const union bpf_attr *kattr,
43578e52272SDavid Miller 			   union bpf_attr __user *uattr, const void *data,
4367855e0dbSLorenzo Bianconi 			   struct skb_shared_info *sinfo, u32 size,
4377855e0dbSLorenzo Bianconi 			   u32 retval, u32 duration)
4381cf1cae9SAlexei Starovoitov {
43978e52272SDavid Miller 	void __user *data_out = u64_to_user_ptr(kattr->test.data_out);
4401cf1cae9SAlexei Starovoitov 	int err = -EFAULT;
441b5a36b1eSLorenz Bauer 	u32 copy_size = size;
4421cf1cae9SAlexei Starovoitov 
443b5a36b1eSLorenz Bauer 	/* Clamp copy if the user has provided a size hint, but copy the full
444b5a36b1eSLorenz Bauer 	 * buffer if not to retain old behaviour.
445b5a36b1eSLorenz Bauer 	 */
446b5a36b1eSLorenz Bauer 	if (kattr->test.data_size_out &&
447b5a36b1eSLorenz Bauer 	    copy_size > kattr->test.data_size_out) {
448b5a36b1eSLorenz Bauer 		copy_size = kattr->test.data_size_out;
449b5a36b1eSLorenz Bauer 		err = -ENOSPC;
450b5a36b1eSLorenz Bauer 	}
451b5a36b1eSLorenz Bauer 
4527855e0dbSLorenzo Bianconi 	if (data_out) {
4537855e0dbSLorenzo Bianconi 		int len = sinfo ? copy_size - sinfo->xdp_frags_size : copy_size;
4547855e0dbSLorenzo Bianconi 
455530e214cSStanislav Fomichev 		if (len < 0) {
456530e214cSStanislav Fomichev 			err = -ENOSPC;
457530e214cSStanislav Fomichev 			goto out;
458530e214cSStanislav Fomichev 		}
459530e214cSStanislav Fomichev 
4607855e0dbSLorenzo Bianconi 		if (copy_to_user(data_out, data, len))
4611cf1cae9SAlexei Starovoitov 			goto out;
4627855e0dbSLorenzo Bianconi 
4637855e0dbSLorenzo Bianconi 		if (sinfo) {
4645d1e9f43SStanislav Fomichev 			int i, offset = len;
4655d1e9f43SStanislav Fomichev 			u32 data_len;
4667855e0dbSLorenzo Bianconi 
4677855e0dbSLorenzo Bianconi 			for (i = 0; i < sinfo->nr_frags; i++) {
4687855e0dbSLorenzo Bianconi 				skb_frag_t *frag = &sinfo->frags[i];
4697855e0dbSLorenzo Bianconi 
4707855e0dbSLorenzo Bianconi 				if (offset >= copy_size) {
4717855e0dbSLorenzo Bianconi 					err = -ENOSPC;
4727855e0dbSLorenzo Bianconi 					break;
4737855e0dbSLorenzo Bianconi 				}
4747855e0dbSLorenzo Bianconi 
4755d1e9f43SStanislav Fomichev 				data_len = min_t(u32, copy_size - offset,
4767855e0dbSLorenzo Bianconi 						 skb_frag_size(frag));
4777855e0dbSLorenzo Bianconi 
4787855e0dbSLorenzo Bianconi 				if (copy_to_user(data_out + offset,
4797855e0dbSLorenzo Bianconi 						 skb_frag_address(frag),
4807855e0dbSLorenzo Bianconi 						 data_len))
4817855e0dbSLorenzo Bianconi 					goto out;
4827855e0dbSLorenzo Bianconi 
4837855e0dbSLorenzo Bianconi 				offset += data_len;
4847855e0dbSLorenzo Bianconi 			}
4857855e0dbSLorenzo Bianconi 		}
4867855e0dbSLorenzo Bianconi 	}
4877855e0dbSLorenzo Bianconi 
4881cf1cae9SAlexei Starovoitov 	if (copy_to_user(&uattr->test.data_size_out, &size, sizeof(size)))
4891cf1cae9SAlexei Starovoitov 		goto out;
4901cf1cae9SAlexei Starovoitov 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval)))
4911cf1cae9SAlexei Starovoitov 		goto out;
4921cf1cae9SAlexei Starovoitov 	if (copy_to_user(&uattr->test.duration, &duration, sizeof(duration)))
4931cf1cae9SAlexei Starovoitov 		goto out;
494b5a36b1eSLorenz Bauer 	if (err != -ENOSPC)
4951cf1cae9SAlexei Starovoitov 		err = 0;
4961cf1cae9SAlexei Starovoitov out:
497e950e843SMatt Mullins 	trace_bpf_test_finish(&err);
4981cf1cae9SAlexei Starovoitov 	return err;
4991cf1cae9SAlexei Starovoitov }
5001cf1cae9SAlexei Starovoitov 
501faeb2dceSAlexei Starovoitov /* Integer types of various sizes and pointer combinations cover variety of
502faeb2dceSAlexei Starovoitov  * architecture dependent calling conventions. 7+ can be supported in the
503faeb2dceSAlexei Starovoitov  * future.
504faeb2dceSAlexei Starovoitov  */
505e9ff9d52SJean-Philippe Menil __diag_push();
5060b206c6dSKumar Kartikeya Dwivedi __diag_ignore_all("-Wmissing-prototypes",
507e9ff9d52SJean-Philippe Menil 		  "Global functions as their definitions will be in vmlinux BTF");
508400031e0SDavid Vernet __bpf_kfunc int bpf_fentry_test1(int a)
509faeb2dceSAlexei Starovoitov {
510faeb2dceSAlexei Starovoitov 	return a + 1;
511faeb2dceSAlexei Starovoitov }
51246565696SKumar Kartikeya Dwivedi EXPORT_SYMBOL_GPL(bpf_fentry_test1);
513faeb2dceSAlexei Starovoitov 
514faeb2dceSAlexei Starovoitov int noinline bpf_fentry_test2(int a, u64 b)
515faeb2dceSAlexei Starovoitov {
516faeb2dceSAlexei Starovoitov 	return a + b;
517faeb2dceSAlexei Starovoitov }
518faeb2dceSAlexei Starovoitov 
519faeb2dceSAlexei Starovoitov int noinline bpf_fentry_test3(char a, int b, u64 c)
520faeb2dceSAlexei Starovoitov {
521faeb2dceSAlexei Starovoitov 	return a + b + c;
522faeb2dceSAlexei Starovoitov }
523faeb2dceSAlexei Starovoitov 
524faeb2dceSAlexei Starovoitov int noinline bpf_fentry_test4(void *a, char b, int c, u64 d)
525faeb2dceSAlexei Starovoitov {
526faeb2dceSAlexei Starovoitov 	return (long)a + b + c + d;
527faeb2dceSAlexei Starovoitov }
528faeb2dceSAlexei Starovoitov 
529faeb2dceSAlexei Starovoitov int noinline bpf_fentry_test5(u64 a, void *b, short c, int d, u64 e)
530faeb2dceSAlexei Starovoitov {
531faeb2dceSAlexei Starovoitov 	return a + (long)b + c + d + e;
532faeb2dceSAlexei Starovoitov }
533faeb2dceSAlexei Starovoitov 
534faeb2dceSAlexei Starovoitov int noinline bpf_fentry_test6(u64 a, void *b, short c, int d, void *e, u64 f)
535faeb2dceSAlexei Starovoitov {
536faeb2dceSAlexei Starovoitov 	return a + (long)b + c + d + (long)e + f;
537faeb2dceSAlexei Starovoitov }
538faeb2dceSAlexei Starovoitov 
539d923021cSYonghong Song struct bpf_fentry_test_t {
540d923021cSYonghong Song 	struct bpf_fentry_test_t *a;
541d923021cSYonghong Song };
542d923021cSYonghong Song 
543d923021cSYonghong Song int noinline bpf_fentry_test7(struct bpf_fentry_test_t *arg)
544d923021cSYonghong Song {
545d923021cSYonghong Song 	return (long)arg;
546d923021cSYonghong Song }
547d923021cSYonghong Song 
548d923021cSYonghong Song int noinline bpf_fentry_test8(struct bpf_fentry_test_t *arg)
549d923021cSYonghong Song {
550d923021cSYonghong Song 	return (long)arg->a;
551d923021cSYonghong Song }
552d923021cSYonghong Song 
55375dcef8dSFeng Zhou __bpf_kfunc u32 bpf_fentry_test9(u32 *a)
55475dcef8dSFeng Zhou {
55575dcef8dSFeng Zhou 	return *a;
55675dcef8dSFeng Zhou }
55775dcef8dSFeng Zhou 
5582597a25cSStanislav Fomichev void noinline bpf_fentry_test_sinfo(struct skb_shared_info *sinfo)
5592597a25cSStanislav Fomichev {
5602597a25cSStanislav Fomichev }
5612597a25cSStanislav Fomichev 
562400031e0SDavid Vernet __bpf_kfunc int bpf_modify_return_test(int a, int *b)
5633d08b6f2SKP Singh {
5643d08b6f2SKP Singh 	*b += 1;
5653d08b6f2SKP Singh 	return a + *b;
5663d08b6f2SKP Singh }
5677bd1590dSMartin KaFai Lau 
568*5e9cf77dSMenglong Dong __bpf_kfunc int bpf_modify_return_test2(int a, int *b, short c, int d,
569*5e9cf77dSMenglong Dong 					void *e, char f, int g)
570*5e9cf77dSMenglong Dong {
571*5e9cf77dSMenglong Dong 	*b += 1;
572*5e9cf77dSMenglong Dong 	return a + *b + c + d + (long)e + f + g;
573*5e9cf77dSMenglong Dong }
574*5e9cf77dSMenglong Dong 
575aa3d65deSViktor Malik int noinline bpf_fentry_shadow_test(int a)
576aa3d65deSViktor Malik {
577aa3d65deSViktor Malik 	return a + 1;
578aa3d65deSViktor Malik }
579aa3d65deSViktor Malik 
580792c0a34SKumar Kartikeya Dwivedi struct prog_test_member1 {
581792c0a34SKumar Kartikeya Dwivedi 	int a;
582792c0a34SKumar Kartikeya Dwivedi };
583792c0a34SKumar Kartikeya Dwivedi 
5848218ccb5SKumar Kartikeya Dwivedi struct prog_test_member {
585792c0a34SKumar Kartikeya Dwivedi 	struct prog_test_member1 m;
586792c0a34SKumar Kartikeya Dwivedi 	int c;
5878218ccb5SKumar Kartikeya Dwivedi };
5888218ccb5SKumar Kartikeya Dwivedi 
589c1ff181fSKumar Kartikeya Dwivedi struct prog_test_ref_kfunc {
590c1ff181fSKumar Kartikeya Dwivedi 	int a;
591c1ff181fSKumar Kartikeya Dwivedi 	int b;
5928218ccb5SKumar Kartikeya Dwivedi 	struct prog_test_member memb;
593c1ff181fSKumar Kartikeya Dwivedi 	struct prog_test_ref_kfunc *next;
5945cdccadcSKumar Kartikeya Dwivedi 	refcount_t cnt;
595c1ff181fSKumar Kartikeya Dwivedi };
596c1ff181fSKumar Kartikeya Dwivedi 
597400031e0SDavid Vernet __bpf_kfunc void bpf_kfunc_call_test_release(struct prog_test_ref_kfunc *p)
598c1ff181fSKumar Kartikeya Dwivedi {
5995cdccadcSKumar Kartikeya Dwivedi 	refcount_dec(&p->cnt);
600c1ff181fSKumar Kartikeya Dwivedi }
601c1ff181fSKumar Kartikeya Dwivedi 
602400031e0SDavid Vernet __bpf_kfunc void bpf_kfunc_call_memb_release(struct prog_test_member *p)
6038218ccb5SKumar Kartikeya Dwivedi {
6048218ccb5SKumar Kartikeya Dwivedi }
6058218ccb5SKumar Kartikeya Dwivedi 
606e9ff9d52SJean-Philippe Menil __diag_pop();
6073d08b6f2SKP Singh 
6085b481acaSBenjamin Tissoires BTF_SET8_START(bpf_test_modify_return_ids)
6095b481acaSBenjamin Tissoires BTF_ID_FLAGS(func, bpf_modify_return_test)
610*5e9cf77dSMenglong Dong BTF_ID_FLAGS(func, bpf_modify_return_test2)
6115b481acaSBenjamin Tissoires BTF_ID_FLAGS(func, bpf_fentry_test1, KF_SLEEPABLE)
6125b481acaSBenjamin Tissoires BTF_SET8_END(bpf_test_modify_return_ids)
6135b481acaSBenjamin Tissoires 
6145b481acaSBenjamin Tissoires static const struct btf_kfunc_id_set bpf_test_modify_return_set = {
6155b481acaSBenjamin Tissoires 	.owner = THIS_MODULE,
6165b481acaSBenjamin Tissoires 	.set   = &bpf_test_modify_return_ids,
6175b481acaSBenjamin Tissoires };
6183d08b6f2SKP Singh 
619a4703e31SKumar Kartikeya Dwivedi BTF_SET8_START(test_sk_check_kfunc_ids)
620a4703e31SKumar Kartikeya Dwivedi BTF_ID_FLAGS(func, bpf_kfunc_call_test_release, KF_RELEASE)
621a4703e31SKumar Kartikeya Dwivedi BTF_ID_FLAGS(func, bpf_kfunc_call_memb_release, KF_RELEASE)
622a4703e31SKumar Kartikeya Dwivedi BTF_SET8_END(test_sk_check_kfunc_ids)
62305a945deSKumar Kartikeya Dwivedi 
624be3d72a2SLorenzo Bianconi static void *bpf_test_init(const union bpf_attr *kattr, u32 user_size,
625be3d72a2SLorenzo Bianconi 			   u32 size, u32 headroom, u32 tailroom)
6261cf1cae9SAlexei Starovoitov {
6271cf1cae9SAlexei Starovoitov 	void __user *data_in = u64_to_user_ptr(kattr->test.data_in);
6281cf1cae9SAlexei Starovoitov 	void *data;
6291cf1cae9SAlexei Starovoitov 
6301cf1cae9SAlexei Starovoitov 	if (size < ETH_HLEN || size > PAGE_SIZE - headroom - tailroom)
6311cf1cae9SAlexei Starovoitov 		return ERR_PTR(-EINVAL);
6321cf1cae9SAlexei Starovoitov 
633d800bad6SJesper Dangaard Brouer 	if (user_size > size)
634d800bad6SJesper Dangaard Brouer 		return ERR_PTR(-EMSGSIZE);
635d800bad6SJesper Dangaard Brouer 
636d3fd203fSBaisong Zhong 	size = SKB_DATA_ALIGN(size);
6371cf1cae9SAlexei Starovoitov 	data = kzalloc(size + headroom + tailroom, GFP_USER);
6381cf1cae9SAlexei Starovoitov 	if (!data)
6391cf1cae9SAlexei Starovoitov 		return ERR_PTR(-ENOMEM);
6401cf1cae9SAlexei Starovoitov 
641d800bad6SJesper Dangaard Brouer 	if (copy_from_user(data + headroom, data_in, user_size)) {
6421cf1cae9SAlexei Starovoitov 		kfree(data);
6431cf1cae9SAlexei Starovoitov 		return ERR_PTR(-EFAULT);
6441cf1cae9SAlexei Starovoitov 	}
645da00d2f1SKP Singh 
646da00d2f1SKP Singh 	return data;
647da00d2f1SKP Singh }
648da00d2f1SKP Singh 
649da00d2f1SKP Singh int bpf_prog_test_run_tracing(struct bpf_prog *prog,
650da00d2f1SKP Singh 			      const union bpf_attr *kattr,
651da00d2f1SKP Singh 			      union bpf_attr __user *uattr)
652da00d2f1SKP Singh {
653d923021cSYonghong Song 	struct bpf_fentry_test_t arg = {};
6543d08b6f2SKP Singh 	u16 side_effect = 0, ret = 0;
6553d08b6f2SKP Singh 	int b = 2, err = -EFAULT;
6563d08b6f2SKP Singh 	u32 retval = 0;
657da00d2f1SKP Singh 
658b530e9e1SToke Høiland-Jørgensen 	if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size)
6591b4d60ecSSong Liu 		return -EINVAL;
6601b4d60ecSSong Liu 
661da00d2f1SKP Singh 	switch (prog->expected_attach_type) {
662da00d2f1SKP Singh 	case BPF_TRACE_FENTRY:
663da00d2f1SKP Singh 	case BPF_TRACE_FEXIT:
664faeb2dceSAlexei Starovoitov 		if (bpf_fentry_test1(1) != 2 ||
665faeb2dceSAlexei Starovoitov 		    bpf_fentry_test2(2, 3) != 5 ||
666faeb2dceSAlexei Starovoitov 		    bpf_fentry_test3(4, 5, 6) != 15 ||
667faeb2dceSAlexei Starovoitov 		    bpf_fentry_test4((void *)7, 8, 9, 10) != 34 ||
668faeb2dceSAlexei Starovoitov 		    bpf_fentry_test5(11, (void *)12, 13, 14, 15) != 65 ||
669d923021cSYonghong Song 		    bpf_fentry_test6(16, (void *)17, 18, 19, (void *)20, 21) != 111 ||
670d923021cSYonghong Song 		    bpf_fentry_test7((struct bpf_fentry_test_t *)0) != 0 ||
67175dcef8dSFeng Zhou 		    bpf_fentry_test8(&arg) != 0 ||
67275dcef8dSFeng Zhou 		    bpf_fentry_test9(&retval) != 0)
673da00d2f1SKP Singh 			goto out;
674da00d2f1SKP Singh 		break;
6753d08b6f2SKP Singh 	case BPF_MODIFY_RETURN:
6763d08b6f2SKP Singh 		ret = bpf_modify_return_test(1, &b);
6773d08b6f2SKP Singh 		if (b != 2)
678*5e9cf77dSMenglong Dong 			side_effect++;
679*5e9cf77dSMenglong Dong 		b = 2;
680*5e9cf77dSMenglong Dong 		ret += bpf_modify_return_test2(1, &b, 3, 4, (void *)5, 6, 7);
681*5e9cf77dSMenglong Dong 		if (b != 2)
682*5e9cf77dSMenglong Dong 			side_effect++;
6833d08b6f2SKP Singh 		break;
684da00d2f1SKP Singh 	default:
685da00d2f1SKP Singh 		goto out;
686a25ecd9dSColin Ian King 	}
687da00d2f1SKP Singh 
6883d08b6f2SKP Singh 	retval = ((u32)side_effect << 16) | ret;
6893d08b6f2SKP Singh 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval)))
6903d08b6f2SKP Singh 		goto out;
6913d08b6f2SKP Singh 
692da00d2f1SKP Singh 	err = 0;
693da00d2f1SKP Singh out:
694da00d2f1SKP Singh 	trace_bpf_test_finish(&err);
695da00d2f1SKP Singh 	return err;
6961cf1cae9SAlexei Starovoitov }
6971cf1cae9SAlexei Starovoitov 
6981b4d60ecSSong Liu struct bpf_raw_tp_test_run_info {
6991b4d60ecSSong Liu 	struct bpf_prog *prog;
7001b4d60ecSSong Liu 	void *ctx;
7011b4d60ecSSong Liu 	u32 retval;
7021b4d60ecSSong Liu };
7031b4d60ecSSong Liu 
7041b4d60ecSSong Liu static void
7051b4d60ecSSong Liu __bpf_prog_test_run_raw_tp(void *data)
7061b4d60ecSSong Liu {
7071b4d60ecSSong Liu 	struct bpf_raw_tp_test_run_info *info = data;
7081b4d60ecSSong Liu 
7091b4d60ecSSong Liu 	rcu_read_lock();
710fb7dd8bcSAndrii Nakryiko 	info->retval = bpf_prog_run(info->prog, info->ctx);
7111b4d60ecSSong Liu 	rcu_read_unlock();
7121b4d60ecSSong Liu }
7131b4d60ecSSong Liu 
7141b4d60ecSSong Liu int bpf_prog_test_run_raw_tp(struct bpf_prog *prog,
7151b4d60ecSSong Liu 			     const union bpf_attr *kattr,
7161b4d60ecSSong Liu 			     union bpf_attr __user *uattr)
7171b4d60ecSSong Liu {
7181b4d60ecSSong Liu 	void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in);
7191b4d60ecSSong Liu 	__u32 ctx_size_in = kattr->test.ctx_size_in;
7201b4d60ecSSong Liu 	struct bpf_raw_tp_test_run_info info;
7211b4d60ecSSong Liu 	int cpu = kattr->test.cpu, err = 0;
722963ec27aSSong Liu 	int current_cpu;
7231b4d60ecSSong Liu 
7241b4d60ecSSong Liu 	/* doesn't support data_in/out, ctx_out, duration, or repeat */
7251b4d60ecSSong Liu 	if (kattr->test.data_in || kattr->test.data_out ||
7261b4d60ecSSong Liu 	    kattr->test.ctx_out || kattr->test.duration ||
727b530e9e1SToke Høiland-Jørgensen 	    kattr->test.repeat || kattr->test.batch_size)
7281b4d60ecSSong Liu 		return -EINVAL;
7291b4d60ecSSong Liu 
7307ac6ad05SSong Liu 	if (ctx_size_in < prog->aux->max_ctx_offset ||
7317ac6ad05SSong Liu 	    ctx_size_in > MAX_BPF_FUNC_ARGS * sizeof(u64))
7321b4d60ecSSong Liu 		return -EINVAL;
7331b4d60ecSSong Liu 
7341b4d60ecSSong Liu 	if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 && cpu != 0)
7351b4d60ecSSong Liu 		return -EINVAL;
7361b4d60ecSSong Liu 
7371b4d60ecSSong Liu 	if (ctx_size_in) {
738db5b6a46SQing Wang 		info.ctx = memdup_user(ctx_in, ctx_size_in);
739db5b6a46SQing Wang 		if (IS_ERR(info.ctx))
740db5b6a46SQing Wang 			return PTR_ERR(info.ctx);
7411b4d60ecSSong Liu 	} else {
7421b4d60ecSSong Liu 		info.ctx = NULL;
7431b4d60ecSSong Liu 	}
7441b4d60ecSSong Liu 
7451b4d60ecSSong Liu 	info.prog = prog;
7461b4d60ecSSong Liu 
747963ec27aSSong Liu 	current_cpu = get_cpu();
7481b4d60ecSSong Liu 	if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 ||
749963ec27aSSong Liu 	    cpu == current_cpu) {
7501b4d60ecSSong Liu 		__bpf_prog_test_run_raw_tp(&info);
751963ec27aSSong Liu 	} else if (cpu >= nr_cpu_ids || !cpu_online(cpu)) {
7521b4d60ecSSong Liu 		/* smp_call_function_single() also checks cpu_online()
7531b4d60ecSSong Liu 		 * after csd_lock(). However, since cpu is from user
7541b4d60ecSSong Liu 		 * space, let's do an extra quick check to filter out
7551b4d60ecSSong Liu 		 * invalid value before smp_call_function_single().
7561b4d60ecSSong Liu 		 */
7571b4d60ecSSong Liu 		err = -ENXIO;
758963ec27aSSong Liu 	} else {
7591b4d60ecSSong Liu 		err = smp_call_function_single(cpu, __bpf_prog_test_run_raw_tp,
7601b4d60ecSSong Liu 					       &info, 1);
7611b4d60ecSSong Liu 	}
762963ec27aSSong Liu 	put_cpu();
7631b4d60ecSSong Liu 
764963ec27aSSong Liu 	if (!err &&
765963ec27aSSong Liu 	    copy_to_user(&uattr->test.retval, &info.retval, sizeof(u32)))
7661b4d60ecSSong Liu 		err = -EFAULT;
7671b4d60ecSSong Liu 
7681b4d60ecSSong Liu 	kfree(info.ctx);
7691b4d60ecSSong Liu 	return err;
7701b4d60ecSSong Liu }
7711b4d60ecSSong Liu 
772b0b9395dSStanislav Fomichev static void *bpf_ctx_init(const union bpf_attr *kattr, u32 max_size)
773b0b9395dSStanislav Fomichev {
774b0b9395dSStanislav Fomichev 	void __user *data_in = u64_to_user_ptr(kattr->test.ctx_in);
775b0b9395dSStanislav Fomichev 	void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out);
776b0b9395dSStanislav Fomichev 	u32 size = kattr->test.ctx_size_in;
777b0b9395dSStanislav Fomichev 	void *data;
778b0b9395dSStanislav Fomichev 	int err;
779b0b9395dSStanislav Fomichev 
780b0b9395dSStanislav Fomichev 	if (!data_in && !data_out)
781b0b9395dSStanislav Fomichev 		return NULL;
782b0b9395dSStanislav Fomichev 
783b0b9395dSStanislav Fomichev 	data = kzalloc(max_size, GFP_USER);
784b0b9395dSStanislav Fomichev 	if (!data)
785b0b9395dSStanislav Fomichev 		return ERR_PTR(-ENOMEM);
786b0b9395dSStanislav Fomichev 
787b0b9395dSStanislav Fomichev 	if (data_in) {
788af2ac3e1SAlexei Starovoitov 		err = bpf_check_uarg_tail_zero(USER_BPFPTR(data_in), max_size, size);
789b0b9395dSStanislav Fomichev 		if (err) {
790b0b9395dSStanislav Fomichev 			kfree(data);
791b0b9395dSStanislav Fomichev 			return ERR_PTR(err);
792b0b9395dSStanislav Fomichev 		}
793b0b9395dSStanislav Fomichev 
794b0b9395dSStanislav Fomichev 		size = min_t(u32, max_size, size);
795b0b9395dSStanislav Fomichev 		if (copy_from_user(data, data_in, size)) {
796b0b9395dSStanislav Fomichev 			kfree(data);
797b0b9395dSStanislav Fomichev 			return ERR_PTR(-EFAULT);
798b0b9395dSStanislav Fomichev 		}
799b0b9395dSStanislav Fomichev 	}
800b0b9395dSStanislav Fomichev 	return data;
801b0b9395dSStanislav Fomichev }
802b0b9395dSStanislav Fomichev 
803b0b9395dSStanislav Fomichev static int bpf_ctx_finish(const union bpf_attr *kattr,
804b0b9395dSStanislav Fomichev 			  union bpf_attr __user *uattr, const void *data,
805b0b9395dSStanislav Fomichev 			  u32 size)
806b0b9395dSStanislav Fomichev {
807b0b9395dSStanislav Fomichev 	void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out);
808b0b9395dSStanislav Fomichev 	int err = -EFAULT;
809b0b9395dSStanislav Fomichev 	u32 copy_size = size;
810b0b9395dSStanislav Fomichev 
811b0b9395dSStanislav Fomichev 	if (!data || !data_out)
812b0b9395dSStanislav Fomichev 		return 0;
813b0b9395dSStanislav Fomichev 
814b0b9395dSStanislav Fomichev 	if (copy_size > kattr->test.ctx_size_out) {
815b0b9395dSStanislav Fomichev 		copy_size = kattr->test.ctx_size_out;
816b0b9395dSStanislav Fomichev 		err = -ENOSPC;
817b0b9395dSStanislav Fomichev 	}
818b0b9395dSStanislav Fomichev 
819b0b9395dSStanislav Fomichev 	if (copy_to_user(data_out, data, copy_size))
820b0b9395dSStanislav Fomichev 		goto out;
821b0b9395dSStanislav Fomichev 	if (copy_to_user(&uattr->test.ctx_size_out, &size, sizeof(size)))
822b0b9395dSStanislav Fomichev 		goto out;
823b0b9395dSStanislav Fomichev 	if (err != -ENOSPC)
824b0b9395dSStanislav Fomichev 		err = 0;
825b0b9395dSStanislav Fomichev out:
826b0b9395dSStanislav Fomichev 	return err;
827b0b9395dSStanislav Fomichev }
828b0b9395dSStanislav Fomichev 
829b0b9395dSStanislav Fomichev /**
830b0b9395dSStanislav Fomichev  * range_is_zero - test whether buffer is initialized
831b0b9395dSStanislav Fomichev  * @buf: buffer to check
832b0b9395dSStanislav Fomichev  * @from: check from this position
833b0b9395dSStanislav Fomichev  * @to: check up until (excluding) this position
834b0b9395dSStanislav Fomichev  *
835b0b9395dSStanislav Fomichev  * This function returns true if the there is a non-zero byte
836b0b9395dSStanislav Fomichev  * in the buf in the range [from,to).
837b0b9395dSStanislav Fomichev  */
838b0b9395dSStanislav Fomichev static inline bool range_is_zero(void *buf, size_t from, size_t to)
839b0b9395dSStanislav Fomichev {
840b0b9395dSStanislav Fomichev 	return !memchr_inv((u8 *)buf + from, 0, to - from);
841b0b9395dSStanislav Fomichev }
842b0b9395dSStanislav Fomichev 
843b0b9395dSStanislav Fomichev static int convert___skb_to_skb(struct sk_buff *skb, struct __sk_buff *__skb)
844b0b9395dSStanislav Fomichev {
845b0b9395dSStanislav Fomichev 	struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb;
846b0b9395dSStanislav Fomichev 
847b0b9395dSStanislav Fomichev 	if (!__skb)
848b0b9395dSStanislav Fomichev 		return 0;
849b0b9395dSStanislav Fomichev 
850b0b9395dSStanislav Fomichev 	/* make sure the fields we don't use are zeroed */
8516de6c1f8SNikita V. Shirokov 	if (!range_is_zero(__skb, 0, offsetof(struct __sk_buff, mark)))
8526de6c1f8SNikita V. Shirokov 		return -EINVAL;
8536de6c1f8SNikita V. Shirokov 
8546de6c1f8SNikita V. Shirokov 	/* mark is allowed */
8556de6c1f8SNikita V. Shirokov 
8566de6c1f8SNikita V. Shirokov 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, mark),
8576de6c1f8SNikita V. Shirokov 			   offsetof(struct __sk_buff, priority)))
858b0b9395dSStanislav Fomichev 		return -EINVAL;
859b0b9395dSStanislav Fomichev 
860b0b9395dSStanislav Fomichev 	/* priority is allowed */
861b238290bSNeil Spring 	/* ingress_ifindex is allowed */
86221594c44SDmitry Yakunin 	/* ifindex is allowed */
86321594c44SDmitry Yakunin 
86421594c44SDmitry Yakunin 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, ifindex),
865b0b9395dSStanislav Fomichev 			   offsetof(struct __sk_buff, cb)))
866b0b9395dSStanislav Fomichev 		return -EINVAL;
867b0b9395dSStanislav Fomichev 
868b0b9395dSStanislav Fomichev 	/* cb is allowed */
869b0b9395dSStanislav Fomichev 
870b590cb5fSStanislav Fomichev 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, cb),
871ba940948SStanislav Fomichev 			   offsetof(struct __sk_buff, tstamp)))
872ba940948SStanislav Fomichev 		return -EINVAL;
873ba940948SStanislav Fomichev 
874ba940948SStanislav Fomichev 	/* tstamp is allowed */
875850a88ccSStanislav Fomichev 	/* wire_len is allowed */
876850a88ccSStanislav Fomichev 	/* gso_segs is allowed */
877ba940948SStanislav Fomichev 
878850a88ccSStanislav Fomichev 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_segs),
879cf62089bSWillem de Bruijn 			   offsetof(struct __sk_buff, gso_size)))
880cf62089bSWillem de Bruijn 		return -EINVAL;
881cf62089bSWillem de Bruijn 
882cf62089bSWillem de Bruijn 	/* gso_size is allowed */
883cf62089bSWillem de Bruijn 
884cf62089bSWillem de Bruijn 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_size),
8853384c7c7SVadim Fedorenko 			   offsetof(struct __sk_buff, hwtstamp)))
8863384c7c7SVadim Fedorenko 		return -EINVAL;
8873384c7c7SVadim Fedorenko 
8883384c7c7SVadim Fedorenko 	/* hwtstamp is allowed */
8893384c7c7SVadim Fedorenko 
8903384c7c7SVadim Fedorenko 	if (!range_is_zero(__skb, offsetofend(struct __sk_buff, hwtstamp),
891b0b9395dSStanislav Fomichev 			   sizeof(struct __sk_buff)))
892b0b9395dSStanislav Fomichev 		return -EINVAL;
893b0b9395dSStanislav Fomichev 
8946de6c1f8SNikita V. Shirokov 	skb->mark = __skb->mark;
895b0b9395dSStanislav Fomichev 	skb->priority = __skb->priority;
896b238290bSNeil Spring 	skb->skb_iif = __skb->ingress_ifindex;
897ba940948SStanislav Fomichev 	skb->tstamp = __skb->tstamp;
898b0b9395dSStanislav Fomichev 	memcpy(&cb->data, __skb->cb, QDISC_CB_PRIV_LEN);
899b0b9395dSStanislav Fomichev 
900850a88ccSStanislav Fomichev 	if (__skb->wire_len == 0) {
901850a88ccSStanislav Fomichev 		cb->pkt_len = skb->len;
902850a88ccSStanislav Fomichev 	} else {
903850a88ccSStanislav Fomichev 		if (__skb->wire_len < skb->len ||
9047c4e983cSAlexander Duyck 		    __skb->wire_len > GSO_LEGACY_MAX_SIZE)
905850a88ccSStanislav Fomichev 			return -EINVAL;
906850a88ccSStanislav Fomichev 		cb->pkt_len = __skb->wire_len;
907850a88ccSStanislav Fomichev 	}
908850a88ccSStanislav Fomichev 
909850a88ccSStanislav Fomichev 	if (__skb->gso_segs > GSO_MAX_SEGS)
910850a88ccSStanislav Fomichev 		return -EINVAL;
911850a88ccSStanislav Fomichev 	skb_shinfo(skb)->gso_segs = __skb->gso_segs;
912cf62089bSWillem de Bruijn 	skb_shinfo(skb)->gso_size = __skb->gso_size;
9133384c7c7SVadim Fedorenko 	skb_shinfo(skb)->hwtstamps.hwtstamp = __skb->hwtstamp;
914850a88ccSStanislav Fomichev 
915b0b9395dSStanislav Fomichev 	return 0;
916b0b9395dSStanislav Fomichev }
917b0b9395dSStanislav Fomichev 
918b0b9395dSStanislav Fomichev static void convert_skb_to___skb(struct sk_buff *skb, struct __sk_buff *__skb)
919b0b9395dSStanislav Fomichev {
920b0b9395dSStanislav Fomichev 	struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb;
921b0b9395dSStanislav Fomichev 
922b0b9395dSStanislav Fomichev 	if (!__skb)
923b0b9395dSStanislav Fomichev 		return;
924b0b9395dSStanislav Fomichev 
9256de6c1f8SNikita V. Shirokov 	__skb->mark = skb->mark;
926b0b9395dSStanislav Fomichev 	__skb->priority = skb->priority;
927b238290bSNeil Spring 	__skb->ingress_ifindex = skb->skb_iif;
92821594c44SDmitry Yakunin 	__skb->ifindex = skb->dev->ifindex;
929ba940948SStanislav Fomichev 	__skb->tstamp = skb->tstamp;
930b0b9395dSStanislav Fomichev 	memcpy(__skb->cb, &cb->data, QDISC_CB_PRIV_LEN);
931850a88ccSStanislav Fomichev 	__skb->wire_len = cb->pkt_len;
932850a88ccSStanislav Fomichev 	__skb->gso_segs = skb_shinfo(skb)->gso_segs;
9333384c7c7SVadim Fedorenko 	__skb->hwtstamp = skb_shinfo(skb)->hwtstamps.hwtstamp;
934b0b9395dSStanislav Fomichev }
935b0b9395dSStanislav Fomichev 
936435b08ecSDaniel Borkmann static struct proto bpf_dummy_proto = {
937435b08ecSDaniel Borkmann 	.name   = "bpf_dummy",
938435b08ecSDaniel Borkmann 	.owner  = THIS_MODULE,
939435b08ecSDaniel Borkmann 	.obj_size = sizeof(struct sock),
940435b08ecSDaniel Borkmann };
941435b08ecSDaniel Borkmann 
9421cf1cae9SAlexei Starovoitov int bpf_prog_test_run_skb(struct bpf_prog *prog, const union bpf_attr *kattr,
9431cf1cae9SAlexei Starovoitov 			  union bpf_attr __user *uattr)
9441cf1cae9SAlexei Starovoitov {
9451cf1cae9SAlexei Starovoitov 	bool is_l2 = false, is_direct_pkt_access = false;
94621594c44SDmitry Yakunin 	struct net *net = current->nsproxy->net_ns;
94721594c44SDmitry Yakunin 	struct net_device *dev = net->loopback_dev;
9481cf1cae9SAlexei Starovoitov 	u32 size = kattr->test.data_size_in;
9491cf1cae9SAlexei Starovoitov 	u32 repeat = kattr->test.repeat;
950b0b9395dSStanislav Fomichev 	struct __sk_buff *ctx = NULL;
9511cf1cae9SAlexei Starovoitov 	u32 retval, duration;
9526e6fddc7SDaniel Borkmann 	int hh_len = ETH_HLEN;
9531cf1cae9SAlexei Starovoitov 	struct sk_buff *skb;
9542cb494a3SSong Liu 	struct sock *sk;
9551cf1cae9SAlexei Starovoitov 	void *data;
9561cf1cae9SAlexei Starovoitov 	int ret;
9571cf1cae9SAlexei Starovoitov 
958b530e9e1SToke Høiland-Jørgensen 	if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size)
9591b4d60ecSSong Liu 		return -EINVAL;
9601b4d60ecSSong Liu 
961be3d72a2SLorenzo Bianconi 	data = bpf_test_init(kattr, kattr->test.data_size_in,
962be3d72a2SLorenzo Bianconi 			     size, NET_SKB_PAD + NET_IP_ALIGN,
9631cf1cae9SAlexei Starovoitov 			     SKB_DATA_ALIGN(sizeof(struct skb_shared_info)));
9641cf1cae9SAlexei Starovoitov 	if (IS_ERR(data))
9651cf1cae9SAlexei Starovoitov 		return PTR_ERR(data);
9661cf1cae9SAlexei Starovoitov 
967b0b9395dSStanislav Fomichev 	ctx = bpf_ctx_init(kattr, sizeof(struct __sk_buff));
968b0b9395dSStanislav Fomichev 	if (IS_ERR(ctx)) {
969b0b9395dSStanislav Fomichev 		kfree(data);
970b0b9395dSStanislav Fomichev 		return PTR_ERR(ctx);
971b0b9395dSStanislav Fomichev 	}
972b0b9395dSStanislav Fomichev 
9731cf1cae9SAlexei Starovoitov 	switch (prog->type) {
9741cf1cae9SAlexei Starovoitov 	case BPF_PROG_TYPE_SCHED_CLS:
9751cf1cae9SAlexei Starovoitov 	case BPF_PROG_TYPE_SCHED_ACT:
9761cf1cae9SAlexei Starovoitov 		is_l2 = true;
977df561f66SGustavo A. R. Silva 		fallthrough;
9781cf1cae9SAlexei Starovoitov 	case BPF_PROG_TYPE_LWT_IN:
9791cf1cae9SAlexei Starovoitov 	case BPF_PROG_TYPE_LWT_OUT:
9801cf1cae9SAlexei Starovoitov 	case BPF_PROG_TYPE_LWT_XMIT:
9811cf1cae9SAlexei Starovoitov 		is_direct_pkt_access = true;
9821cf1cae9SAlexei Starovoitov 		break;
9831cf1cae9SAlexei Starovoitov 	default:
9841cf1cae9SAlexei Starovoitov 		break;
9851cf1cae9SAlexei Starovoitov 	}
9861cf1cae9SAlexei Starovoitov 
987435b08ecSDaniel Borkmann 	sk = sk_alloc(net, AF_UNSPEC, GFP_USER, &bpf_dummy_proto, 1);
9882cb494a3SSong Liu 	if (!sk) {
9891cf1cae9SAlexei Starovoitov 		kfree(data);
990b0b9395dSStanislav Fomichev 		kfree(ctx);
9911cf1cae9SAlexei Starovoitov 		return -ENOMEM;
9921cf1cae9SAlexei Starovoitov 	}
9932cb494a3SSong Liu 	sock_init_data(NULL, sk);
9942cb494a3SSong Liu 
995ce098da1SKees Cook 	skb = slab_build_skb(data);
9962cb494a3SSong Liu 	if (!skb) {
9972cb494a3SSong Liu 		kfree(data);
998b0b9395dSStanislav Fomichev 		kfree(ctx);
999435b08ecSDaniel Borkmann 		sk_free(sk);
10002cb494a3SSong Liu 		return -ENOMEM;
10012cb494a3SSong Liu 	}
10022cb494a3SSong Liu 	skb->sk = sk;
10031cf1cae9SAlexei Starovoitov 
1004586f8525SDavid Miller 	skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN);
10051cf1cae9SAlexei Starovoitov 	__skb_put(skb, size);
100621594c44SDmitry Yakunin 	if (ctx && ctx->ifindex > 1) {
100721594c44SDmitry Yakunin 		dev = dev_get_by_index(net, ctx->ifindex);
100821594c44SDmitry Yakunin 		if (!dev) {
100921594c44SDmitry Yakunin 			ret = -ENODEV;
101021594c44SDmitry Yakunin 			goto out;
101121594c44SDmitry Yakunin 		}
101221594c44SDmitry Yakunin 	}
101321594c44SDmitry Yakunin 	skb->protocol = eth_type_trans(skb, dev);
10141cf1cae9SAlexei Starovoitov 	skb_reset_network_header(skb);
10151cf1cae9SAlexei Starovoitov 
1016fa5cb548SDmitry Yakunin 	switch (skb->protocol) {
1017fa5cb548SDmitry Yakunin 	case htons(ETH_P_IP):
1018fa5cb548SDmitry Yakunin 		sk->sk_family = AF_INET;
1019fa5cb548SDmitry Yakunin 		if (sizeof(struct iphdr) <= skb_headlen(skb)) {
1020fa5cb548SDmitry Yakunin 			sk->sk_rcv_saddr = ip_hdr(skb)->saddr;
1021fa5cb548SDmitry Yakunin 			sk->sk_daddr = ip_hdr(skb)->daddr;
1022fa5cb548SDmitry Yakunin 		}
1023fa5cb548SDmitry Yakunin 		break;
1024fa5cb548SDmitry Yakunin #if IS_ENABLED(CONFIG_IPV6)
1025fa5cb548SDmitry Yakunin 	case htons(ETH_P_IPV6):
1026fa5cb548SDmitry Yakunin 		sk->sk_family = AF_INET6;
1027fa5cb548SDmitry Yakunin 		if (sizeof(struct ipv6hdr) <= skb_headlen(skb)) {
1028fa5cb548SDmitry Yakunin 			sk->sk_v6_rcv_saddr = ipv6_hdr(skb)->saddr;
1029fa5cb548SDmitry Yakunin 			sk->sk_v6_daddr = ipv6_hdr(skb)->daddr;
1030fa5cb548SDmitry Yakunin 		}
1031fa5cb548SDmitry Yakunin 		break;
1032fa5cb548SDmitry Yakunin #endif
1033fa5cb548SDmitry Yakunin 	default:
1034fa5cb548SDmitry Yakunin 		break;
1035fa5cb548SDmitry Yakunin 	}
1036fa5cb548SDmitry Yakunin 
10371cf1cae9SAlexei Starovoitov 	if (is_l2)
10386e6fddc7SDaniel Borkmann 		__skb_push(skb, hh_len);
10391cf1cae9SAlexei Starovoitov 	if (is_direct_pkt_access)
10406aaae2b6SDaniel Borkmann 		bpf_compute_data_pointers(skb);
1041b0b9395dSStanislav Fomichev 	ret = convert___skb_to_skb(skb, ctx);
1042b0b9395dSStanislav Fomichev 	if (ret)
1043b0b9395dSStanislav Fomichev 		goto out;
1044f23c4b39SBjörn Töpel 	ret = bpf_test_run(prog, skb, repeat, &retval, &duration, false);
1045b0b9395dSStanislav Fomichev 	if (ret)
1046b0b9395dSStanislav Fomichev 		goto out;
10476e6fddc7SDaniel Borkmann 	if (!is_l2) {
10486e6fddc7SDaniel Borkmann 		if (skb_headroom(skb) < hh_len) {
10496e6fddc7SDaniel Borkmann 			int nhead = HH_DATA_ALIGN(hh_len - skb_headroom(skb));
10506e6fddc7SDaniel Borkmann 
10516e6fddc7SDaniel Borkmann 			if (pskb_expand_head(skb, nhead, 0, GFP_USER)) {
1052b0b9395dSStanislav Fomichev 				ret = -ENOMEM;
1053b0b9395dSStanislav Fomichev 				goto out;
10546e6fddc7SDaniel Borkmann 			}
10556e6fddc7SDaniel Borkmann 		}
10566e6fddc7SDaniel Borkmann 		memset(__skb_push(skb, hh_len), 0, hh_len);
10576e6fddc7SDaniel Borkmann 	}
1058b0b9395dSStanislav Fomichev 	convert_skb_to___skb(skb, ctx);
10596e6fddc7SDaniel Borkmann 
10601cf1cae9SAlexei Starovoitov 	size = skb->len;
10611cf1cae9SAlexei Starovoitov 	/* bpf program can never convert linear skb to non-linear */
10621cf1cae9SAlexei Starovoitov 	if (WARN_ON_ONCE(skb_is_nonlinear(skb)))
10631cf1cae9SAlexei Starovoitov 		size = skb_headlen(skb);
10647855e0dbSLorenzo Bianconi 	ret = bpf_test_finish(kattr, uattr, skb->data, NULL, size, retval,
10657855e0dbSLorenzo Bianconi 			      duration);
1066b0b9395dSStanislav Fomichev 	if (!ret)
1067b0b9395dSStanislav Fomichev 		ret = bpf_ctx_finish(kattr, uattr, ctx,
1068b0b9395dSStanislav Fomichev 				     sizeof(struct __sk_buff));
1069b0b9395dSStanislav Fomichev out:
107021594c44SDmitry Yakunin 	if (dev && dev != net->loopback_dev)
107121594c44SDmitry Yakunin 		dev_put(dev);
10721cf1cae9SAlexei Starovoitov 	kfree_skb(skb);
1073435b08ecSDaniel Borkmann 	sk_free(sk);
1074b0b9395dSStanislav Fomichev 	kfree(ctx);
10751cf1cae9SAlexei Starovoitov 	return ret;
10761cf1cae9SAlexei Starovoitov }
10771cf1cae9SAlexei Starovoitov 
107847316f4aSZvi Effron static int xdp_convert_md_to_buff(struct xdp_md *xdp_md, struct xdp_buff *xdp)
107947316f4aSZvi Effron {
1080ec94670fSZvi Effron 	unsigned int ingress_ifindex, rx_queue_index;
1081ec94670fSZvi Effron 	struct netdev_rx_queue *rxqueue;
1082ec94670fSZvi Effron 	struct net_device *device;
1083ec94670fSZvi Effron 
108447316f4aSZvi Effron 	if (!xdp_md)
108547316f4aSZvi Effron 		return 0;
108647316f4aSZvi Effron 
108747316f4aSZvi Effron 	if (xdp_md->egress_ifindex != 0)
108847316f4aSZvi Effron 		return -EINVAL;
108947316f4aSZvi Effron 
1090ec94670fSZvi Effron 	ingress_ifindex = xdp_md->ingress_ifindex;
1091ec94670fSZvi Effron 	rx_queue_index = xdp_md->rx_queue_index;
1092ec94670fSZvi Effron 
1093ec94670fSZvi Effron 	if (!ingress_ifindex && rx_queue_index)
109447316f4aSZvi Effron 		return -EINVAL;
109547316f4aSZvi Effron 
1096ec94670fSZvi Effron 	if (ingress_ifindex) {
1097ec94670fSZvi Effron 		device = dev_get_by_index(current->nsproxy->net_ns,
1098ec94670fSZvi Effron 					  ingress_ifindex);
1099ec94670fSZvi Effron 		if (!device)
1100ec94670fSZvi Effron 			return -ENODEV;
110147316f4aSZvi Effron 
1102ec94670fSZvi Effron 		if (rx_queue_index >= device->real_num_rx_queues)
1103ec94670fSZvi Effron 			goto free_dev;
1104ec94670fSZvi Effron 
1105ec94670fSZvi Effron 		rxqueue = __netif_get_rx_queue(device, rx_queue_index);
1106ec94670fSZvi Effron 
1107ec94670fSZvi Effron 		if (!xdp_rxq_info_is_reg(&rxqueue->xdp_rxq))
1108ec94670fSZvi Effron 			goto free_dev;
1109ec94670fSZvi Effron 
1110ec94670fSZvi Effron 		xdp->rxq = &rxqueue->xdp_rxq;
1111ec94670fSZvi Effron 		/* The device is now tracked in the xdp->rxq for later
1112ec94670fSZvi Effron 		 * dev_put()
1113ec94670fSZvi Effron 		 */
1114ec94670fSZvi Effron 	}
1115ec94670fSZvi Effron 
1116ec94670fSZvi Effron 	xdp->data = xdp->data_meta + xdp_md->data;
111747316f4aSZvi Effron 	return 0;
1118ec94670fSZvi Effron 
1119ec94670fSZvi Effron free_dev:
1120ec94670fSZvi Effron 	dev_put(device);
1121ec94670fSZvi Effron 	return -EINVAL;
1122ec94670fSZvi Effron }
1123ec94670fSZvi Effron 
1124ec94670fSZvi Effron static void xdp_convert_buff_to_md(struct xdp_buff *xdp, struct xdp_md *xdp_md)
1125ec94670fSZvi Effron {
1126ec94670fSZvi Effron 	if (!xdp_md)
1127ec94670fSZvi Effron 		return;
1128ec94670fSZvi Effron 
1129ec94670fSZvi Effron 	xdp_md->data = xdp->data - xdp->data_meta;
1130ec94670fSZvi Effron 	xdp_md->data_end = xdp->data_end - xdp->data_meta;
1131ec94670fSZvi Effron 
1132ec94670fSZvi Effron 	if (xdp_md->ingress_ifindex)
1133ec94670fSZvi Effron 		dev_put(xdp->rxq->dev);
113447316f4aSZvi Effron }
113547316f4aSZvi Effron 
11361cf1cae9SAlexei Starovoitov int bpf_prog_test_run_xdp(struct bpf_prog *prog, const union bpf_attr *kattr,
11371cf1cae9SAlexei Starovoitov 			  union bpf_attr __user *uattr)
11381cf1cae9SAlexei Starovoitov {
1139b530e9e1SToke Høiland-Jørgensen 	bool do_live = (kattr->test.flags & BPF_F_TEST_XDP_LIVE_FRAMES);
1140bc56c919SJesper Dangaard Brouer 	u32 tailroom = SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
1141b530e9e1SToke Høiland-Jørgensen 	u32 batch_size = kattr->test.batch_size;
1142eecbfd97SToke Høiland-Jørgensen 	u32 retval = 0, duration, max_data_sz;
11431cf1cae9SAlexei Starovoitov 	u32 size = kattr->test.data_size_in;
11441c194998SLorenzo Bianconi 	u32 headroom = XDP_PACKET_HEADROOM;
11451cf1cae9SAlexei Starovoitov 	u32 repeat = kattr->test.repeat;
114665073a67SDaniel Borkmann 	struct netdev_rx_queue *rxqueue;
11471c194998SLorenzo Bianconi 	struct skb_shared_info *sinfo;
11481cf1cae9SAlexei Starovoitov 	struct xdp_buff xdp = {};
11491c194998SLorenzo Bianconi 	int i, ret = -EINVAL;
115047316f4aSZvi Effron 	struct xdp_md *ctx;
11511cf1cae9SAlexei Starovoitov 	void *data;
11521cf1cae9SAlexei Starovoitov 
11535e21bb4eSXuan Zhuo 	if (prog->expected_attach_type == BPF_XDP_DEVMAP ||
11545e21bb4eSXuan Zhuo 	    prog->expected_attach_type == BPF_XDP_CPUMAP)
11555e21bb4eSXuan Zhuo 		return -EINVAL;
11566d4eb36dSAndrii Nakryiko 
1157b530e9e1SToke Høiland-Jørgensen 	if (kattr->test.flags & ~BPF_F_TEST_XDP_LIVE_FRAMES)
1158b530e9e1SToke Høiland-Jørgensen 		return -EINVAL;
1159b530e9e1SToke Høiland-Jørgensen 
11603d76a4d3SStanislav Fomichev 	if (bpf_prog_is_dev_bound(prog->aux))
11613d76a4d3SStanislav Fomichev 		return -EINVAL;
11623d76a4d3SStanislav Fomichev 
1163b530e9e1SToke Høiland-Jørgensen 	if (do_live) {
1164b530e9e1SToke Høiland-Jørgensen 		if (!batch_size)
1165b530e9e1SToke Høiland-Jørgensen 			batch_size = NAPI_POLL_WEIGHT;
1166b530e9e1SToke Høiland-Jørgensen 		else if (batch_size > TEST_XDP_MAX_BATCH)
1167b530e9e1SToke Høiland-Jørgensen 			return -E2BIG;
1168b6f1f780SToke Høiland-Jørgensen 
1169b6f1f780SToke Høiland-Jørgensen 		headroom += sizeof(struct xdp_page_head);
1170b530e9e1SToke Høiland-Jørgensen 	} else if (batch_size) {
1171b530e9e1SToke Høiland-Jørgensen 		return -EINVAL;
1172b530e9e1SToke Høiland-Jørgensen 	}
1173b530e9e1SToke Høiland-Jørgensen 
117447316f4aSZvi Effron 	ctx = bpf_ctx_init(kattr, sizeof(struct xdp_md));
117547316f4aSZvi Effron 	if (IS_ERR(ctx))
117647316f4aSZvi Effron 		return PTR_ERR(ctx);
117747316f4aSZvi Effron 
117847316f4aSZvi Effron 	if (ctx) {
117947316f4aSZvi Effron 		/* There can't be user provided data before the meta data */
118047316f4aSZvi Effron 		if (ctx->data_meta || ctx->data_end != size ||
118147316f4aSZvi Effron 		    ctx->data > ctx->data_end ||
1182b530e9e1SToke Høiland-Jørgensen 		    unlikely(xdp_metalen_invalid(ctx->data)) ||
1183b530e9e1SToke Høiland-Jørgensen 		    (do_live && (kattr->test.data_out || kattr->test.ctx_out)))
118447316f4aSZvi Effron 			goto free_ctx;
118547316f4aSZvi Effron 		/* Meta data is allocated from the headroom */
118647316f4aSZvi Effron 		headroom -= ctx->data;
118747316f4aSZvi Effron 	}
1188947e8b59SStanislav Fomichev 
1189bc56c919SJesper Dangaard Brouer 	max_data_sz = 4096 - headroom - tailroom;
1190b530e9e1SToke Høiland-Jørgensen 	if (size > max_data_sz) {
1191b530e9e1SToke Høiland-Jørgensen 		/* disallow live data mode for jumbo frames */
1192b530e9e1SToke Høiland-Jørgensen 		if (do_live)
1193b530e9e1SToke Høiland-Jørgensen 			goto free_ctx;
1194b530e9e1SToke Høiland-Jørgensen 		size = max_data_sz;
1195b530e9e1SToke Høiland-Jørgensen 	}
1196bc56c919SJesper Dangaard Brouer 
11971c194998SLorenzo Bianconi 	data = bpf_test_init(kattr, size, max_data_sz, headroom, tailroom);
119847316f4aSZvi Effron 	if (IS_ERR(data)) {
119947316f4aSZvi Effron 		ret = PTR_ERR(data);
120047316f4aSZvi Effron 		goto free_ctx;
120147316f4aSZvi Effron 	}
12021cf1cae9SAlexei Starovoitov 
120365073a67SDaniel Borkmann 	rxqueue = __netif_get_rx_queue(current->nsproxy->net_ns->loopback_dev, 0);
12041c194998SLorenzo Bianconi 	rxqueue->xdp_rxq.frag_size = headroom + max_data_sz + tailroom;
12051c194998SLorenzo Bianconi 	xdp_init_buff(&xdp, rxqueue->xdp_rxq.frag_size, &rxqueue->xdp_rxq);
1206be9df4afSLorenzo Bianconi 	xdp_prepare_buff(&xdp, data, headroom, size, true);
12071c194998SLorenzo Bianconi 	sinfo = xdp_get_shared_info_from_buff(&xdp);
1208be9df4afSLorenzo Bianconi 
120947316f4aSZvi Effron 	ret = xdp_convert_md_to_buff(ctx, &xdp);
121047316f4aSZvi Effron 	if (ret)
121147316f4aSZvi Effron 		goto free_data;
121247316f4aSZvi Effron 
12131c194998SLorenzo Bianconi 	if (unlikely(kattr->test.data_size_in > size)) {
12141c194998SLorenzo Bianconi 		void __user *data_in = u64_to_user_ptr(kattr->test.data_in);
12151c194998SLorenzo Bianconi 
12161c194998SLorenzo Bianconi 		while (size < kattr->test.data_size_in) {
12171c194998SLorenzo Bianconi 			struct page *page;
12181c194998SLorenzo Bianconi 			skb_frag_t *frag;
12199d63b59dSStanislav Fomichev 			u32 data_len;
12201c194998SLorenzo Bianconi 
1221a6763080SLorenzo Bianconi 			if (sinfo->nr_frags == MAX_SKB_FRAGS) {
1222a6763080SLorenzo Bianconi 				ret = -ENOMEM;
1223a6763080SLorenzo Bianconi 				goto out;
1224a6763080SLorenzo Bianconi 			}
1225a6763080SLorenzo Bianconi 
12261c194998SLorenzo Bianconi 			page = alloc_page(GFP_KERNEL);
12271c194998SLorenzo Bianconi 			if (!page) {
12281c194998SLorenzo Bianconi 				ret = -ENOMEM;
12291c194998SLorenzo Bianconi 				goto out;
12301c194998SLorenzo Bianconi 			}
12311c194998SLorenzo Bianconi 
12321c194998SLorenzo Bianconi 			frag = &sinfo->frags[sinfo->nr_frags++];
12331c194998SLorenzo Bianconi 
12349d63b59dSStanislav Fomichev 			data_len = min_t(u32, kattr->test.data_size_in - size,
12351c194998SLorenzo Bianconi 					 PAGE_SIZE);
1236b51f4113SYunsheng Lin 			skb_frag_fill_page_desc(frag, page, 0, data_len);
12371c194998SLorenzo Bianconi 
12381c194998SLorenzo Bianconi 			if (copy_from_user(page_address(page), data_in + size,
12391c194998SLorenzo Bianconi 					   data_len)) {
12401c194998SLorenzo Bianconi 				ret = -EFAULT;
12411c194998SLorenzo Bianconi 				goto out;
12421c194998SLorenzo Bianconi 			}
12431c194998SLorenzo Bianconi 			sinfo->xdp_frags_size += data_len;
12441c194998SLorenzo Bianconi 			size += data_len;
12451c194998SLorenzo Bianconi 		}
12461c194998SLorenzo Bianconi 		xdp_buff_set_frags_flag(&xdp);
12471c194998SLorenzo Bianconi 	}
12481c194998SLorenzo Bianconi 
1249de21d8bfSLorenz Bauer 	if (repeat > 1)
1250f23c4b39SBjörn Töpel 		bpf_prog_change_xdp(NULL, prog);
12511c194998SLorenzo Bianconi 
1252b530e9e1SToke Høiland-Jørgensen 	if (do_live)
1253b530e9e1SToke Høiland-Jørgensen 		ret = bpf_test_run_xdp_live(prog, &xdp, repeat, batch_size, &duration);
1254b530e9e1SToke Høiland-Jørgensen 	else
1255f23c4b39SBjörn Töpel 		ret = bpf_test_run(prog, &xdp, repeat, &retval, &duration, true);
1256ec94670fSZvi Effron 	/* We convert the xdp_buff back to an xdp_md before checking the return
1257ec94670fSZvi Effron 	 * code so the reference count of any held netdevice will be decremented
1258ec94670fSZvi Effron 	 * even if the test run failed.
1259ec94670fSZvi Effron 	 */
1260ec94670fSZvi Effron 	xdp_convert_buff_to_md(&xdp, ctx);
1261dcb40590SRoman Gushchin 	if (ret)
1262dcb40590SRoman Gushchin 		goto out;
126347316f4aSZvi Effron 
12641c194998SLorenzo Bianconi 	size = xdp.data_end - xdp.data_meta + sinfo->xdp_frags_size;
12657855e0dbSLorenzo Bianconi 	ret = bpf_test_finish(kattr, uattr, xdp.data_meta, sinfo, size,
12667855e0dbSLorenzo Bianconi 			      retval, duration);
126747316f4aSZvi Effron 	if (!ret)
126847316f4aSZvi Effron 		ret = bpf_ctx_finish(kattr, uattr, ctx,
126947316f4aSZvi Effron 				     sizeof(struct xdp_md));
127047316f4aSZvi Effron 
1271dcb40590SRoman Gushchin out:
1272de21d8bfSLorenz Bauer 	if (repeat > 1)
1273f23c4b39SBjörn Töpel 		bpf_prog_change_xdp(prog, NULL);
127447316f4aSZvi Effron free_data:
12751c194998SLorenzo Bianconi 	for (i = 0; i < sinfo->nr_frags; i++)
12761c194998SLorenzo Bianconi 		__free_page(skb_frag_page(&sinfo->frags[i]));
12771cf1cae9SAlexei Starovoitov 	kfree(data);
127847316f4aSZvi Effron free_ctx:
127947316f4aSZvi Effron 	kfree(ctx);
12801cf1cae9SAlexei Starovoitov 	return ret;
12811cf1cae9SAlexei Starovoitov }
1282b7a1848eSStanislav Fomichev 
1283b2ca4e1cSStanislav Fomichev static int verify_user_bpf_flow_keys(struct bpf_flow_keys *ctx)
1284b2ca4e1cSStanislav Fomichev {
1285b2ca4e1cSStanislav Fomichev 	/* make sure the fields we don't use are zeroed */
1286b2ca4e1cSStanislav Fomichev 	if (!range_is_zero(ctx, 0, offsetof(struct bpf_flow_keys, flags)))
1287b2ca4e1cSStanislav Fomichev 		return -EINVAL;
1288b2ca4e1cSStanislav Fomichev 
1289b2ca4e1cSStanislav Fomichev 	/* flags is allowed */
1290b2ca4e1cSStanislav Fomichev 
1291b590cb5fSStanislav Fomichev 	if (!range_is_zero(ctx, offsetofend(struct bpf_flow_keys, flags),
1292b2ca4e1cSStanislav Fomichev 			   sizeof(struct bpf_flow_keys)))
1293b2ca4e1cSStanislav Fomichev 		return -EINVAL;
1294b2ca4e1cSStanislav Fomichev 
1295b2ca4e1cSStanislav Fomichev 	return 0;
1296b2ca4e1cSStanislav Fomichev }
1297b2ca4e1cSStanislav Fomichev 
1298b7a1848eSStanislav Fomichev int bpf_prog_test_run_flow_dissector(struct bpf_prog *prog,
1299b7a1848eSStanislav Fomichev 				     const union bpf_attr *kattr,
1300b7a1848eSStanislav Fomichev 				     union bpf_attr __user *uattr)
1301b7a1848eSStanislav Fomichev {
1302607b9cc9SLorenz Bauer 	struct bpf_test_timer t = { NO_PREEMPT };
1303b7a1848eSStanislav Fomichev 	u32 size = kattr->test.data_size_in;
13047b8a1304SStanislav Fomichev 	struct bpf_flow_dissector ctx = {};
1305b7a1848eSStanislav Fomichev 	u32 repeat = kattr->test.repeat;
1306b2ca4e1cSStanislav Fomichev 	struct bpf_flow_keys *user_ctx;
1307b7a1848eSStanislav Fomichev 	struct bpf_flow_keys flow_keys;
13087b8a1304SStanislav Fomichev 	const struct ethhdr *eth;
1309b2ca4e1cSStanislav Fomichev 	unsigned int flags = 0;
1310b7a1848eSStanislav Fomichev 	u32 retval, duration;
1311b7a1848eSStanislav Fomichev 	void *data;
1312b7a1848eSStanislav Fomichev 	int ret;
1313b7a1848eSStanislav Fomichev 
1314b530e9e1SToke Høiland-Jørgensen 	if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size)
13151b4d60ecSSong Liu 		return -EINVAL;
13161b4d60ecSSong Liu 
13177b8a1304SStanislav Fomichev 	if (size < ETH_HLEN)
13187b8a1304SStanislav Fomichev 		return -EINVAL;
13197b8a1304SStanislav Fomichev 
1320be3d72a2SLorenzo Bianconi 	data = bpf_test_init(kattr, kattr->test.data_size_in, size, 0, 0);
1321b7a1848eSStanislav Fomichev 	if (IS_ERR(data))
1322b7a1848eSStanislav Fomichev 		return PTR_ERR(data);
1323b7a1848eSStanislav Fomichev 
13247b8a1304SStanislav Fomichev 	eth = (struct ethhdr *)data;
1325b7a1848eSStanislav Fomichev 
1326b7a1848eSStanislav Fomichev 	if (!repeat)
1327b7a1848eSStanislav Fomichev 		repeat = 1;
1328b7a1848eSStanislav Fomichev 
1329b2ca4e1cSStanislav Fomichev 	user_ctx = bpf_ctx_init(kattr, sizeof(struct bpf_flow_keys));
1330b2ca4e1cSStanislav Fomichev 	if (IS_ERR(user_ctx)) {
1331b2ca4e1cSStanislav Fomichev 		kfree(data);
1332b2ca4e1cSStanislav Fomichev 		return PTR_ERR(user_ctx);
1333b2ca4e1cSStanislav Fomichev 	}
1334b2ca4e1cSStanislav Fomichev 	if (user_ctx) {
1335b2ca4e1cSStanislav Fomichev 		ret = verify_user_bpf_flow_keys(user_ctx);
1336b2ca4e1cSStanislav Fomichev 		if (ret)
1337b2ca4e1cSStanislav Fomichev 			goto out;
1338b2ca4e1cSStanislav Fomichev 		flags = user_ctx->flags;
1339b2ca4e1cSStanislav Fomichev 	}
1340b2ca4e1cSStanislav Fomichev 
13417b8a1304SStanislav Fomichev 	ctx.flow_keys = &flow_keys;
13427b8a1304SStanislav Fomichev 	ctx.data = data;
13437b8a1304SStanislav Fomichev 	ctx.data_end = (__u8 *)data + size;
13447b8a1304SStanislav Fomichev 
1345607b9cc9SLorenz Bauer 	bpf_test_timer_enter(&t);
1346607b9cc9SLorenz Bauer 	do {
13477b8a1304SStanislav Fomichev 		retval = bpf_flow_dissect(prog, &ctx, eth->h_proto, ETH_HLEN,
1348b2ca4e1cSStanislav Fomichev 					  size, flags);
1349b530e9e1SToke Høiland-Jørgensen 	} while (bpf_test_timer_continue(&t, 1, repeat, &ret, &duration));
1350607b9cc9SLorenz Bauer 	bpf_test_timer_leave(&t);
13517b8a1304SStanislav Fomichev 
1352607b9cc9SLorenz Bauer 	if (ret < 0)
1353a439184dSStanislav Fomichev 		goto out;
1354b7a1848eSStanislav Fomichev 
13557855e0dbSLorenzo Bianconi 	ret = bpf_test_finish(kattr, uattr, &flow_keys, NULL,
13567855e0dbSLorenzo Bianconi 			      sizeof(flow_keys), retval, duration);
1357b2ca4e1cSStanislav Fomichev 	if (!ret)
1358b2ca4e1cSStanislav Fomichev 		ret = bpf_ctx_finish(kattr, uattr, user_ctx,
1359b2ca4e1cSStanislav Fomichev 				     sizeof(struct bpf_flow_keys));
1360b7a1848eSStanislav Fomichev 
1361a439184dSStanislav Fomichev out:
1362b2ca4e1cSStanislav Fomichev 	kfree(user_ctx);
13637b8a1304SStanislav Fomichev 	kfree(data);
1364b7a1848eSStanislav Fomichev 	return ret;
1365b7a1848eSStanislav Fomichev }
13667c32e8f8SLorenz Bauer 
13677c32e8f8SLorenz Bauer int bpf_prog_test_run_sk_lookup(struct bpf_prog *prog, const union bpf_attr *kattr,
13687c32e8f8SLorenz Bauer 				union bpf_attr __user *uattr)
13697c32e8f8SLorenz Bauer {
13707c32e8f8SLorenz Bauer 	struct bpf_test_timer t = { NO_PREEMPT };
13717c32e8f8SLorenz Bauer 	struct bpf_prog_array *progs = NULL;
13727c32e8f8SLorenz Bauer 	struct bpf_sk_lookup_kern ctx = {};
13737c32e8f8SLorenz Bauer 	u32 repeat = kattr->test.repeat;
13747c32e8f8SLorenz Bauer 	struct bpf_sk_lookup *user_ctx;
13757c32e8f8SLorenz Bauer 	u32 retval, duration;
13767c32e8f8SLorenz Bauer 	int ret = -EINVAL;
13777c32e8f8SLorenz Bauer 
1378b530e9e1SToke Høiland-Jørgensen 	if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size)
13797c32e8f8SLorenz Bauer 		return -EINVAL;
13807c32e8f8SLorenz Bauer 
13817c32e8f8SLorenz Bauer 	if (kattr->test.data_in || kattr->test.data_size_in || kattr->test.data_out ||
13827c32e8f8SLorenz Bauer 	    kattr->test.data_size_out)
13837c32e8f8SLorenz Bauer 		return -EINVAL;
13847c32e8f8SLorenz Bauer 
13857c32e8f8SLorenz Bauer 	if (!repeat)
13867c32e8f8SLorenz Bauer 		repeat = 1;
13877c32e8f8SLorenz Bauer 
13887c32e8f8SLorenz Bauer 	user_ctx = bpf_ctx_init(kattr, sizeof(*user_ctx));
13897c32e8f8SLorenz Bauer 	if (IS_ERR(user_ctx))
13907c32e8f8SLorenz Bauer 		return PTR_ERR(user_ctx);
13917c32e8f8SLorenz Bauer 
13927c32e8f8SLorenz Bauer 	if (!user_ctx)
13937c32e8f8SLorenz Bauer 		return -EINVAL;
13947c32e8f8SLorenz Bauer 
13957c32e8f8SLorenz Bauer 	if (user_ctx->sk)
13967c32e8f8SLorenz Bauer 		goto out;
13977c32e8f8SLorenz Bauer 
13987c32e8f8SLorenz Bauer 	if (!range_is_zero(user_ctx, offsetofend(typeof(*user_ctx), local_port), sizeof(*user_ctx)))
13997c32e8f8SLorenz Bauer 		goto out;
14007c32e8f8SLorenz Bauer 
14019a69e2b3SJakub Sitnicki 	if (user_ctx->local_port > U16_MAX) {
14027c32e8f8SLorenz Bauer 		ret = -ERANGE;
14037c32e8f8SLorenz Bauer 		goto out;
14047c32e8f8SLorenz Bauer 	}
14057c32e8f8SLorenz Bauer 
14067c32e8f8SLorenz Bauer 	ctx.family = (u16)user_ctx->family;
14077c32e8f8SLorenz Bauer 	ctx.protocol = (u16)user_ctx->protocol;
14087c32e8f8SLorenz Bauer 	ctx.dport = (u16)user_ctx->local_port;
14099a69e2b3SJakub Sitnicki 	ctx.sport = user_ctx->remote_port;
14107c32e8f8SLorenz Bauer 
14117c32e8f8SLorenz Bauer 	switch (ctx.family) {
14127c32e8f8SLorenz Bauer 	case AF_INET:
14137c32e8f8SLorenz Bauer 		ctx.v4.daddr = (__force __be32)user_ctx->local_ip4;
14147c32e8f8SLorenz Bauer 		ctx.v4.saddr = (__force __be32)user_ctx->remote_ip4;
14157c32e8f8SLorenz Bauer 		break;
14167c32e8f8SLorenz Bauer 
14177c32e8f8SLorenz Bauer #if IS_ENABLED(CONFIG_IPV6)
14187c32e8f8SLorenz Bauer 	case AF_INET6:
14197c32e8f8SLorenz Bauer 		ctx.v6.daddr = (struct in6_addr *)user_ctx->local_ip6;
14207c32e8f8SLorenz Bauer 		ctx.v6.saddr = (struct in6_addr *)user_ctx->remote_ip6;
14217c32e8f8SLorenz Bauer 		break;
14227c32e8f8SLorenz Bauer #endif
14237c32e8f8SLorenz Bauer 
14247c32e8f8SLorenz Bauer 	default:
14257c32e8f8SLorenz Bauer 		ret = -EAFNOSUPPORT;
14267c32e8f8SLorenz Bauer 		goto out;
14277c32e8f8SLorenz Bauer 	}
14287c32e8f8SLorenz Bauer 
14297c32e8f8SLorenz Bauer 	progs = bpf_prog_array_alloc(1, GFP_KERNEL);
14307c32e8f8SLorenz Bauer 	if (!progs) {
14317c32e8f8SLorenz Bauer 		ret = -ENOMEM;
14327c32e8f8SLorenz Bauer 		goto out;
14337c32e8f8SLorenz Bauer 	}
14347c32e8f8SLorenz Bauer 
14357c32e8f8SLorenz Bauer 	progs->items[0].prog = prog;
14367c32e8f8SLorenz Bauer 
14377c32e8f8SLorenz Bauer 	bpf_test_timer_enter(&t);
14387c32e8f8SLorenz Bauer 	do {
14397c32e8f8SLorenz Bauer 		ctx.selected_sk = NULL;
1440fb7dd8bcSAndrii Nakryiko 		retval = BPF_PROG_SK_LOOKUP_RUN_ARRAY(progs, ctx, bpf_prog_run);
1441b530e9e1SToke Høiland-Jørgensen 	} while (bpf_test_timer_continue(&t, 1, repeat, &ret, &duration));
14427c32e8f8SLorenz Bauer 	bpf_test_timer_leave(&t);
14437c32e8f8SLorenz Bauer 
14447c32e8f8SLorenz Bauer 	if (ret < 0)
14457c32e8f8SLorenz Bauer 		goto out;
14467c32e8f8SLorenz Bauer 
14477c32e8f8SLorenz Bauer 	user_ctx->cookie = 0;
14487c32e8f8SLorenz Bauer 	if (ctx.selected_sk) {
14497c32e8f8SLorenz Bauer 		if (ctx.selected_sk->sk_reuseport && !ctx.no_reuseport) {
14507c32e8f8SLorenz Bauer 			ret = -EOPNOTSUPP;
14517c32e8f8SLorenz Bauer 			goto out;
14527c32e8f8SLorenz Bauer 		}
14537c32e8f8SLorenz Bauer 
14547c32e8f8SLorenz Bauer 		user_ctx->cookie = sock_gen_cookie(ctx.selected_sk);
14557c32e8f8SLorenz Bauer 	}
14567c32e8f8SLorenz Bauer 
14577855e0dbSLorenzo Bianconi 	ret = bpf_test_finish(kattr, uattr, NULL, NULL, 0, retval, duration);
14587c32e8f8SLorenz Bauer 	if (!ret)
14597c32e8f8SLorenz Bauer 		ret = bpf_ctx_finish(kattr, uattr, user_ctx, sizeof(*user_ctx));
14607c32e8f8SLorenz Bauer 
14617c32e8f8SLorenz Bauer out:
14627c32e8f8SLorenz Bauer 	bpf_prog_array_free(progs);
14637c32e8f8SLorenz Bauer 	kfree(user_ctx);
14647c32e8f8SLorenz Bauer 	return ret;
14657c32e8f8SLorenz Bauer }
146679a7f8bdSAlexei Starovoitov 
146779a7f8bdSAlexei Starovoitov int bpf_prog_test_run_syscall(struct bpf_prog *prog,
146879a7f8bdSAlexei Starovoitov 			      const union bpf_attr *kattr,
146979a7f8bdSAlexei Starovoitov 			      union bpf_attr __user *uattr)
147079a7f8bdSAlexei Starovoitov {
147179a7f8bdSAlexei Starovoitov 	void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in);
147279a7f8bdSAlexei Starovoitov 	__u32 ctx_size_in = kattr->test.ctx_size_in;
147379a7f8bdSAlexei Starovoitov 	void *ctx = NULL;
147479a7f8bdSAlexei Starovoitov 	u32 retval;
147579a7f8bdSAlexei Starovoitov 	int err = 0;
147679a7f8bdSAlexei Starovoitov 
147779a7f8bdSAlexei Starovoitov 	/* doesn't support data_in/out, ctx_out, duration, or repeat or flags */
147879a7f8bdSAlexei Starovoitov 	if (kattr->test.data_in || kattr->test.data_out ||
147979a7f8bdSAlexei Starovoitov 	    kattr->test.ctx_out || kattr->test.duration ||
1480b530e9e1SToke Høiland-Jørgensen 	    kattr->test.repeat || kattr->test.flags ||
1481b530e9e1SToke Høiland-Jørgensen 	    kattr->test.batch_size)
148279a7f8bdSAlexei Starovoitov 		return -EINVAL;
148379a7f8bdSAlexei Starovoitov 
148479a7f8bdSAlexei Starovoitov 	if (ctx_size_in < prog->aux->max_ctx_offset ||
148579a7f8bdSAlexei Starovoitov 	    ctx_size_in > U16_MAX)
148679a7f8bdSAlexei Starovoitov 		return -EINVAL;
148779a7f8bdSAlexei Starovoitov 
148879a7f8bdSAlexei Starovoitov 	if (ctx_size_in) {
1489db5b6a46SQing Wang 		ctx = memdup_user(ctx_in, ctx_size_in);
1490db5b6a46SQing Wang 		if (IS_ERR(ctx))
1491db5b6a46SQing Wang 			return PTR_ERR(ctx);
149279a7f8bdSAlexei Starovoitov 	}
149387b7b533SYonghong Song 
149487b7b533SYonghong Song 	rcu_read_lock_trace();
149579a7f8bdSAlexei Starovoitov 	retval = bpf_prog_run_pin_on_cpu(prog, ctx);
149687b7b533SYonghong Song 	rcu_read_unlock_trace();
149779a7f8bdSAlexei Starovoitov 
149879a7f8bdSAlexei Starovoitov 	if (copy_to_user(&uattr->test.retval, &retval, sizeof(u32))) {
149979a7f8bdSAlexei Starovoitov 		err = -EFAULT;
150079a7f8bdSAlexei Starovoitov 		goto out;
150179a7f8bdSAlexei Starovoitov 	}
150279a7f8bdSAlexei Starovoitov 	if (ctx_size_in)
150379a7f8bdSAlexei Starovoitov 		if (copy_to_user(ctx_in, ctx, ctx_size_in))
150479a7f8bdSAlexei Starovoitov 			err = -EFAULT;
150579a7f8bdSAlexei Starovoitov out:
150679a7f8bdSAlexei Starovoitov 	kfree(ctx);
150779a7f8bdSAlexei Starovoitov 	return err;
150879a7f8bdSAlexei Starovoitov }
1509b202d844SKumar Kartikeya Dwivedi 
15102b99ef22SFlorian Westphal static int verify_and_copy_hook_state(struct nf_hook_state *state,
15112b99ef22SFlorian Westphal 				      const struct nf_hook_state *user,
15122b99ef22SFlorian Westphal 				      struct net_device *dev)
15132b99ef22SFlorian Westphal {
15142b99ef22SFlorian Westphal 	if (user->in || user->out)
15152b99ef22SFlorian Westphal 		return -EINVAL;
15162b99ef22SFlorian Westphal 
15172b99ef22SFlorian Westphal 	if (user->net || user->sk || user->okfn)
15182b99ef22SFlorian Westphal 		return -EINVAL;
15192b99ef22SFlorian Westphal 
15202b99ef22SFlorian Westphal 	switch (user->pf) {
15212b99ef22SFlorian Westphal 	case NFPROTO_IPV4:
15222b99ef22SFlorian Westphal 	case NFPROTO_IPV6:
15232b99ef22SFlorian Westphal 		switch (state->hook) {
15242b99ef22SFlorian Westphal 		case NF_INET_PRE_ROUTING:
15252b99ef22SFlorian Westphal 			state->in = dev;
15262b99ef22SFlorian Westphal 			break;
15272b99ef22SFlorian Westphal 		case NF_INET_LOCAL_IN:
15282b99ef22SFlorian Westphal 			state->in = dev;
15292b99ef22SFlorian Westphal 			break;
15302b99ef22SFlorian Westphal 		case NF_INET_FORWARD:
15312b99ef22SFlorian Westphal 			state->in = dev;
15322b99ef22SFlorian Westphal 			state->out = dev;
15332b99ef22SFlorian Westphal 			break;
15342b99ef22SFlorian Westphal 		case NF_INET_LOCAL_OUT:
15352b99ef22SFlorian Westphal 			state->out = dev;
15362b99ef22SFlorian Westphal 			break;
15372b99ef22SFlorian Westphal 		case NF_INET_POST_ROUTING:
15382b99ef22SFlorian Westphal 			state->out = dev;
15392b99ef22SFlorian Westphal 			break;
15402b99ef22SFlorian Westphal 		}
15412b99ef22SFlorian Westphal 
15422b99ef22SFlorian Westphal 		break;
15432b99ef22SFlorian Westphal 	default:
15442b99ef22SFlorian Westphal 		return -EINVAL;
15452b99ef22SFlorian Westphal 	}
15462b99ef22SFlorian Westphal 
15472b99ef22SFlorian Westphal 	state->pf = user->pf;
15482b99ef22SFlorian Westphal 	state->hook = user->hook;
15492b99ef22SFlorian Westphal 
15502b99ef22SFlorian Westphal 	return 0;
15512b99ef22SFlorian Westphal }
15522b99ef22SFlorian Westphal 
15532b99ef22SFlorian Westphal static __be16 nfproto_eth(int nfproto)
15542b99ef22SFlorian Westphal {
15552b99ef22SFlorian Westphal 	switch (nfproto) {
15562b99ef22SFlorian Westphal 	case NFPROTO_IPV4:
15572b99ef22SFlorian Westphal 		return htons(ETH_P_IP);
15582b99ef22SFlorian Westphal 	case NFPROTO_IPV6:
15592b99ef22SFlorian Westphal 		break;
15602b99ef22SFlorian Westphal 	}
15612b99ef22SFlorian Westphal 
15622b99ef22SFlorian Westphal 	return htons(ETH_P_IPV6);
15632b99ef22SFlorian Westphal }
15642b99ef22SFlorian Westphal 
15652b99ef22SFlorian Westphal int bpf_prog_test_run_nf(struct bpf_prog *prog,
15662b99ef22SFlorian Westphal 			 const union bpf_attr *kattr,
15672b99ef22SFlorian Westphal 			 union bpf_attr __user *uattr)
15682b99ef22SFlorian Westphal {
15692b99ef22SFlorian Westphal 	struct net *net = current->nsproxy->net_ns;
15702b99ef22SFlorian Westphal 	struct net_device *dev = net->loopback_dev;
15712b99ef22SFlorian Westphal 	struct nf_hook_state *user_ctx, hook_state = {
15722b99ef22SFlorian Westphal 		.pf = NFPROTO_IPV4,
15732b99ef22SFlorian Westphal 		.hook = NF_INET_LOCAL_OUT,
15742b99ef22SFlorian Westphal 	};
15752b99ef22SFlorian Westphal 	u32 size = kattr->test.data_size_in;
15762b99ef22SFlorian Westphal 	u32 repeat = kattr->test.repeat;
15772b99ef22SFlorian Westphal 	struct bpf_nf_ctx ctx = {
15782b99ef22SFlorian Westphal 		.state = &hook_state,
15792b99ef22SFlorian Westphal 	};
15802b99ef22SFlorian Westphal 	struct sk_buff *skb = NULL;
15812b99ef22SFlorian Westphal 	u32 retval, duration;
15822b99ef22SFlorian Westphal 	void *data;
15832b99ef22SFlorian Westphal 	int ret;
15842b99ef22SFlorian Westphal 
15852b99ef22SFlorian Westphal 	if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size)
15862b99ef22SFlorian Westphal 		return -EINVAL;
15872b99ef22SFlorian Westphal 
15882b99ef22SFlorian Westphal 	if (size < sizeof(struct iphdr))
15892b99ef22SFlorian Westphal 		return -EINVAL;
15902b99ef22SFlorian Westphal 
15912b99ef22SFlorian Westphal 	data = bpf_test_init(kattr, kattr->test.data_size_in, size,
15922b99ef22SFlorian Westphal 			     NET_SKB_PAD + NET_IP_ALIGN,
15932b99ef22SFlorian Westphal 			     SKB_DATA_ALIGN(sizeof(struct skb_shared_info)));
15942b99ef22SFlorian Westphal 	if (IS_ERR(data))
15952b99ef22SFlorian Westphal 		return PTR_ERR(data);
15962b99ef22SFlorian Westphal 
15972b99ef22SFlorian Westphal 	if (!repeat)
15982b99ef22SFlorian Westphal 		repeat = 1;
15992b99ef22SFlorian Westphal 
16002b99ef22SFlorian Westphal 	user_ctx = bpf_ctx_init(kattr, sizeof(struct nf_hook_state));
16012b99ef22SFlorian Westphal 	if (IS_ERR(user_ctx)) {
16022b99ef22SFlorian Westphal 		kfree(data);
16032b99ef22SFlorian Westphal 		return PTR_ERR(user_ctx);
16042b99ef22SFlorian Westphal 	}
16052b99ef22SFlorian Westphal 
16062b99ef22SFlorian Westphal 	if (user_ctx) {
16072b99ef22SFlorian Westphal 		ret = verify_and_copy_hook_state(&hook_state, user_ctx, dev);
16082b99ef22SFlorian Westphal 		if (ret)
16092b99ef22SFlorian Westphal 			goto out;
16102b99ef22SFlorian Westphal 	}
16112b99ef22SFlorian Westphal 
16122b99ef22SFlorian Westphal 	skb = slab_build_skb(data);
16132b99ef22SFlorian Westphal 	if (!skb) {
16142b99ef22SFlorian Westphal 		ret = -ENOMEM;
16152b99ef22SFlorian Westphal 		goto out;
16162b99ef22SFlorian Westphal 	}
16172b99ef22SFlorian Westphal 
16182b99ef22SFlorian Westphal 	data = NULL; /* data released via kfree_skb */
16192b99ef22SFlorian Westphal 
16202b99ef22SFlorian Westphal 	skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN);
16212b99ef22SFlorian Westphal 	__skb_put(skb, size);
16222b99ef22SFlorian Westphal 
16232b99ef22SFlorian Westphal 	ret = -EINVAL;
16242b99ef22SFlorian Westphal 
16252b99ef22SFlorian Westphal 	if (hook_state.hook != NF_INET_LOCAL_OUT) {
16262b99ef22SFlorian Westphal 		if (size < ETH_HLEN + sizeof(struct iphdr))
16272b99ef22SFlorian Westphal 			goto out;
16282b99ef22SFlorian Westphal 
16292b99ef22SFlorian Westphal 		skb->protocol = eth_type_trans(skb, dev);
16302b99ef22SFlorian Westphal 		switch (skb->protocol) {
16312b99ef22SFlorian Westphal 		case htons(ETH_P_IP):
16322b99ef22SFlorian Westphal 			if (hook_state.pf == NFPROTO_IPV4)
16332b99ef22SFlorian Westphal 				break;
16342b99ef22SFlorian Westphal 			goto out;
16352b99ef22SFlorian Westphal 		case htons(ETH_P_IPV6):
16362b99ef22SFlorian Westphal 			if (size < ETH_HLEN + sizeof(struct ipv6hdr))
16372b99ef22SFlorian Westphal 				goto out;
16382b99ef22SFlorian Westphal 			if (hook_state.pf == NFPROTO_IPV6)
16392b99ef22SFlorian Westphal 				break;
16402b99ef22SFlorian Westphal 			goto out;
16412b99ef22SFlorian Westphal 		default:
16422b99ef22SFlorian Westphal 			ret = -EPROTO;
16432b99ef22SFlorian Westphal 			goto out;
16442b99ef22SFlorian Westphal 		}
16452b99ef22SFlorian Westphal 
16462b99ef22SFlorian Westphal 		skb_reset_network_header(skb);
16472b99ef22SFlorian Westphal 	} else {
16482b99ef22SFlorian Westphal 		skb->protocol = nfproto_eth(hook_state.pf);
16492b99ef22SFlorian Westphal 	}
16502b99ef22SFlorian Westphal 
16512b99ef22SFlorian Westphal 	ctx.skb = skb;
16522b99ef22SFlorian Westphal 
16532b99ef22SFlorian Westphal 	ret = bpf_test_run(prog, &ctx, repeat, &retval, &duration, false);
16542b99ef22SFlorian Westphal 	if (ret)
16552b99ef22SFlorian Westphal 		goto out;
16562b99ef22SFlorian Westphal 
16572b99ef22SFlorian Westphal 	ret = bpf_test_finish(kattr, uattr, NULL, NULL, 0, retval, duration);
16582b99ef22SFlorian Westphal 
16592b99ef22SFlorian Westphal out:
16602b99ef22SFlorian Westphal 	kfree(user_ctx);
16612b99ef22SFlorian Westphal 	kfree_skb(skb);
16622b99ef22SFlorian Westphal 	kfree(data);
16632b99ef22SFlorian Westphal 	return ret;
16642b99ef22SFlorian Westphal }
16652b99ef22SFlorian Westphal 
1666b202d844SKumar Kartikeya Dwivedi static const struct btf_kfunc_id_set bpf_prog_test_kfunc_set = {
1667b202d844SKumar Kartikeya Dwivedi 	.owner = THIS_MODULE,
1668a4703e31SKumar Kartikeya Dwivedi 	.set   = &test_sk_check_kfunc_ids,
1669b202d844SKumar Kartikeya Dwivedi };
1670b202d844SKumar Kartikeya Dwivedi 
167105a945deSKumar Kartikeya Dwivedi BTF_ID_LIST(bpf_prog_test_dtor_kfunc_ids)
167205a945deSKumar Kartikeya Dwivedi BTF_ID(struct, prog_test_ref_kfunc)
167305a945deSKumar Kartikeya Dwivedi BTF_ID(func, bpf_kfunc_call_test_release)
167405a945deSKumar Kartikeya Dwivedi BTF_ID(struct, prog_test_member)
167505a945deSKumar Kartikeya Dwivedi BTF_ID(func, bpf_kfunc_call_memb_release)
167605a945deSKumar Kartikeya Dwivedi 
1677b202d844SKumar Kartikeya Dwivedi static int __init bpf_prog_test_run_init(void)
1678b202d844SKumar Kartikeya Dwivedi {
167905a945deSKumar Kartikeya Dwivedi 	const struct btf_id_dtor_kfunc bpf_prog_test_dtor_kfunc[] = {
168005a945deSKumar Kartikeya Dwivedi 		{
168105a945deSKumar Kartikeya Dwivedi 		  .btf_id       = bpf_prog_test_dtor_kfunc_ids[0],
168205a945deSKumar Kartikeya Dwivedi 		  .kfunc_btf_id = bpf_prog_test_dtor_kfunc_ids[1]
168305a945deSKumar Kartikeya Dwivedi 		},
168405a945deSKumar Kartikeya Dwivedi 		{
168505a945deSKumar Kartikeya Dwivedi 		  .btf_id	= bpf_prog_test_dtor_kfunc_ids[2],
168605a945deSKumar Kartikeya Dwivedi 		  .kfunc_btf_id = bpf_prog_test_dtor_kfunc_ids[3],
168705a945deSKumar Kartikeya Dwivedi 		},
168805a945deSKumar Kartikeya Dwivedi 	};
168905a945deSKumar Kartikeya Dwivedi 	int ret;
169005a945deSKumar Kartikeya Dwivedi 
16915b481acaSBenjamin Tissoires 	ret = register_btf_fmodret_id_set(&bpf_test_modify_return_set);
16925b481acaSBenjamin Tissoires 	ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_SCHED_CLS, &bpf_prog_test_kfunc_set);
16931f075262SKumar Kartikeya Dwivedi 	ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_TRACING, &bpf_prog_test_kfunc_set);
1694fb66223aSBenjamin Tissoires 	ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_SYSCALL, &bpf_prog_test_kfunc_set);
169505a945deSKumar Kartikeya Dwivedi 	return ret ?: register_btf_id_dtor_kfuncs(bpf_prog_test_dtor_kfunc,
169605a945deSKumar Kartikeya Dwivedi 						  ARRAY_SIZE(bpf_prog_test_dtor_kfunc),
169705a945deSKumar Kartikeya Dwivedi 						  THIS_MODULE);
1698b202d844SKumar Kartikeya Dwivedi }
1699b202d844SKumar Kartikeya Dwivedi late_initcall(bpf_prog_test_run_init);
1700