1 // SPDX-License-Identifier: GPL-2.0-only 2 /* Copyright (c) 2017 Facebook 3 */ 4 #include <linux/bpf.h> 5 #include <linux/btf.h> 6 #include <linux/btf_ids.h> 7 #include <linux/slab.h> 8 #include <linux/init.h> 9 #include <linux/vmalloc.h> 10 #include <linux/etherdevice.h> 11 #include <linux/filter.h> 12 #include <linux/rcupdate_trace.h> 13 #include <linux/sched/signal.h> 14 #include <net/bpf_sk_storage.h> 15 #include <net/hotdata.h> 16 #include <net/sock.h> 17 #include <net/tcp.h> 18 #include <net/net_namespace.h> 19 #include <net/page_pool/helpers.h> 20 #include <linux/error-injection.h> 21 #include <linux/smp.h> 22 #include <linux/sock_diag.h> 23 #include <linux/netfilter.h> 24 #include <net/netdev_rx_queue.h> 25 #include <net/xdp.h> 26 #include <net/netfilter/nf_bpf_link.h> 27 28 #define CREATE_TRACE_POINTS 29 #include <trace/events/bpf_test_run.h> 30 31 struct bpf_test_timer { 32 enum { NO_PREEMPT, NO_MIGRATE } mode; 33 u32 i; 34 u64 time_start, time_spent; 35 }; 36 37 static void bpf_test_timer_enter(struct bpf_test_timer *t) 38 __acquires(rcu) 39 { 40 rcu_read_lock(); 41 if (t->mode == NO_PREEMPT) 42 preempt_disable(); 43 else 44 migrate_disable(); 45 46 t->time_start = ktime_get_ns(); 47 } 48 49 static void bpf_test_timer_leave(struct bpf_test_timer *t) 50 __releases(rcu) 51 { 52 t->time_start = 0; 53 54 if (t->mode == NO_PREEMPT) 55 preempt_enable(); 56 else 57 migrate_enable(); 58 rcu_read_unlock(); 59 } 60 61 static bool bpf_test_timer_continue(struct bpf_test_timer *t, int iterations, 62 u32 repeat, int *err, u32 *duration) 63 __must_hold(rcu) 64 { 65 t->i += iterations; 66 if (t->i >= repeat) { 67 /* We're done. */ 68 t->time_spent += ktime_get_ns() - t->time_start; 69 do_div(t->time_spent, t->i); 70 *duration = t->time_spent > U32_MAX ? U32_MAX : (u32)t->time_spent; 71 *err = 0; 72 goto reset; 73 } 74 75 if (signal_pending(current)) { 76 /* During iteration: we've been cancelled, abort. */ 77 *err = -EINTR; 78 goto reset; 79 } 80 81 if (need_resched()) { 82 /* During iteration: we need to reschedule between runs. */ 83 t->time_spent += ktime_get_ns() - t->time_start; 84 bpf_test_timer_leave(t); 85 cond_resched(); 86 bpf_test_timer_enter(t); 87 } 88 89 /* Do another round. */ 90 return true; 91 92 reset: 93 t->i = 0; 94 return false; 95 } 96 97 /* We put this struct at the head of each page with a context and frame 98 * initialised when the page is allocated, so we don't have to do this on each 99 * repetition of the test run. 100 */ 101 struct xdp_page_head { 102 struct xdp_buff orig_ctx; 103 struct xdp_buff ctx; 104 union { 105 /* ::data_hard_start starts here */ 106 DECLARE_FLEX_ARRAY(struct xdp_frame, frame); 107 DECLARE_FLEX_ARRAY(u8, data); 108 }; 109 }; 110 111 struct xdp_test_data { 112 struct xdp_buff *orig_ctx; 113 struct xdp_rxq_info rxq; 114 struct net_device *dev; 115 struct page_pool *pp; 116 struct xdp_frame **frames; 117 struct sk_buff **skbs; 118 struct xdp_mem_info mem; 119 u32 batch_size; 120 u32 frame_cnt; 121 }; 122 123 /* tools/testing/selftests/bpf/prog_tests/xdp_do_redirect.c:%MAX_PKT_SIZE 124 * must be updated accordingly this gets changed, otherwise BPF selftests 125 * will fail. 126 */ 127 #define TEST_XDP_FRAME_SIZE (PAGE_SIZE - sizeof(struct xdp_page_head)) 128 #define TEST_XDP_MAX_BATCH 256 129 130 static void xdp_test_run_init_page(struct page *page, void *arg) 131 { 132 struct xdp_page_head *head = phys_to_virt(page_to_phys(page)); 133 struct xdp_buff *new_ctx, *orig_ctx; 134 u32 headroom = XDP_PACKET_HEADROOM; 135 struct xdp_test_data *xdp = arg; 136 size_t frm_len, meta_len; 137 struct xdp_frame *frm; 138 void *data; 139 140 orig_ctx = xdp->orig_ctx; 141 frm_len = orig_ctx->data_end - orig_ctx->data_meta; 142 meta_len = orig_ctx->data - orig_ctx->data_meta; 143 headroom -= meta_len; 144 145 new_ctx = &head->ctx; 146 frm = head->frame; 147 data = head->data; 148 memcpy(data + headroom, orig_ctx->data_meta, frm_len); 149 150 xdp_init_buff(new_ctx, TEST_XDP_FRAME_SIZE, &xdp->rxq); 151 xdp_prepare_buff(new_ctx, data, headroom, frm_len, true); 152 new_ctx->data = new_ctx->data_meta + meta_len; 153 154 xdp_update_frame_from_buff(new_ctx, frm); 155 frm->mem = new_ctx->rxq->mem; 156 157 memcpy(&head->orig_ctx, new_ctx, sizeof(head->orig_ctx)); 158 } 159 160 static int xdp_test_run_setup(struct xdp_test_data *xdp, struct xdp_buff *orig_ctx) 161 { 162 struct page_pool *pp; 163 int err = -ENOMEM; 164 struct page_pool_params pp_params = { 165 .order = 0, 166 .flags = 0, 167 .pool_size = xdp->batch_size, 168 .nid = NUMA_NO_NODE, 169 .init_callback = xdp_test_run_init_page, 170 .init_arg = xdp, 171 }; 172 173 xdp->frames = kvmalloc_array(xdp->batch_size, sizeof(void *), GFP_KERNEL); 174 if (!xdp->frames) 175 return -ENOMEM; 176 177 xdp->skbs = kvmalloc_array(xdp->batch_size, sizeof(void *), GFP_KERNEL); 178 if (!xdp->skbs) 179 goto err_skbs; 180 181 pp = page_pool_create(&pp_params); 182 if (IS_ERR(pp)) { 183 err = PTR_ERR(pp); 184 goto err_pp; 185 } 186 187 /* will copy 'mem.id' into pp->xdp_mem_id */ 188 err = xdp_reg_mem_model(&xdp->mem, MEM_TYPE_PAGE_POOL, pp); 189 if (err) 190 goto err_mmodel; 191 192 xdp->pp = pp; 193 194 /* We create a 'fake' RXQ referencing the original dev, but with an 195 * xdp_mem_info pointing to our page_pool 196 */ 197 xdp_rxq_info_reg(&xdp->rxq, orig_ctx->rxq->dev, 0, 0); 198 xdp->rxq.mem.type = MEM_TYPE_PAGE_POOL; 199 xdp->rxq.mem.id = pp->xdp_mem_id; 200 xdp->dev = orig_ctx->rxq->dev; 201 xdp->orig_ctx = orig_ctx; 202 203 return 0; 204 205 err_mmodel: 206 page_pool_destroy(pp); 207 err_pp: 208 kvfree(xdp->skbs); 209 err_skbs: 210 kvfree(xdp->frames); 211 return err; 212 } 213 214 static void xdp_test_run_teardown(struct xdp_test_data *xdp) 215 { 216 xdp_unreg_mem_model(&xdp->mem); 217 page_pool_destroy(xdp->pp); 218 kfree(xdp->frames); 219 kfree(xdp->skbs); 220 } 221 222 static bool frame_was_changed(const struct xdp_page_head *head) 223 { 224 /* xdp_scrub_frame() zeroes the data pointer, flags is the last field, 225 * i.e. has the highest chances to be overwritten. If those two are 226 * untouched, it's most likely safe to skip the context reset. 227 */ 228 return head->frame->data != head->orig_ctx.data || 229 head->frame->flags != head->orig_ctx.flags; 230 } 231 232 static bool ctx_was_changed(struct xdp_page_head *head) 233 { 234 return head->orig_ctx.data != head->ctx.data || 235 head->orig_ctx.data_meta != head->ctx.data_meta || 236 head->orig_ctx.data_end != head->ctx.data_end; 237 } 238 239 static void reset_ctx(struct xdp_page_head *head) 240 { 241 if (likely(!frame_was_changed(head) && !ctx_was_changed(head))) 242 return; 243 244 head->ctx.data = head->orig_ctx.data; 245 head->ctx.data_meta = head->orig_ctx.data_meta; 246 head->ctx.data_end = head->orig_ctx.data_end; 247 xdp_update_frame_from_buff(&head->ctx, head->frame); 248 } 249 250 static int xdp_recv_frames(struct xdp_frame **frames, int nframes, 251 struct sk_buff **skbs, 252 struct net_device *dev) 253 { 254 gfp_t gfp = __GFP_ZERO | GFP_ATOMIC; 255 int i, n; 256 LIST_HEAD(list); 257 258 n = kmem_cache_alloc_bulk(net_hotdata.skbuff_cache, gfp, nframes, 259 (void **)skbs); 260 if (unlikely(n == 0)) { 261 for (i = 0; i < nframes; i++) 262 xdp_return_frame(frames[i]); 263 return -ENOMEM; 264 } 265 266 for (i = 0; i < nframes; i++) { 267 struct xdp_frame *xdpf = frames[i]; 268 struct sk_buff *skb = skbs[i]; 269 270 skb = __xdp_build_skb_from_frame(xdpf, skb, dev); 271 if (!skb) { 272 xdp_return_frame(xdpf); 273 continue; 274 } 275 276 list_add_tail(&skb->list, &list); 277 } 278 netif_receive_skb_list(&list); 279 280 return 0; 281 } 282 283 static int xdp_test_run_batch(struct xdp_test_data *xdp, struct bpf_prog *prog, 284 u32 repeat) 285 { 286 struct bpf_redirect_info *ri = this_cpu_ptr(&bpf_redirect_info); 287 int err = 0, act, ret, i, nframes = 0, batch_sz; 288 struct xdp_frame **frames = xdp->frames; 289 struct xdp_page_head *head; 290 struct xdp_frame *frm; 291 bool redirect = false; 292 struct xdp_buff *ctx; 293 struct page *page; 294 295 batch_sz = min_t(u32, repeat, xdp->batch_size); 296 297 local_bh_disable(); 298 xdp_set_return_frame_no_direct(); 299 300 for (i = 0; i < batch_sz; i++) { 301 page = page_pool_dev_alloc_pages(xdp->pp); 302 if (!page) { 303 err = -ENOMEM; 304 goto out; 305 } 306 307 head = phys_to_virt(page_to_phys(page)); 308 reset_ctx(head); 309 ctx = &head->ctx; 310 frm = head->frame; 311 xdp->frame_cnt++; 312 313 act = bpf_prog_run_xdp(prog, ctx); 314 315 /* if program changed pkt bounds we need to update the xdp_frame */ 316 if (unlikely(ctx_was_changed(head))) { 317 ret = xdp_update_frame_from_buff(ctx, frm); 318 if (ret) { 319 xdp_return_buff(ctx); 320 continue; 321 } 322 } 323 324 switch (act) { 325 case XDP_TX: 326 /* we can't do a real XDP_TX since we're not in the 327 * driver, so turn it into a REDIRECT back to the same 328 * index 329 */ 330 ri->tgt_index = xdp->dev->ifindex; 331 ri->map_id = INT_MAX; 332 ri->map_type = BPF_MAP_TYPE_UNSPEC; 333 fallthrough; 334 case XDP_REDIRECT: 335 redirect = true; 336 ret = xdp_do_redirect_frame(xdp->dev, ctx, frm, prog); 337 if (ret) 338 xdp_return_buff(ctx); 339 break; 340 case XDP_PASS: 341 frames[nframes++] = frm; 342 break; 343 default: 344 bpf_warn_invalid_xdp_action(NULL, prog, act); 345 fallthrough; 346 case XDP_DROP: 347 xdp_return_buff(ctx); 348 break; 349 } 350 } 351 352 out: 353 if (redirect) 354 xdp_do_flush(); 355 if (nframes) { 356 ret = xdp_recv_frames(frames, nframes, xdp->skbs, xdp->dev); 357 if (ret) 358 err = ret; 359 } 360 361 xdp_clear_return_frame_no_direct(); 362 local_bh_enable(); 363 return err; 364 } 365 366 static int bpf_test_run_xdp_live(struct bpf_prog *prog, struct xdp_buff *ctx, 367 u32 repeat, u32 batch_size, u32 *time) 368 369 { 370 struct xdp_test_data xdp = { .batch_size = batch_size }; 371 struct bpf_test_timer t = { .mode = NO_MIGRATE }; 372 int ret; 373 374 if (!repeat) 375 repeat = 1; 376 377 ret = xdp_test_run_setup(&xdp, ctx); 378 if (ret) 379 return ret; 380 381 bpf_test_timer_enter(&t); 382 do { 383 xdp.frame_cnt = 0; 384 ret = xdp_test_run_batch(&xdp, prog, repeat - t.i); 385 if (unlikely(ret < 0)) 386 break; 387 } while (bpf_test_timer_continue(&t, xdp.frame_cnt, repeat, &ret, time)); 388 bpf_test_timer_leave(&t); 389 390 xdp_test_run_teardown(&xdp); 391 return ret; 392 } 393 394 static int bpf_test_run(struct bpf_prog *prog, void *ctx, u32 repeat, 395 u32 *retval, u32 *time, bool xdp) 396 { 397 struct bpf_prog_array_item item = {.prog = prog}; 398 struct bpf_run_ctx *old_ctx; 399 struct bpf_cg_run_ctx run_ctx; 400 struct bpf_test_timer t = { NO_MIGRATE }; 401 enum bpf_cgroup_storage_type stype; 402 int ret; 403 404 for_each_cgroup_storage_type(stype) { 405 item.cgroup_storage[stype] = bpf_cgroup_storage_alloc(prog, stype); 406 if (IS_ERR(item.cgroup_storage[stype])) { 407 item.cgroup_storage[stype] = NULL; 408 for_each_cgroup_storage_type(stype) 409 bpf_cgroup_storage_free(item.cgroup_storage[stype]); 410 return -ENOMEM; 411 } 412 } 413 414 if (!repeat) 415 repeat = 1; 416 417 bpf_test_timer_enter(&t); 418 old_ctx = bpf_set_run_ctx(&run_ctx.run_ctx); 419 do { 420 run_ctx.prog_item = &item; 421 local_bh_disable(); 422 if (xdp) 423 *retval = bpf_prog_run_xdp(prog, ctx); 424 else 425 *retval = bpf_prog_run(prog, ctx); 426 local_bh_enable(); 427 } while (bpf_test_timer_continue(&t, 1, repeat, &ret, time)); 428 bpf_reset_run_ctx(old_ctx); 429 bpf_test_timer_leave(&t); 430 431 for_each_cgroup_storage_type(stype) 432 bpf_cgroup_storage_free(item.cgroup_storage[stype]); 433 434 return ret; 435 } 436 437 static int bpf_test_finish(const union bpf_attr *kattr, 438 union bpf_attr __user *uattr, const void *data, 439 struct skb_shared_info *sinfo, u32 size, 440 u32 retval, u32 duration) 441 { 442 void __user *data_out = u64_to_user_ptr(kattr->test.data_out); 443 int err = -EFAULT; 444 u32 copy_size = size; 445 446 /* Clamp copy if the user has provided a size hint, but copy the full 447 * buffer if not to retain old behaviour. 448 */ 449 if (kattr->test.data_size_out && 450 copy_size > kattr->test.data_size_out) { 451 copy_size = kattr->test.data_size_out; 452 err = -ENOSPC; 453 } 454 455 if (data_out) { 456 int len = sinfo ? copy_size - sinfo->xdp_frags_size : copy_size; 457 458 if (len < 0) { 459 err = -ENOSPC; 460 goto out; 461 } 462 463 if (copy_to_user(data_out, data, len)) 464 goto out; 465 466 if (sinfo) { 467 int i, offset = len; 468 u32 data_len; 469 470 for (i = 0; i < sinfo->nr_frags; i++) { 471 skb_frag_t *frag = &sinfo->frags[i]; 472 473 if (offset >= copy_size) { 474 err = -ENOSPC; 475 break; 476 } 477 478 data_len = min_t(u32, copy_size - offset, 479 skb_frag_size(frag)); 480 481 if (copy_to_user(data_out + offset, 482 skb_frag_address(frag), 483 data_len)) 484 goto out; 485 486 offset += data_len; 487 } 488 } 489 } 490 491 if (copy_to_user(&uattr->test.data_size_out, &size, sizeof(size))) 492 goto out; 493 if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval))) 494 goto out; 495 if (copy_to_user(&uattr->test.duration, &duration, sizeof(duration))) 496 goto out; 497 if (err != -ENOSPC) 498 err = 0; 499 out: 500 trace_bpf_test_finish(&err); 501 return err; 502 } 503 504 /* Integer types of various sizes and pointer combinations cover variety of 505 * architecture dependent calling conventions. 7+ can be supported in the 506 * future. 507 */ 508 __bpf_kfunc_start_defs(); 509 510 __bpf_kfunc int bpf_fentry_test1(int a) 511 { 512 return a + 1; 513 } 514 EXPORT_SYMBOL_GPL(bpf_fentry_test1); 515 516 int noinline bpf_fentry_test2(int a, u64 b) 517 { 518 return a + b; 519 } 520 521 int noinline bpf_fentry_test3(char a, int b, u64 c) 522 { 523 return a + b + c; 524 } 525 526 int noinline bpf_fentry_test4(void *a, char b, int c, u64 d) 527 { 528 return (long)a + b + c + d; 529 } 530 531 int noinline bpf_fentry_test5(u64 a, void *b, short c, int d, u64 e) 532 { 533 return a + (long)b + c + d + e; 534 } 535 536 int noinline bpf_fentry_test6(u64 a, void *b, short c, int d, void *e, u64 f) 537 { 538 return a + (long)b + c + d + (long)e + f; 539 } 540 541 struct bpf_fentry_test_t { 542 struct bpf_fentry_test_t *a; 543 }; 544 545 int noinline bpf_fentry_test7(struct bpf_fentry_test_t *arg) 546 { 547 asm volatile ("": "+r"(arg)); 548 return (long)arg; 549 } 550 551 int noinline bpf_fentry_test8(struct bpf_fentry_test_t *arg) 552 { 553 return (long)arg->a; 554 } 555 556 __bpf_kfunc u32 bpf_fentry_test9(u32 *a) 557 { 558 return *a; 559 } 560 561 void noinline bpf_fentry_test_sinfo(struct skb_shared_info *sinfo) 562 { 563 } 564 565 __bpf_kfunc int bpf_modify_return_test(int a, int *b) 566 { 567 *b += 1; 568 return a + *b; 569 } 570 571 __bpf_kfunc int bpf_modify_return_test2(int a, int *b, short c, int d, 572 void *e, char f, int g) 573 { 574 *b += 1; 575 return a + *b + c + d + (long)e + f + g; 576 } 577 578 __bpf_kfunc int bpf_modify_return_test_tp(int nonce) 579 { 580 trace_bpf_trigger_tp(nonce); 581 582 return nonce; 583 } 584 585 int noinline bpf_fentry_shadow_test(int a) 586 { 587 return a + 1; 588 } 589 590 struct prog_test_member1 { 591 int a; 592 }; 593 594 struct prog_test_member { 595 struct prog_test_member1 m; 596 int c; 597 }; 598 599 struct prog_test_ref_kfunc { 600 int a; 601 int b; 602 struct prog_test_member memb; 603 struct prog_test_ref_kfunc *next; 604 refcount_t cnt; 605 }; 606 607 __bpf_kfunc void bpf_kfunc_call_test_release(struct prog_test_ref_kfunc *p) 608 { 609 refcount_dec(&p->cnt); 610 } 611 612 __bpf_kfunc void bpf_kfunc_call_test_release_dtor(void *p) 613 { 614 bpf_kfunc_call_test_release(p); 615 } 616 CFI_NOSEAL(bpf_kfunc_call_test_release_dtor); 617 618 __bpf_kfunc void bpf_kfunc_call_memb_release(struct prog_test_member *p) 619 { 620 } 621 622 __bpf_kfunc void bpf_kfunc_call_memb_release_dtor(void *p) 623 { 624 } 625 CFI_NOSEAL(bpf_kfunc_call_memb_release_dtor); 626 627 __bpf_kfunc_end_defs(); 628 629 BTF_KFUNCS_START(bpf_test_modify_return_ids) 630 BTF_ID_FLAGS(func, bpf_modify_return_test) 631 BTF_ID_FLAGS(func, bpf_modify_return_test2) 632 BTF_ID_FLAGS(func, bpf_modify_return_test_tp) 633 BTF_ID_FLAGS(func, bpf_fentry_test1, KF_SLEEPABLE) 634 BTF_KFUNCS_END(bpf_test_modify_return_ids) 635 636 static const struct btf_kfunc_id_set bpf_test_modify_return_set = { 637 .owner = THIS_MODULE, 638 .set = &bpf_test_modify_return_ids, 639 }; 640 641 BTF_KFUNCS_START(test_sk_check_kfunc_ids) 642 BTF_ID_FLAGS(func, bpf_kfunc_call_test_release, KF_RELEASE) 643 BTF_ID_FLAGS(func, bpf_kfunc_call_memb_release, KF_RELEASE) 644 BTF_KFUNCS_END(test_sk_check_kfunc_ids) 645 646 static void *bpf_test_init(const union bpf_attr *kattr, u32 user_size, 647 u32 size, u32 headroom, u32 tailroom) 648 { 649 void __user *data_in = u64_to_user_ptr(kattr->test.data_in); 650 void *data; 651 652 if (size < ETH_HLEN || size > PAGE_SIZE - headroom - tailroom) 653 return ERR_PTR(-EINVAL); 654 655 if (user_size > size) 656 return ERR_PTR(-EMSGSIZE); 657 658 size = SKB_DATA_ALIGN(size); 659 data = kzalloc(size + headroom + tailroom, GFP_USER); 660 if (!data) 661 return ERR_PTR(-ENOMEM); 662 663 if (copy_from_user(data + headroom, data_in, user_size)) { 664 kfree(data); 665 return ERR_PTR(-EFAULT); 666 } 667 668 return data; 669 } 670 671 int bpf_prog_test_run_tracing(struct bpf_prog *prog, 672 const union bpf_attr *kattr, 673 union bpf_attr __user *uattr) 674 { 675 struct bpf_fentry_test_t arg = {}; 676 u16 side_effect = 0, ret = 0; 677 int b = 2, err = -EFAULT; 678 u32 retval = 0; 679 680 if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size) 681 return -EINVAL; 682 683 switch (prog->expected_attach_type) { 684 case BPF_TRACE_FENTRY: 685 case BPF_TRACE_FEXIT: 686 if (bpf_fentry_test1(1) != 2 || 687 bpf_fentry_test2(2, 3) != 5 || 688 bpf_fentry_test3(4, 5, 6) != 15 || 689 bpf_fentry_test4((void *)7, 8, 9, 10) != 34 || 690 bpf_fentry_test5(11, (void *)12, 13, 14, 15) != 65 || 691 bpf_fentry_test6(16, (void *)17, 18, 19, (void *)20, 21) != 111 || 692 bpf_fentry_test7((struct bpf_fentry_test_t *)0) != 0 || 693 bpf_fentry_test8(&arg) != 0 || 694 bpf_fentry_test9(&retval) != 0) 695 goto out; 696 break; 697 case BPF_MODIFY_RETURN: 698 ret = bpf_modify_return_test(1, &b); 699 if (b != 2) 700 side_effect++; 701 b = 2; 702 ret += bpf_modify_return_test2(1, &b, 3, 4, (void *)5, 6, 7); 703 if (b != 2) 704 side_effect++; 705 break; 706 default: 707 goto out; 708 } 709 710 retval = ((u32)side_effect << 16) | ret; 711 if (copy_to_user(&uattr->test.retval, &retval, sizeof(retval))) 712 goto out; 713 714 err = 0; 715 out: 716 trace_bpf_test_finish(&err); 717 return err; 718 } 719 720 struct bpf_raw_tp_test_run_info { 721 struct bpf_prog *prog; 722 void *ctx; 723 u32 retval; 724 }; 725 726 static void 727 __bpf_prog_test_run_raw_tp(void *data) 728 { 729 struct bpf_raw_tp_test_run_info *info = data; 730 731 rcu_read_lock(); 732 info->retval = bpf_prog_run(info->prog, info->ctx); 733 rcu_read_unlock(); 734 } 735 736 int bpf_prog_test_run_raw_tp(struct bpf_prog *prog, 737 const union bpf_attr *kattr, 738 union bpf_attr __user *uattr) 739 { 740 void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in); 741 __u32 ctx_size_in = kattr->test.ctx_size_in; 742 struct bpf_raw_tp_test_run_info info; 743 int cpu = kattr->test.cpu, err = 0; 744 int current_cpu; 745 746 /* doesn't support data_in/out, ctx_out, duration, or repeat */ 747 if (kattr->test.data_in || kattr->test.data_out || 748 kattr->test.ctx_out || kattr->test.duration || 749 kattr->test.repeat || kattr->test.batch_size) 750 return -EINVAL; 751 752 if (ctx_size_in < prog->aux->max_ctx_offset || 753 ctx_size_in > MAX_BPF_FUNC_ARGS * sizeof(u64)) 754 return -EINVAL; 755 756 if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 && cpu != 0) 757 return -EINVAL; 758 759 if (ctx_size_in) { 760 info.ctx = memdup_user(ctx_in, ctx_size_in); 761 if (IS_ERR(info.ctx)) 762 return PTR_ERR(info.ctx); 763 } else { 764 info.ctx = NULL; 765 } 766 767 info.prog = prog; 768 769 current_cpu = get_cpu(); 770 if ((kattr->test.flags & BPF_F_TEST_RUN_ON_CPU) == 0 || 771 cpu == current_cpu) { 772 __bpf_prog_test_run_raw_tp(&info); 773 } else if (cpu >= nr_cpu_ids || !cpu_online(cpu)) { 774 /* smp_call_function_single() also checks cpu_online() 775 * after csd_lock(). However, since cpu is from user 776 * space, let's do an extra quick check to filter out 777 * invalid value before smp_call_function_single(). 778 */ 779 err = -ENXIO; 780 } else { 781 err = smp_call_function_single(cpu, __bpf_prog_test_run_raw_tp, 782 &info, 1); 783 } 784 put_cpu(); 785 786 if (!err && 787 copy_to_user(&uattr->test.retval, &info.retval, sizeof(u32))) 788 err = -EFAULT; 789 790 kfree(info.ctx); 791 return err; 792 } 793 794 static void *bpf_ctx_init(const union bpf_attr *kattr, u32 max_size) 795 { 796 void __user *data_in = u64_to_user_ptr(kattr->test.ctx_in); 797 void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out); 798 u32 size = kattr->test.ctx_size_in; 799 void *data; 800 int err; 801 802 if (!data_in && !data_out) 803 return NULL; 804 805 data = kzalloc(max_size, GFP_USER); 806 if (!data) 807 return ERR_PTR(-ENOMEM); 808 809 if (data_in) { 810 err = bpf_check_uarg_tail_zero(USER_BPFPTR(data_in), max_size, size); 811 if (err) { 812 kfree(data); 813 return ERR_PTR(err); 814 } 815 816 size = min_t(u32, max_size, size); 817 if (copy_from_user(data, data_in, size)) { 818 kfree(data); 819 return ERR_PTR(-EFAULT); 820 } 821 } 822 return data; 823 } 824 825 static int bpf_ctx_finish(const union bpf_attr *kattr, 826 union bpf_attr __user *uattr, const void *data, 827 u32 size) 828 { 829 void __user *data_out = u64_to_user_ptr(kattr->test.ctx_out); 830 int err = -EFAULT; 831 u32 copy_size = size; 832 833 if (!data || !data_out) 834 return 0; 835 836 if (copy_size > kattr->test.ctx_size_out) { 837 copy_size = kattr->test.ctx_size_out; 838 err = -ENOSPC; 839 } 840 841 if (copy_to_user(data_out, data, copy_size)) 842 goto out; 843 if (copy_to_user(&uattr->test.ctx_size_out, &size, sizeof(size))) 844 goto out; 845 if (err != -ENOSPC) 846 err = 0; 847 out: 848 return err; 849 } 850 851 /** 852 * range_is_zero - test whether buffer is initialized 853 * @buf: buffer to check 854 * @from: check from this position 855 * @to: check up until (excluding) this position 856 * 857 * This function returns true if the there is a non-zero byte 858 * in the buf in the range [from,to). 859 */ 860 static inline bool range_is_zero(void *buf, size_t from, size_t to) 861 { 862 return !memchr_inv((u8 *)buf + from, 0, to - from); 863 } 864 865 static int convert___skb_to_skb(struct sk_buff *skb, struct __sk_buff *__skb) 866 { 867 struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb; 868 869 if (!__skb) 870 return 0; 871 872 /* make sure the fields we don't use are zeroed */ 873 if (!range_is_zero(__skb, 0, offsetof(struct __sk_buff, mark))) 874 return -EINVAL; 875 876 /* mark is allowed */ 877 878 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, mark), 879 offsetof(struct __sk_buff, priority))) 880 return -EINVAL; 881 882 /* priority is allowed */ 883 /* ingress_ifindex is allowed */ 884 /* ifindex is allowed */ 885 886 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, ifindex), 887 offsetof(struct __sk_buff, cb))) 888 return -EINVAL; 889 890 /* cb is allowed */ 891 892 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, cb), 893 offsetof(struct __sk_buff, tstamp))) 894 return -EINVAL; 895 896 /* tstamp is allowed */ 897 /* wire_len is allowed */ 898 /* gso_segs is allowed */ 899 900 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_segs), 901 offsetof(struct __sk_buff, gso_size))) 902 return -EINVAL; 903 904 /* gso_size is allowed */ 905 906 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, gso_size), 907 offsetof(struct __sk_buff, hwtstamp))) 908 return -EINVAL; 909 910 /* hwtstamp is allowed */ 911 912 if (!range_is_zero(__skb, offsetofend(struct __sk_buff, hwtstamp), 913 sizeof(struct __sk_buff))) 914 return -EINVAL; 915 916 skb->mark = __skb->mark; 917 skb->priority = __skb->priority; 918 skb->skb_iif = __skb->ingress_ifindex; 919 skb->tstamp = __skb->tstamp; 920 memcpy(&cb->data, __skb->cb, QDISC_CB_PRIV_LEN); 921 922 if (__skb->wire_len == 0) { 923 cb->pkt_len = skb->len; 924 } else { 925 if (__skb->wire_len < skb->len || 926 __skb->wire_len > GSO_LEGACY_MAX_SIZE) 927 return -EINVAL; 928 cb->pkt_len = __skb->wire_len; 929 } 930 931 if (__skb->gso_segs > GSO_MAX_SEGS) 932 return -EINVAL; 933 skb_shinfo(skb)->gso_segs = __skb->gso_segs; 934 skb_shinfo(skb)->gso_size = __skb->gso_size; 935 skb_shinfo(skb)->hwtstamps.hwtstamp = __skb->hwtstamp; 936 937 return 0; 938 } 939 940 static void convert_skb_to___skb(struct sk_buff *skb, struct __sk_buff *__skb) 941 { 942 struct qdisc_skb_cb *cb = (struct qdisc_skb_cb *)skb->cb; 943 944 if (!__skb) 945 return; 946 947 __skb->mark = skb->mark; 948 __skb->priority = skb->priority; 949 __skb->ingress_ifindex = skb->skb_iif; 950 __skb->ifindex = skb->dev->ifindex; 951 __skb->tstamp = skb->tstamp; 952 memcpy(__skb->cb, &cb->data, QDISC_CB_PRIV_LEN); 953 __skb->wire_len = cb->pkt_len; 954 __skb->gso_segs = skb_shinfo(skb)->gso_segs; 955 __skb->hwtstamp = skb_shinfo(skb)->hwtstamps.hwtstamp; 956 } 957 958 static struct proto bpf_dummy_proto = { 959 .name = "bpf_dummy", 960 .owner = THIS_MODULE, 961 .obj_size = sizeof(struct sock), 962 }; 963 964 int bpf_prog_test_run_skb(struct bpf_prog *prog, const union bpf_attr *kattr, 965 union bpf_attr __user *uattr) 966 { 967 bool is_l2 = false, is_direct_pkt_access = false; 968 struct net *net = current->nsproxy->net_ns; 969 struct net_device *dev = net->loopback_dev; 970 u32 size = kattr->test.data_size_in; 971 u32 repeat = kattr->test.repeat; 972 struct __sk_buff *ctx = NULL; 973 u32 retval, duration; 974 int hh_len = ETH_HLEN; 975 struct sk_buff *skb; 976 struct sock *sk; 977 void *data; 978 int ret; 979 980 if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size) 981 return -EINVAL; 982 983 data = bpf_test_init(kattr, kattr->test.data_size_in, 984 size, NET_SKB_PAD + NET_IP_ALIGN, 985 SKB_DATA_ALIGN(sizeof(struct skb_shared_info))); 986 if (IS_ERR(data)) 987 return PTR_ERR(data); 988 989 ctx = bpf_ctx_init(kattr, sizeof(struct __sk_buff)); 990 if (IS_ERR(ctx)) { 991 kfree(data); 992 return PTR_ERR(ctx); 993 } 994 995 switch (prog->type) { 996 case BPF_PROG_TYPE_SCHED_CLS: 997 case BPF_PROG_TYPE_SCHED_ACT: 998 is_l2 = true; 999 fallthrough; 1000 case BPF_PROG_TYPE_LWT_IN: 1001 case BPF_PROG_TYPE_LWT_OUT: 1002 case BPF_PROG_TYPE_LWT_XMIT: 1003 is_direct_pkt_access = true; 1004 break; 1005 default: 1006 break; 1007 } 1008 1009 sk = sk_alloc(net, AF_UNSPEC, GFP_USER, &bpf_dummy_proto, 1); 1010 if (!sk) { 1011 kfree(data); 1012 kfree(ctx); 1013 return -ENOMEM; 1014 } 1015 sock_init_data(NULL, sk); 1016 1017 skb = slab_build_skb(data); 1018 if (!skb) { 1019 kfree(data); 1020 kfree(ctx); 1021 sk_free(sk); 1022 return -ENOMEM; 1023 } 1024 skb->sk = sk; 1025 1026 skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN); 1027 __skb_put(skb, size); 1028 if (ctx && ctx->ifindex > 1) { 1029 dev = dev_get_by_index(net, ctx->ifindex); 1030 if (!dev) { 1031 ret = -ENODEV; 1032 goto out; 1033 } 1034 } 1035 skb->protocol = eth_type_trans(skb, dev); 1036 skb_reset_network_header(skb); 1037 1038 switch (skb->protocol) { 1039 case htons(ETH_P_IP): 1040 sk->sk_family = AF_INET; 1041 if (sizeof(struct iphdr) <= skb_headlen(skb)) { 1042 sk->sk_rcv_saddr = ip_hdr(skb)->saddr; 1043 sk->sk_daddr = ip_hdr(skb)->daddr; 1044 } 1045 break; 1046 #if IS_ENABLED(CONFIG_IPV6) 1047 case htons(ETH_P_IPV6): 1048 sk->sk_family = AF_INET6; 1049 if (sizeof(struct ipv6hdr) <= skb_headlen(skb)) { 1050 sk->sk_v6_rcv_saddr = ipv6_hdr(skb)->saddr; 1051 sk->sk_v6_daddr = ipv6_hdr(skb)->daddr; 1052 } 1053 break; 1054 #endif 1055 default: 1056 break; 1057 } 1058 1059 if (is_l2) 1060 __skb_push(skb, hh_len); 1061 if (is_direct_pkt_access) 1062 bpf_compute_data_pointers(skb); 1063 ret = convert___skb_to_skb(skb, ctx); 1064 if (ret) 1065 goto out; 1066 ret = bpf_test_run(prog, skb, repeat, &retval, &duration, false); 1067 if (ret) 1068 goto out; 1069 if (!is_l2) { 1070 if (skb_headroom(skb) < hh_len) { 1071 int nhead = HH_DATA_ALIGN(hh_len - skb_headroom(skb)); 1072 1073 if (pskb_expand_head(skb, nhead, 0, GFP_USER)) { 1074 ret = -ENOMEM; 1075 goto out; 1076 } 1077 } 1078 memset(__skb_push(skb, hh_len), 0, hh_len); 1079 } 1080 convert_skb_to___skb(skb, ctx); 1081 1082 size = skb->len; 1083 /* bpf program can never convert linear skb to non-linear */ 1084 if (WARN_ON_ONCE(skb_is_nonlinear(skb))) 1085 size = skb_headlen(skb); 1086 ret = bpf_test_finish(kattr, uattr, skb->data, NULL, size, retval, 1087 duration); 1088 if (!ret) 1089 ret = bpf_ctx_finish(kattr, uattr, ctx, 1090 sizeof(struct __sk_buff)); 1091 out: 1092 if (dev && dev != net->loopback_dev) 1093 dev_put(dev); 1094 kfree_skb(skb); 1095 sk_free(sk); 1096 kfree(ctx); 1097 return ret; 1098 } 1099 1100 static int xdp_convert_md_to_buff(struct xdp_md *xdp_md, struct xdp_buff *xdp) 1101 { 1102 unsigned int ingress_ifindex, rx_queue_index; 1103 struct netdev_rx_queue *rxqueue; 1104 struct net_device *device; 1105 1106 if (!xdp_md) 1107 return 0; 1108 1109 if (xdp_md->egress_ifindex != 0) 1110 return -EINVAL; 1111 1112 ingress_ifindex = xdp_md->ingress_ifindex; 1113 rx_queue_index = xdp_md->rx_queue_index; 1114 1115 if (!ingress_ifindex && rx_queue_index) 1116 return -EINVAL; 1117 1118 if (ingress_ifindex) { 1119 device = dev_get_by_index(current->nsproxy->net_ns, 1120 ingress_ifindex); 1121 if (!device) 1122 return -ENODEV; 1123 1124 if (rx_queue_index >= device->real_num_rx_queues) 1125 goto free_dev; 1126 1127 rxqueue = __netif_get_rx_queue(device, rx_queue_index); 1128 1129 if (!xdp_rxq_info_is_reg(&rxqueue->xdp_rxq)) 1130 goto free_dev; 1131 1132 xdp->rxq = &rxqueue->xdp_rxq; 1133 /* The device is now tracked in the xdp->rxq for later 1134 * dev_put() 1135 */ 1136 } 1137 1138 xdp->data = xdp->data_meta + xdp_md->data; 1139 return 0; 1140 1141 free_dev: 1142 dev_put(device); 1143 return -EINVAL; 1144 } 1145 1146 static void xdp_convert_buff_to_md(struct xdp_buff *xdp, struct xdp_md *xdp_md) 1147 { 1148 if (!xdp_md) 1149 return; 1150 1151 xdp_md->data = xdp->data - xdp->data_meta; 1152 xdp_md->data_end = xdp->data_end - xdp->data_meta; 1153 1154 if (xdp_md->ingress_ifindex) 1155 dev_put(xdp->rxq->dev); 1156 } 1157 1158 int bpf_prog_test_run_xdp(struct bpf_prog *prog, const union bpf_attr *kattr, 1159 union bpf_attr __user *uattr) 1160 { 1161 bool do_live = (kattr->test.flags & BPF_F_TEST_XDP_LIVE_FRAMES); 1162 u32 tailroom = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)); 1163 u32 batch_size = kattr->test.batch_size; 1164 u32 retval = 0, duration, max_data_sz; 1165 u32 size = kattr->test.data_size_in; 1166 u32 headroom = XDP_PACKET_HEADROOM; 1167 u32 repeat = kattr->test.repeat; 1168 struct netdev_rx_queue *rxqueue; 1169 struct skb_shared_info *sinfo; 1170 struct xdp_buff xdp = {}; 1171 int i, ret = -EINVAL; 1172 struct xdp_md *ctx; 1173 void *data; 1174 1175 if (prog->expected_attach_type == BPF_XDP_DEVMAP || 1176 prog->expected_attach_type == BPF_XDP_CPUMAP) 1177 return -EINVAL; 1178 1179 if (kattr->test.flags & ~BPF_F_TEST_XDP_LIVE_FRAMES) 1180 return -EINVAL; 1181 1182 if (bpf_prog_is_dev_bound(prog->aux)) 1183 return -EINVAL; 1184 1185 if (do_live) { 1186 if (!batch_size) 1187 batch_size = NAPI_POLL_WEIGHT; 1188 else if (batch_size > TEST_XDP_MAX_BATCH) 1189 return -E2BIG; 1190 1191 headroom += sizeof(struct xdp_page_head); 1192 } else if (batch_size) { 1193 return -EINVAL; 1194 } 1195 1196 ctx = bpf_ctx_init(kattr, sizeof(struct xdp_md)); 1197 if (IS_ERR(ctx)) 1198 return PTR_ERR(ctx); 1199 1200 if (ctx) { 1201 /* There can't be user provided data before the meta data */ 1202 if (ctx->data_meta || ctx->data_end != size || 1203 ctx->data > ctx->data_end || 1204 unlikely(xdp_metalen_invalid(ctx->data)) || 1205 (do_live && (kattr->test.data_out || kattr->test.ctx_out))) 1206 goto free_ctx; 1207 /* Meta data is allocated from the headroom */ 1208 headroom -= ctx->data; 1209 } 1210 1211 max_data_sz = 4096 - headroom - tailroom; 1212 if (size > max_data_sz) { 1213 /* disallow live data mode for jumbo frames */ 1214 if (do_live) 1215 goto free_ctx; 1216 size = max_data_sz; 1217 } 1218 1219 data = bpf_test_init(kattr, size, max_data_sz, headroom, tailroom); 1220 if (IS_ERR(data)) { 1221 ret = PTR_ERR(data); 1222 goto free_ctx; 1223 } 1224 1225 rxqueue = __netif_get_rx_queue(current->nsproxy->net_ns->loopback_dev, 0); 1226 rxqueue->xdp_rxq.frag_size = headroom + max_data_sz + tailroom; 1227 xdp_init_buff(&xdp, rxqueue->xdp_rxq.frag_size, &rxqueue->xdp_rxq); 1228 xdp_prepare_buff(&xdp, data, headroom, size, true); 1229 sinfo = xdp_get_shared_info_from_buff(&xdp); 1230 1231 ret = xdp_convert_md_to_buff(ctx, &xdp); 1232 if (ret) 1233 goto free_data; 1234 1235 if (unlikely(kattr->test.data_size_in > size)) { 1236 void __user *data_in = u64_to_user_ptr(kattr->test.data_in); 1237 1238 while (size < kattr->test.data_size_in) { 1239 struct page *page; 1240 skb_frag_t *frag; 1241 u32 data_len; 1242 1243 if (sinfo->nr_frags == MAX_SKB_FRAGS) { 1244 ret = -ENOMEM; 1245 goto out; 1246 } 1247 1248 page = alloc_page(GFP_KERNEL); 1249 if (!page) { 1250 ret = -ENOMEM; 1251 goto out; 1252 } 1253 1254 frag = &sinfo->frags[sinfo->nr_frags++]; 1255 1256 data_len = min_t(u32, kattr->test.data_size_in - size, 1257 PAGE_SIZE); 1258 skb_frag_fill_page_desc(frag, page, 0, data_len); 1259 1260 if (copy_from_user(page_address(page), data_in + size, 1261 data_len)) { 1262 ret = -EFAULT; 1263 goto out; 1264 } 1265 sinfo->xdp_frags_size += data_len; 1266 size += data_len; 1267 } 1268 xdp_buff_set_frags_flag(&xdp); 1269 } 1270 1271 if (repeat > 1) 1272 bpf_prog_change_xdp(NULL, prog); 1273 1274 if (do_live) 1275 ret = bpf_test_run_xdp_live(prog, &xdp, repeat, batch_size, &duration); 1276 else 1277 ret = bpf_test_run(prog, &xdp, repeat, &retval, &duration, true); 1278 /* We convert the xdp_buff back to an xdp_md before checking the return 1279 * code so the reference count of any held netdevice will be decremented 1280 * even if the test run failed. 1281 */ 1282 xdp_convert_buff_to_md(&xdp, ctx); 1283 if (ret) 1284 goto out; 1285 1286 size = xdp.data_end - xdp.data_meta + sinfo->xdp_frags_size; 1287 ret = bpf_test_finish(kattr, uattr, xdp.data_meta, sinfo, size, 1288 retval, duration); 1289 if (!ret) 1290 ret = bpf_ctx_finish(kattr, uattr, ctx, 1291 sizeof(struct xdp_md)); 1292 1293 out: 1294 if (repeat > 1) 1295 bpf_prog_change_xdp(prog, NULL); 1296 free_data: 1297 for (i = 0; i < sinfo->nr_frags; i++) 1298 __free_page(skb_frag_page(&sinfo->frags[i])); 1299 kfree(data); 1300 free_ctx: 1301 kfree(ctx); 1302 return ret; 1303 } 1304 1305 static int verify_user_bpf_flow_keys(struct bpf_flow_keys *ctx) 1306 { 1307 /* make sure the fields we don't use are zeroed */ 1308 if (!range_is_zero(ctx, 0, offsetof(struct bpf_flow_keys, flags))) 1309 return -EINVAL; 1310 1311 /* flags is allowed */ 1312 1313 if (!range_is_zero(ctx, offsetofend(struct bpf_flow_keys, flags), 1314 sizeof(struct bpf_flow_keys))) 1315 return -EINVAL; 1316 1317 return 0; 1318 } 1319 1320 int bpf_prog_test_run_flow_dissector(struct bpf_prog *prog, 1321 const union bpf_attr *kattr, 1322 union bpf_attr __user *uattr) 1323 { 1324 struct bpf_test_timer t = { NO_PREEMPT }; 1325 u32 size = kattr->test.data_size_in; 1326 struct bpf_flow_dissector ctx = {}; 1327 u32 repeat = kattr->test.repeat; 1328 struct bpf_flow_keys *user_ctx; 1329 struct bpf_flow_keys flow_keys; 1330 const struct ethhdr *eth; 1331 unsigned int flags = 0; 1332 u32 retval, duration; 1333 void *data; 1334 int ret; 1335 1336 if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size) 1337 return -EINVAL; 1338 1339 if (size < ETH_HLEN) 1340 return -EINVAL; 1341 1342 data = bpf_test_init(kattr, kattr->test.data_size_in, size, 0, 0); 1343 if (IS_ERR(data)) 1344 return PTR_ERR(data); 1345 1346 eth = (struct ethhdr *)data; 1347 1348 if (!repeat) 1349 repeat = 1; 1350 1351 user_ctx = bpf_ctx_init(kattr, sizeof(struct bpf_flow_keys)); 1352 if (IS_ERR(user_ctx)) { 1353 kfree(data); 1354 return PTR_ERR(user_ctx); 1355 } 1356 if (user_ctx) { 1357 ret = verify_user_bpf_flow_keys(user_ctx); 1358 if (ret) 1359 goto out; 1360 flags = user_ctx->flags; 1361 } 1362 1363 ctx.flow_keys = &flow_keys; 1364 ctx.data = data; 1365 ctx.data_end = (__u8 *)data + size; 1366 1367 bpf_test_timer_enter(&t); 1368 do { 1369 retval = bpf_flow_dissect(prog, &ctx, eth->h_proto, ETH_HLEN, 1370 size, flags); 1371 } while (bpf_test_timer_continue(&t, 1, repeat, &ret, &duration)); 1372 bpf_test_timer_leave(&t); 1373 1374 if (ret < 0) 1375 goto out; 1376 1377 ret = bpf_test_finish(kattr, uattr, &flow_keys, NULL, 1378 sizeof(flow_keys), retval, duration); 1379 if (!ret) 1380 ret = bpf_ctx_finish(kattr, uattr, user_ctx, 1381 sizeof(struct bpf_flow_keys)); 1382 1383 out: 1384 kfree(user_ctx); 1385 kfree(data); 1386 return ret; 1387 } 1388 1389 int bpf_prog_test_run_sk_lookup(struct bpf_prog *prog, const union bpf_attr *kattr, 1390 union bpf_attr __user *uattr) 1391 { 1392 struct bpf_test_timer t = { NO_PREEMPT }; 1393 struct bpf_prog_array *progs = NULL; 1394 struct bpf_sk_lookup_kern ctx = {}; 1395 u32 repeat = kattr->test.repeat; 1396 struct bpf_sk_lookup *user_ctx; 1397 u32 retval, duration; 1398 int ret = -EINVAL; 1399 1400 if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size) 1401 return -EINVAL; 1402 1403 if (kattr->test.data_in || kattr->test.data_size_in || kattr->test.data_out || 1404 kattr->test.data_size_out) 1405 return -EINVAL; 1406 1407 if (!repeat) 1408 repeat = 1; 1409 1410 user_ctx = bpf_ctx_init(kattr, sizeof(*user_ctx)); 1411 if (IS_ERR(user_ctx)) 1412 return PTR_ERR(user_ctx); 1413 1414 if (!user_ctx) 1415 return -EINVAL; 1416 1417 if (user_ctx->sk) 1418 goto out; 1419 1420 if (!range_is_zero(user_ctx, offsetofend(typeof(*user_ctx), local_port), sizeof(*user_ctx))) 1421 goto out; 1422 1423 if (user_ctx->local_port > U16_MAX) { 1424 ret = -ERANGE; 1425 goto out; 1426 } 1427 1428 ctx.family = (u16)user_ctx->family; 1429 ctx.protocol = (u16)user_ctx->protocol; 1430 ctx.dport = (u16)user_ctx->local_port; 1431 ctx.sport = user_ctx->remote_port; 1432 1433 switch (ctx.family) { 1434 case AF_INET: 1435 ctx.v4.daddr = (__force __be32)user_ctx->local_ip4; 1436 ctx.v4.saddr = (__force __be32)user_ctx->remote_ip4; 1437 break; 1438 1439 #if IS_ENABLED(CONFIG_IPV6) 1440 case AF_INET6: 1441 ctx.v6.daddr = (struct in6_addr *)user_ctx->local_ip6; 1442 ctx.v6.saddr = (struct in6_addr *)user_ctx->remote_ip6; 1443 break; 1444 #endif 1445 1446 default: 1447 ret = -EAFNOSUPPORT; 1448 goto out; 1449 } 1450 1451 progs = bpf_prog_array_alloc(1, GFP_KERNEL); 1452 if (!progs) { 1453 ret = -ENOMEM; 1454 goto out; 1455 } 1456 1457 progs->items[0].prog = prog; 1458 1459 bpf_test_timer_enter(&t); 1460 do { 1461 ctx.selected_sk = NULL; 1462 retval = BPF_PROG_SK_LOOKUP_RUN_ARRAY(progs, ctx, bpf_prog_run); 1463 } while (bpf_test_timer_continue(&t, 1, repeat, &ret, &duration)); 1464 bpf_test_timer_leave(&t); 1465 1466 if (ret < 0) 1467 goto out; 1468 1469 user_ctx->cookie = 0; 1470 if (ctx.selected_sk) { 1471 if (ctx.selected_sk->sk_reuseport && !ctx.no_reuseport) { 1472 ret = -EOPNOTSUPP; 1473 goto out; 1474 } 1475 1476 user_ctx->cookie = sock_gen_cookie(ctx.selected_sk); 1477 } 1478 1479 ret = bpf_test_finish(kattr, uattr, NULL, NULL, 0, retval, duration); 1480 if (!ret) 1481 ret = bpf_ctx_finish(kattr, uattr, user_ctx, sizeof(*user_ctx)); 1482 1483 out: 1484 bpf_prog_array_free(progs); 1485 kfree(user_ctx); 1486 return ret; 1487 } 1488 1489 int bpf_prog_test_run_syscall(struct bpf_prog *prog, 1490 const union bpf_attr *kattr, 1491 union bpf_attr __user *uattr) 1492 { 1493 void __user *ctx_in = u64_to_user_ptr(kattr->test.ctx_in); 1494 __u32 ctx_size_in = kattr->test.ctx_size_in; 1495 void *ctx = NULL; 1496 u32 retval; 1497 int err = 0; 1498 1499 /* doesn't support data_in/out, ctx_out, duration, or repeat or flags */ 1500 if (kattr->test.data_in || kattr->test.data_out || 1501 kattr->test.ctx_out || kattr->test.duration || 1502 kattr->test.repeat || kattr->test.flags || 1503 kattr->test.batch_size) 1504 return -EINVAL; 1505 1506 if (ctx_size_in < prog->aux->max_ctx_offset || 1507 ctx_size_in > U16_MAX) 1508 return -EINVAL; 1509 1510 if (ctx_size_in) { 1511 ctx = memdup_user(ctx_in, ctx_size_in); 1512 if (IS_ERR(ctx)) 1513 return PTR_ERR(ctx); 1514 } 1515 1516 rcu_read_lock_trace(); 1517 retval = bpf_prog_run_pin_on_cpu(prog, ctx); 1518 rcu_read_unlock_trace(); 1519 1520 if (copy_to_user(&uattr->test.retval, &retval, sizeof(u32))) { 1521 err = -EFAULT; 1522 goto out; 1523 } 1524 if (ctx_size_in) 1525 if (copy_to_user(ctx_in, ctx, ctx_size_in)) 1526 err = -EFAULT; 1527 out: 1528 kfree(ctx); 1529 return err; 1530 } 1531 1532 static int verify_and_copy_hook_state(struct nf_hook_state *state, 1533 const struct nf_hook_state *user, 1534 struct net_device *dev) 1535 { 1536 if (user->in || user->out) 1537 return -EINVAL; 1538 1539 if (user->net || user->sk || user->okfn) 1540 return -EINVAL; 1541 1542 switch (user->pf) { 1543 case NFPROTO_IPV4: 1544 case NFPROTO_IPV6: 1545 switch (state->hook) { 1546 case NF_INET_PRE_ROUTING: 1547 state->in = dev; 1548 break; 1549 case NF_INET_LOCAL_IN: 1550 state->in = dev; 1551 break; 1552 case NF_INET_FORWARD: 1553 state->in = dev; 1554 state->out = dev; 1555 break; 1556 case NF_INET_LOCAL_OUT: 1557 state->out = dev; 1558 break; 1559 case NF_INET_POST_ROUTING: 1560 state->out = dev; 1561 break; 1562 } 1563 1564 break; 1565 default: 1566 return -EINVAL; 1567 } 1568 1569 state->pf = user->pf; 1570 state->hook = user->hook; 1571 1572 return 0; 1573 } 1574 1575 static __be16 nfproto_eth(int nfproto) 1576 { 1577 switch (nfproto) { 1578 case NFPROTO_IPV4: 1579 return htons(ETH_P_IP); 1580 case NFPROTO_IPV6: 1581 break; 1582 } 1583 1584 return htons(ETH_P_IPV6); 1585 } 1586 1587 int bpf_prog_test_run_nf(struct bpf_prog *prog, 1588 const union bpf_attr *kattr, 1589 union bpf_attr __user *uattr) 1590 { 1591 struct net *net = current->nsproxy->net_ns; 1592 struct net_device *dev = net->loopback_dev; 1593 struct nf_hook_state *user_ctx, hook_state = { 1594 .pf = NFPROTO_IPV4, 1595 .hook = NF_INET_LOCAL_OUT, 1596 }; 1597 u32 size = kattr->test.data_size_in; 1598 u32 repeat = kattr->test.repeat; 1599 struct bpf_nf_ctx ctx = { 1600 .state = &hook_state, 1601 }; 1602 struct sk_buff *skb = NULL; 1603 u32 retval, duration; 1604 void *data; 1605 int ret; 1606 1607 if (kattr->test.flags || kattr->test.cpu || kattr->test.batch_size) 1608 return -EINVAL; 1609 1610 if (size < sizeof(struct iphdr)) 1611 return -EINVAL; 1612 1613 data = bpf_test_init(kattr, kattr->test.data_size_in, size, 1614 NET_SKB_PAD + NET_IP_ALIGN, 1615 SKB_DATA_ALIGN(sizeof(struct skb_shared_info))); 1616 if (IS_ERR(data)) 1617 return PTR_ERR(data); 1618 1619 if (!repeat) 1620 repeat = 1; 1621 1622 user_ctx = bpf_ctx_init(kattr, sizeof(struct nf_hook_state)); 1623 if (IS_ERR(user_ctx)) { 1624 kfree(data); 1625 return PTR_ERR(user_ctx); 1626 } 1627 1628 if (user_ctx) { 1629 ret = verify_and_copy_hook_state(&hook_state, user_ctx, dev); 1630 if (ret) 1631 goto out; 1632 } 1633 1634 skb = slab_build_skb(data); 1635 if (!skb) { 1636 ret = -ENOMEM; 1637 goto out; 1638 } 1639 1640 data = NULL; /* data released via kfree_skb */ 1641 1642 skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN); 1643 __skb_put(skb, size); 1644 1645 ret = -EINVAL; 1646 1647 if (hook_state.hook != NF_INET_LOCAL_OUT) { 1648 if (size < ETH_HLEN + sizeof(struct iphdr)) 1649 goto out; 1650 1651 skb->protocol = eth_type_trans(skb, dev); 1652 switch (skb->protocol) { 1653 case htons(ETH_P_IP): 1654 if (hook_state.pf == NFPROTO_IPV4) 1655 break; 1656 goto out; 1657 case htons(ETH_P_IPV6): 1658 if (size < ETH_HLEN + sizeof(struct ipv6hdr)) 1659 goto out; 1660 if (hook_state.pf == NFPROTO_IPV6) 1661 break; 1662 goto out; 1663 default: 1664 ret = -EPROTO; 1665 goto out; 1666 } 1667 1668 skb_reset_network_header(skb); 1669 } else { 1670 skb->protocol = nfproto_eth(hook_state.pf); 1671 } 1672 1673 ctx.skb = skb; 1674 1675 ret = bpf_test_run(prog, &ctx, repeat, &retval, &duration, false); 1676 if (ret) 1677 goto out; 1678 1679 ret = bpf_test_finish(kattr, uattr, NULL, NULL, 0, retval, duration); 1680 1681 out: 1682 kfree(user_ctx); 1683 kfree_skb(skb); 1684 kfree(data); 1685 return ret; 1686 } 1687 1688 static const struct btf_kfunc_id_set bpf_prog_test_kfunc_set = { 1689 .owner = THIS_MODULE, 1690 .set = &test_sk_check_kfunc_ids, 1691 }; 1692 1693 BTF_ID_LIST(bpf_prog_test_dtor_kfunc_ids) 1694 BTF_ID(struct, prog_test_ref_kfunc) 1695 BTF_ID(func, bpf_kfunc_call_test_release_dtor) 1696 BTF_ID(struct, prog_test_member) 1697 BTF_ID(func, bpf_kfunc_call_memb_release_dtor) 1698 1699 static int __init bpf_prog_test_run_init(void) 1700 { 1701 const struct btf_id_dtor_kfunc bpf_prog_test_dtor_kfunc[] = { 1702 { 1703 .btf_id = bpf_prog_test_dtor_kfunc_ids[0], 1704 .kfunc_btf_id = bpf_prog_test_dtor_kfunc_ids[1] 1705 }, 1706 { 1707 .btf_id = bpf_prog_test_dtor_kfunc_ids[2], 1708 .kfunc_btf_id = bpf_prog_test_dtor_kfunc_ids[3], 1709 }, 1710 }; 1711 int ret; 1712 1713 ret = register_btf_fmodret_id_set(&bpf_test_modify_return_set); 1714 ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_SCHED_CLS, &bpf_prog_test_kfunc_set); 1715 ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_TRACING, &bpf_prog_test_kfunc_set); 1716 ret = ret ?: register_btf_kfunc_id_set(BPF_PROG_TYPE_SYSCALL, &bpf_prog_test_kfunc_set); 1717 return ret ?: register_btf_id_dtor_kfuncs(bpf_prog_test_dtor_kfunc, 1718 ARRAY_SIZE(bpf_prog_test_dtor_kfunc), 1719 THIS_MODULE); 1720 } 1721 late_initcall(bpf_prog_test_run_init); 1722