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