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