1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (c) 2018 Facebook
10 #include <arpa/inet.h>
11 #include <netinet/in.h>
12 #include <sys/types.h>
13 #include <sys/select.h>
14 #include <sys/socket.h>
16 #include <linux/filter.h>
19 #include <bpf/libbpf.h>
21 #include "cgroup_helpers.h"
22 #include "bpf_rlimit.h"
29 #define CG_PATH "/foo"
30 #define CONNECT4_PROG_PATH "./connect4_prog.o"
31 #define CONNECT6_PROG_PATH "./connect6_prog.o"
32 #define SENDMSG4_PROG_PATH "./sendmsg4_prog.o"
33 #define SENDMSG6_PROG_PATH "./sendmsg6_prog.o"
35 #define SERV4_IP "192.168.1.254"
36 #define SERV4_REWRITE_IP "127.0.0.1"
37 #define SRC4_IP "172.16.0.1"
38 #define SRC4_REWRITE_IP "127.0.0.4"
39 #define SERV4_PORT 4040
40 #define SERV4_REWRITE_PORT 4444
42 #define SERV6_IP "face:b00c:1234:5678::abcd"
43 #define SERV6_REWRITE_IP "::1"
44 #define SERV6_V4MAPPED_IP "::ffff:192.168.0.4"
46 #define SRC6_REWRITE_IP "::6"
47 #define WILDCARD6_IP "::"
48 #define SERV6_PORT 6060
49 #define SERV6_REWRITE_PORT 6666
51 #define INET_NTOP_BUF 40
53 struct sock_addr_test;
55 typedef int (*load_fn)(const struct sock_addr_test *test);
56 typedef int (*info_fn)(int, struct sockaddr *, socklen_t *);
58 char bpf_log_buf[BPF_LOG_BUF_SIZE];
60 struct sock_addr_test {
62 /* BPF prog properties */
64 enum bpf_attach_type expected_attach_type;
65 enum bpf_attach_type attach_type;
66 /* Socket properties */
69 /* IP:port pairs for BPF prog to override */
70 const char *requested_ip;
71 unsigned short requested_port;
72 const char *expected_ip;
73 unsigned short expected_port;
74 const char *expected_src_ip;
75 /* Expected test result */
85 static int bind4_prog_load(const struct sock_addr_test *test);
86 static int bind6_prog_load(const struct sock_addr_test *test);
87 static int connect4_prog_load(const struct sock_addr_test *test);
88 static int connect6_prog_load(const struct sock_addr_test *test);
89 static int sendmsg_allow_prog_load(const struct sock_addr_test *test);
90 static int sendmsg_deny_prog_load(const struct sock_addr_test *test);
91 static int sendmsg4_rw_asm_prog_load(const struct sock_addr_test *test);
92 static int sendmsg4_rw_c_prog_load(const struct sock_addr_test *test);
93 static int sendmsg6_rw_asm_prog_load(const struct sock_addr_test *test);
94 static int sendmsg6_rw_c_prog_load(const struct sock_addr_test *test);
95 static int sendmsg6_rw_v4mapped_prog_load(const struct sock_addr_test *test);
96 static int sendmsg6_rw_wildcard_prog_load(const struct sock_addr_test *test);
98 static struct sock_addr_test tests[] = {
101 "bind4: load prog with wrong expected attach type",
103 BPF_CGROUP_INET6_BIND,
104 BPF_CGROUP_INET4_BIND,
115 "bind4: attach prog with wrong attach type",
117 BPF_CGROUP_INET4_BIND,
118 BPF_CGROUP_INET6_BIND,
129 "bind4: rewrite IP & TCP port in",
131 BPF_CGROUP_INET4_BIND,
132 BPF_CGROUP_INET4_BIND,
143 "bind4: rewrite IP & UDP port in",
145 BPF_CGROUP_INET4_BIND,
146 BPF_CGROUP_INET4_BIND,
157 "bind6: load prog with wrong expected attach type",
159 BPF_CGROUP_INET4_BIND,
160 BPF_CGROUP_INET6_BIND,
171 "bind6: attach prog with wrong attach type",
173 BPF_CGROUP_INET6_BIND,
174 BPF_CGROUP_INET4_BIND,
185 "bind6: rewrite IP & TCP port in",
187 BPF_CGROUP_INET6_BIND,
188 BPF_CGROUP_INET6_BIND,
199 "bind6: rewrite IP & UDP port in",
201 BPF_CGROUP_INET6_BIND,
202 BPF_CGROUP_INET6_BIND,
215 "connect4: load prog with wrong expected attach type",
217 BPF_CGROUP_INET6_CONNECT,
218 BPF_CGROUP_INET4_CONNECT,
229 "connect4: attach prog with wrong attach type",
231 BPF_CGROUP_INET4_CONNECT,
232 BPF_CGROUP_INET6_CONNECT,
243 "connect4: rewrite IP & TCP port",
245 BPF_CGROUP_INET4_CONNECT,
246 BPF_CGROUP_INET4_CONNECT,
257 "connect4: rewrite IP & UDP port",
259 BPF_CGROUP_INET4_CONNECT,
260 BPF_CGROUP_INET4_CONNECT,
271 "connect6: load prog with wrong expected attach type",
273 BPF_CGROUP_INET4_CONNECT,
274 BPF_CGROUP_INET6_CONNECT,
285 "connect6: attach prog with wrong attach type",
287 BPF_CGROUP_INET6_CONNECT,
288 BPF_CGROUP_INET4_CONNECT,
299 "connect6: rewrite IP & TCP port",
301 BPF_CGROUP_INET6_CONNECT,
302 BPF_CGROUP_INET6_CONNECT,
313 "connect6: rewrite IP & UDP port",
315 BPF_CGROUP_INET6_CONNECT,
316 BPF_CGROUP_INET6_CONNECT,
329 "sendmsg4: load prog with wrong expected attach type",
330 sendmsg4_rw_asm_prog_load,
331 BPF_CGROUP_UDP6_SENDMSG,
332 BPF_CGROUP_UDP4_SENDMSG,
343 "sendmsg4: attach prog with wrong attach type",
344 sendmsg4_rw_asm_prog_load,
345 BPF_CGROUP_UDP4_SENDMSG,
346 BPF_CGROUP_UDP6_SENDMSG,
357 "sendmsg4: rewrite IP & port (asm)",
358 sendmsg4_rw_asm_prog_load,
359 BPF_CGROUP_UDP4_SENDMSG,
360 BPF_CGROUP_UDP4_SENDMSG,
371 "sendmsg4: rewrite IP & port (C)",
372 sendmsg4_rw_c_prog_load,
373 BPF_CGROUP_UDP4_SENDMSG,
374 BPF_CGROUP_UDP4_SENDMSG,
385 "sendmsg4: deny call",
386 sendmsg_deny_prog_load,
387 BPF_CGROUP_UDP4_SENDMSG,
388 BPF_CGROUP_UDP4_SENDMSG,
399 "sendmsg6: load prog with wrong expected attach type",
400 sendmsg6_rw_asm_prog_load,
401 BPF_CGROUP_UDP4_SENDMSG,
402 BPF_CGROUP_UDP6_SENDMSG,
413 "sendmsg6: attach prog with wrong attach type",
414 sendmsg6_rw_asm_prog_load,
415 BPF_CGROUP_UDP6_SENDMSG,
416 BPF_CGROUP_UDP4_SENDMSG,
427 "sendmsg6: rewrite IP & port (asm)",
428 sendmsg6_rw_asm_prog_load,
429 BPF_CGROUP_UDP6_SENDMSG,
430 BPF_CGROUP_UDP6_SENDMSG,
441 "sendmsg6: rewrite IP & port (C)",
442 sendmsg6_rw_c_prog_load,
443 BPF_CGROUP_UDP6_SENDMSG,
444 BPF_CGROUP_UDP6_SENDMSG,
455 "sendmsg6: IPv4-mapped IPv6",
456 sendmsg6_rw_v4mapped_prog_load,
457 BPF_CGROUP_UDP6_SENDMSG,
458 BPF_CGROUP_UDP6_SENDMSG,
469 "sendmsg6: set dst IP = [::] (BSD'ism)",
470 sendmsg6_rw_wildcard_prog_load,
471 BPF_CGROUP_UDP6_SENDMSG,
472 BPF_CGROUP_UDP6_SENDMSG,
483 "sendmsg6: preserve dst IP = [::] (BSD'ism)",
484 sendmsg_allow_prog_load,
485 BPF_CGROUP_UDP6_SENDMSG,
486 BPF_CGROUP_UDP6_SENDMSG,
497 "sendmsg6: deny call",
498 sendmsg_deny_prog_load,
499 BPF_CGROUP_UDP6_SENDMSG,
500 BPF_CGROUP_UDP6_SENDMSG,
512 static int mk_sockaddr(int domain, const char *ip, unsigned short port,
513 struct sockaddr *addr, socklen_t addr_len)
515 struct sockaddr_in6 *addr6;
516 struct sockaddr_in *addr4;
518 if (domain != AF_INET && domain != AF_INET6) {
519 log_err("Unsupported address family");
523 memset(addr, 0, addr_len);
525 if (domain == AF_INET) {
526 if (addr_len < sizeof(struct sockaddr_in))
528 addr4 = (struct sockaddr_in *)addr;
529 addr4->sin_family = domain;
530 addr4->sin_port = htons(port);
531 if (inet_pton(domain, ip, (void *)&addr4->sin_addr) != 1) {
532 log_err("Invalid IPv4: %s", ip);
535 } else if (domain == AF_INET6) {
536 if (addr_len < sizeof(struct sockaddr_in6))
538 addr6 = (struct sockaddr_in6 *)addr;
539 addr6->sin6_family = domain;
540 addr6->sin6_port = htons(port);
541 if (inet_pton(domain, ip, (void *)&addr6->sin6_addr) != 1) {
542 log_err("Invalid IPv6: %s", ip);
550 static int load_insns(const struct sock_addr_test *test,
551 const struct bpf_insn *insns, size_t insns_cnt)
553 struct bpf_load_program_attr load_attr;
556 memset(&load_attr, 0, sizeof(struct bpf_load_program_attr));
557 load_attr.prog_type = BPF_PROG_TYPE_CGROUP_SOCK_ADDR;
558 load_attr.expected_attach_type = test->expected_attach_type;
559 load_attr.insns = insns;
560 load_attr.insns_cnt = insns_cnt;
561 load_attr.license = "GPL";
563 ret = bpf_load_program_xattr(&load_attr, bpf_log_buf, BPF_LOG_BUF_SIZE);
564 if (ret < 0 && test->expected_result != LOAD_REJECT) {
565 log_err(">>> Loading program error.\n"
566 ">>> Verifier output:\n%s\n-------\n", bpf_log_buf);
572 /* [1] These testing programs try to read different context fields, including
573 * narrow loads of different sizes from user_ip4 and user_ip6, and write to
574 * those allowed to be overridden.
576 * [2] BPF_LD_IMM64 & BPF_JMP_REG are used below whenever there is a need to
577 * compare a register with unsigned 32bit integer. BPF_JMP_IMM can't be used
578 * in such cases since it accepts only _signed_ 32bit integer as IMM
579 * argument. Also note that BPF_LD_IMM64 contains 2 instructions what matters
580 * to count jumps properly.
583 static int bind4_prog_load(const struct sock_addr_test *test)
587 uint16_t u4_addr16[2];
590 struct sockaddr_in addr4_rw;
592 if (inet_pton(AF_INET, SERV4_IP, (void *)&ip4) != 1) {
593 log_err("Invalid IPv4: %s", SERV4_IP);
597 if (mk_sockaddr(AF_INET, SERV4_REWRITE_IP, SERV4_REWRITE_PORT,
598 (struct sockaddr *)&addr4_rw, sizeof(addr4_rw)) == -1)
602 struct bpf_insn insns[] = {
603 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
605 /* if (sk.family == AF_INET && */
606 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
607 offsetof(struct bpf_sock_addr, family)),
608 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET, 24),
610 /* (sk.type == SOCK_DGRAM || sk.type == SOCK_STREAM) && */
611 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
612 offsetof(struct bpf_sock_addr, type)),
613 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, SOCK_DGRAM, 1),
615 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, SOCK_STREAM, 20),
617 /* 1st_byte_of_user_ip4 == expected && */
618 BPF_LDX_MEM(BPF_B, BPF_REG_7, BPF_REG_6,
619 offsetof(struct bpf_sock_addr, user_ip4)),
620 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr8[0], 18),
622 /* 2nd_byte_of_user_ip4 == expected && */
623 BPF_LDX_MEM(BPF_B, BPF_REG_7, BPF_REG_6,
624 offsetof(struct bpf_sock_addr, user_ip4) + 1),
625 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr8[1], 16),
627 /* 3rd_byte_of_user_ip4 == expected && */
628 BPF_LDX_MEM(BPF_B, BPF_REG_7, BPF_REG_6,
629 offsetof(struct bpf_sock_addr, user_ip4) + 2),
630 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr8[2], 14),
632 /* 4th_byte_of_user_ip4 == expected && */
633 BPF_LDX_MEM(BPF_B, BPF_REG_7, BPF_REG_6,
634 offsetof(struct bpf_sock_addr, user_ip4) + 3),
635 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr8[3], 12),
637 /* 1st_half_of_user_ip4 == expected && */
638 BPF_LDX_MEM(BPF_H, BPF_REG_7, BPF_REG_6,
639 offsetof(struct bpf_sock_addr, user_ip4)),
640 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr16[0], 10),
642 /* 2nd_half_of_user_ip4 == expected && */
643 BPF_LDX_MEM(BPF_H, BPF_REG_7, BPF_REG_6,
644 offsetof(struct bpf_sock_addr, user_ip4) + 2),
645 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip4.u4_addr16[1], 8),
647 /* whole_user_ip4 == expected) { */
648 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
649 offsetof(struct bpf_sock_addr, user_ip4)),
650 BPF_LD_IMM64(BPF_REG_8, ip4.u4_addr32), /* See [2]. */
651 BPF_JMP_REG(BPF_JNE, BPF_REG_7, BPF_REG_8, 4),
653 /* user_ip4 = addr4_rw.sin_addr */
654 BPF_MOV32_IMM(BPF_REG_7, addr4_rw.sin_addr.s_addr),
655 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
656 offsetof(struct bpf_sock_addr, user_ip4)),
658 /* user_port = addr4_rw.sin_port */
659 BPF_MOV32_IMM(BPF_REG_7, addr4_rw.sin_port),
660 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
661 offsetof(struct bpf_sock_addr, user_port)),
665 BPF_MOV64_IMM(BPF_REG_0, 1),
669 return load_insns(test, insns, sizeof(insns) / sizeof(struct bpf_insn));
672 static int bind6_prog_load(const struct sock_addr_test *test)
674 struct sockaddr_in6 addr6_rw;
677 if (inet_pton(AF_INET6, SERV6_IP, (void *)&ip6) != 1) {
678 log_err("Invalid IPv6: %s", SERV6_IP);
682 if (mk_sockaddr(AF_INET6, SERV6_REWRITE_IP, SERV6_REWRITE_PORT,
683 (struct sockaddr *)&addr6_rw, sizeof(addr6_rw)) == -1)
687 struct bpf_insn insns[] = {
688 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
690 /* if (sk.family == AF_INET6 && */
691 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
692 offsetof(struct bpf_sock_addr, family)),
693 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET6, 18),
695 /* 5th_byte_of_user_ip6 == expected && */
696 BPF_LDX_MEM(BPF_B, BPF_REG_7, BPF_REG_6,
697 offsetof(struct bpf_sock_addr, user_ip6[1])),
698 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip6.s6_addr[4], 16),
700 /* 3rd_half_of_user_ip6 == expected && */
701 BPF_LDX_MEM(BPF_H, BPF_REG_7, BPF_REG_6,
702 offsetof(struct bpf_sock_addr, user_ip6[1])),
703 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, ip6.s6_addr16[2], 14),
705 /* last_word_of_user_ip6 == expected) { */
706 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
707 offsetof(struct bpf_sock_addr, user_ip6[3])),
708 BPF_LD_IMM64(BPF_REG_8, ip6.s6_addr32[3]), /* See [2]. */
709 BPF_JMP_REG(BPF_JNE, BPF_REG_7, BPF_REG_8, 10),
712 #define STORE_IPV6_WORD(N) \
713 BPF_MOV32_IMM(BPF_REG_7, addr6_rw.sin6_addr.s6_addr32[N]), \
714 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7, \
715 offsetof(struct bpf_sock_addr, user_ip6[N]))
717 /* user_ip6 = addr6_rw.sin6_addr */
723 /* user_port = addr6_rw.sin6_port */
724 BPF_MOV32_IMM(BPF_REG_7, addr6_rw.sin6_port),
725 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
726 offsetof(struct bpf_sock_addr, user_port)),
731 BPF_MOV64_IMM(BPF_REG_0, 1),
735 return load_insns(test, insns, sizeof(insns) / sizeof(struct bpf_insn));
738 static int load_path(const struct sock_addr_test *test, const char *path)
740 struct bpf_prog_load_attr attr;
741 struct bpf_object *obj;
744 memset(&attr, 0, sizeof(struct bpf_prog_load_attr));
746 attr.prog_type = BPF_PROG_TYPE_CGROUP_SOCK_ADDR;
747 attr.expected_attach_type = test->expected_attach_type;
749 if (bpf_prog_load_xattr(&attr, &obj, &prog_fd)) {
750 if (test->expected_result != LOAD_REJECT)
751 log_err(">>> Loading program (%s) error.\n", path);
758 static int connect4_prog_load(const struct sock_addr_test *test)
760 return load_path(test, CONNECT4_PROG_PATH);
763 static int connect6_prog_load(const struct sock_addr_test *test)
765 return load_path(test, CONNECT6_PROG_PATH);
768 static int sendmsg_ret_only_prog_load(const struct sock_addr_test *test,
771 struct bpf_insn insns[] = {
773 BPF_MOV64_IMM(BPF_REG_0, rc),
776 return load_insns(test, insns, sizeof(insns) / sizeof(struct bpf_insn));
779 static int sendmsg_allow_prog_load(const struct sock_addr_test *test)
781 return sendmsg_ret_only_prog_load(test, /*rc*/ 1);
784 static int sendmsg_deny_prog_load(const struct sock_addr_test *test)
786 return sendmsg_ret_only_prog_load(test, /*rc*/ 0);
789 static int sendmsg4_rw_asm_prog_load(const struct sock_addr_test *test)
791 struct sockaddr_in dst4_rw_addr;
792 struct in_addr src4_rw_ip;
794 if (inet_pton(AF_INET, SRC4_REWRITE_IP, (void *)&src4_rw_ip) != 1) {
795 log_err("Invalid IPv4: %s", SRC4_REWRITE_IP);
799 if (mk_sockaddr(AF_INET, SERV4_REWRITE_IP, SERV4_REWRITE_PORT,
800 (struct sockaddr *)&dst4_rw_addr,
801 sizeof(dst4_rw_addr)) == -1)
804 struct bpf_insn insns[] = {
805 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
807 /* if (sk.family == AF_INET && */
808 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
809 offsetof(struct bpf_sock_addr, family)),
810 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET, 8),
812 /* sk.type == SOCK_DGRAM) { */
813 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
814 offsetof(struct bpf_sock_addr, type)),
815 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, SOCK_DGRAM, 6),
817 /* msg_src_ip4 = src4_rw_ip */
818 BPF_MOV32_IMM(BPF_REG_7, src4_rw_ip.s_addr),
819 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
820 offsetof(struct bpf_sock_addr, msg_src_ip4)),
822 /* user_ip4 = dst4_rw_addr.sin_addr */
823 BPF_MOV32_IMM(BPF_REG_7, dst4_rw_addr.sin_addr.s_addr),
824 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
825 offsetof(struct bpf_sock_addr, user_ip4)),
827 /* user_port = dst4_rw_addr.sin_port */
828 BPF_MOV32_IMM(BPF_REG_7, dst4_rw_addr.sin_port),
829 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
830 offsetof(struct bpf_sock_addr, user_port)),
834 BPF_MOV64_IMM(BPF_REG_0, 1),
838 return load_insns(test, insns, sizeof(insns) / sizeof(struct bpf_insn));
841 static int sendmsg4_rw_c_prog_load(const struct sock_addr_test *test)
843 return load_path(test, SENDMSG4_PROG_PATH);
846 static int sendmsg6_rw_dst_asm_prog_load(const struct sock_addr_test *test,
847 const char *rw_dst_ip)
849 struct sockaddr_in6 dst6_rw_addr;
850 struct in6_addr src6_rw_ip;
852 if (inet_pton(AF_INET6, SRC6_REWRITE_IP, (void *)&src6_rw_ip) != 1) {
853 log_err("Invalid IPv6: %s", SRC6_REWRITE_IP);
857 if (mk_sockaddr(AF_INET6, rw_dst_ip, SERV6_REWRITE_PORT,
858 (struct sockaddr *)&dst6_rw_addr,
859 sizeof(dst6_rw_addr)) == -1)
862 struct bpf_insn insns[] = {
863 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
865 /* if (sk.family == AF_INET6) { */
866 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
867 offsetof(struct bpf_sock_addr, family)),
868 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET6, 18),
870 #define STORE_IPV6_WORD_N(DST, SRC, N) \
871 BPF_MOV32_IMM(BPF_REG_7, SRC[N]), \
872 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7, \
873 offsetof(struct bpf_sock_addr, DST[N]))
875 #define STORE_IPV6(DST, SRC) \
876 STORE_IPV6_WORD_N(DST, SRC, 0), \
877 STORE_IPV6_WORD_N(DST, SRC, 1), \
878 STORE_IPV6_WORD_N(DST, SRC, 2), \
879 STORE_IPV6_WORD_N(DST, SRC, 3)
881 STORE_IPV6(msg_src_ip6, src6_rw_ip.s6_addr32),
882 STORE_IPV6(user_ip6, dst6_rw_addr.sin6_addr.s6_addr32),
884 /* user_port = dst6_rw_addr.sin6_port */
885 BPF_MOV32_IMM(BPF_REG_7, dst6_rw_addr.sin6_port),
886 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
887 offsetof(struct bpf_sock_addr, user_port)),
892 BPF_MOV64_IMM(BPF_REG_0, 1),
896 return load_insns(test, insns, sizeof(insns) / sizeof(struct bpf_insn));
899 static int sendmsg6_rw_asm_prog_load(const struct sock_addr_test *test)
901 return sendmsg6_rw_dst_asm_prog_load(test, SERV6_REWRITE_IP);
904 static int sendmsg6_rw_v4mapped_prog_load(const struct sock_addr_test *test)
906 return sendmsg6_rw_dst_asm_prog_load(test, SERV6_V4MAPPED_IP);
909 static int sendmsg6_rw_wildcard_prog_load(const struct sock_addr_test *test)
911 return sendmsg6_rw_dst_asm_prog_load(test, WILDCARD6_IP);
914 static int sendmsg6_rw_c_prog_load(const struct sock_addr_test *test)
916 return load_path(test, SENDMSG6_PROG_PATH);
919 static int cmp_addr(const struct sockaddr_storage *addr1,
920 const struct sockaddr_storage *addr2, int cmp_port)
922 const struct sockaddr_in *four1, *four2;
923 const struct sockaddr_in6 *six1, *six2;
925 if (addr1->ss_family != addr2->ss_family)
928 if (addr1->ss_family == AF_INET) {
929 four1 = (const struct sockaddr_in *)addr1;
930 four2 = (const struct sockaddr_in *)addr2;
931 return !((four1->sin_port == four2->sin_port || !cmp_port) &&
932 four1->sin_addr.s_addr == four2->sin_addr.s_addr);
933 } else if (addr1->ss_family == AF_INET6) {
934 six1 = (const struct sockaddr_in6 *)addr1;
935 six2 = (const struct sockaddr_in6 *)addr2;
936 return !((six1->sin6_port == six2->sin6_port || !cmp_port) &&
937 !memcmp(&six1->sin6_addr, &six2->sin6_addr,
938 sizeof(struct in6_addr)));
944 static int cmp_sock_addr(info_fn fn, int sock1,
945 const struct sockaddr_storage *addr2, int cmp_port)
947 struct sockaddr_storage addr1;
948 socklen_t len1 = sizeof(addr1);
950 memset(&addr1, 0, len1);
951 if (fn(sock1, (struct sockaddr *)&addr1, (socklen_t *)&len1) != 0)
954 return cmp_addr(&addr1, addr2, cmp_port);
957 static int cmp_local_ip(int sock1, const struct sockaddr_storage *addr2)
959 return cmp_sock_addr(getsockname, sock1, addr2, /*cmp_port*/ 0);
962 static int cmp_local_addr(int sock1, const struct sockaddr_storage *addr2)
964 return cmp_sock_addr(getsockname, sock1, addr2, /*cmp_port*/ 1);
967 static int cmp_peer_addr(int sock1, const struct sockaddr_storage *addr2)
969 return cmp_sock_addr(getpeername, sock1, addr2, /*cmp_port*/ 1);
972 static int start_server(int type, const struct sockaddr_storage *addr,
977 fd = socket(addr->ss_family, type, 0);
979 log_err("Failed to create server socket");
983 if (bind(fd, (const struct sockaddr *)addr, addr_len) == -1) {
984 log_err("Failed to bind server socket");
988 if (type == SOCK_STREAM) {
989 if (listen(fd, 128) == -1) {
990 log_err("Failed to listen on server socket");
1003 static int connect_to_server(int type, const struct sockaddr_storage *addr,
1009 domain = addr->ss_family;
1011 if (domain != AF_INET && domain != AF_INET6) {
1012 log_err("Unsupported address family");
1016 fd = socket(domain, type, 0);
1018 log_err("Failed to create client socket");
1022 if (connect(fd, (const struct sockaddr *)addr, addr_len) == -1) {
1023 log_err("Fail to connect to server");
1035 int init_pktinfo(int domain, struct cmsghdr *cmsg)
1037 struct in6_pktinfo *pktinfo6;
1038 struct in_pktinfo *pktinfo4;
1040 if (domain == AF_INET) {
1041 cmsg->cmsg_level = SOL_IP;
1042 cmsg->cmsg_type = IP_PKTINFO;
1043 cmsg->cmsg_len = CMSG_LEN(sizeof(struct in_pktinfo));
1044 pktinfo4 = (struct in_pktinfo *)CMSG_DATA(cmsg);
1045 memset(pktinfo4, 0, sizeof(struct in_pktinfo));
1046 if (inet_pton(domain, SRC4_IP,
1047 (void *)&pktinfo4->ipi_spec_dst) != 1)
1049 } else if (domain == AF_INET6) {
1050 cmsg->cmsg_level = SOL_IPV6;
1051 cmsg->cmsg_type = IPV6_PKTINFO;
1052 cmsg->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
1053 pktinfo6 = (struct in6_pktinfo *)CMSG_DATA(cmsg);
1054 memset(pktinfo6, 0, sizeof(struct in6_pktinfo));
1055 if (inet_pton(domain, SRC6_IP,
1056 (void *)&pktinfo6->ipi6_addr) != 1)
1065 static int sendmsg_to_server(int type, const struct sockaddr_storage *addr,
1066 socklen_t addr_len, int set_cmsg, int flags,
1070 char buf[CMSG_SPACE(sizeof(struct in6_pktinfo))];
1071 struct cmsghdr align;
1074 char buf[CMSG_SPACE(sizeof(struct in_pktinfo))];
1075 struct cmsghdr align;
1083 domain = addr->ss_family;
1085 if (domain != AF_INET && domain != AF_INET6) {
1086 log_err("Unsupported address family");
1090 fd = socket(domain, type, 0);
1092 log_err("Failed to create client socket");
1096 memset(&iov, 0, sizeof(iov));
1097 iov.iov_base = &data;
1098 iov.iov_len = sizeof(data);
1100 memset(&hdr, 0, sizeof(hdr));
1101 hdr.msg_name = (void *)addr;
1102 hdr.msg_namelen = addr_len;
1107 if (domain == AF_INET) {
1108 hdr.msg_control = &control4;
1109 hdr.msg_controllen = sizeof(control4.buf);
1110 } else if (domain == AF_INET6) {
1111 hdr.msg_control = &control6;
1112 hdr.msg_controllen = sizeof(control6.buf);
1114 if (init_pktinfo(domain, CMSG_FIRSTHDR(&hdr))) {
1115 log_err("Fail to init pktinfo");
1120 if (sendmsg(fd, &hdr, flags) != sizeof(data)) {
1121 log_err("Fail to send message to server");
1122 *syscall_err = errno;
1134 static int fastconnect_to_server(const struct sockaddr_storage *addr,
1139 return sendmsg_to_server(SOCK_STREAM, addr, addr_len, /*set_cmsg*/0,
1140 MSG_FASTOPEN, &sendmsg_err);
1143 static int recvmsg_from_client(int sockfd, struct sockaddr_storage *src_addr)
1152 FD_SET(sockfd, &rfds);
1157 if (select(sockfd + 1, &rfds, NULL, NULL, &tv) <= 0 ||
1158 !FD_ISSET(sockfd, &rfds))
1161 memset(&iov, 0, sizeof(iov));
1162 iov.iov_base = data;
1163 iov.iov_len = sizeof(data);
1165 memset(&hdr, 0, sizeof(hdr));
1166 hdr.msg_name = src_addr;
1167 hdr.msg_namelen = sizeof(struct sockaddr_storage);
1171 return recvmsg(sockfd, &hdr, 0);
1174 static int init_addrs(const struct sock_addr_test *test,
1175 struct sockaddr_storage *requested_addr,
1176 struct sockaddr_storage *expected_addr,
1177 struct sockaddr_storage *expected_src_addr)
1179 socklen_t addr_len = sizeof(struct sockaddr_storage);
1181 if (mk_sockaddr(test->domain, test->expected_ip, test->expected_port,
1182 (struct sockaddr *)expected_addr, addr_len) == -1)
1185 if (mk_sockaddr(test->domain, test->requested_ip, test->requested_port,
1186 (struct sockaddr *)requested_addr, addr_len) == -1)
1189 if (test->expected_src_ip &&
1190 mk_sockaddr(test->domain, test->expected_src_ip, 0,
1191 (struct sockaddr *)expected_src_addr, addr_len) == -1)
1199 static int run_bind_test_case(const struct sock_addr_test *test)
1201 socklen_t addr_len = sizeof(struct sockaddr_storage);
1202 struct sockaddr_storage requested_addr;
1203 struct sockaddr_storage expected_addr;
1208 if (init_addrs(test, &requested_addr, &expected_addr, NULL))
1211 servfd = start_server(test->type, &requested_addr, addr_len);
1215 if (cmp_local_addr(servfd, &expected_addr))
1218 /* Try to connect to server just in case */
1219 clientfd = connect_to_server(test->type, &expected_addr, addr_len);
1232 static int run_connect_test_case(const struct sock_addr_test *test)
1234 socklen_t addr_len = sizeof(struct sockaddr_storage);
1235 struct sockaddr_storage expected_src_addr;
1236 struct sockaddr_storage requested_addr;
1237 struct sockaddr_storage expected_addr;
1242 if (init_addrs(test, &requested_addr, &expected_addr,
1243 &expected_src_addr))
1246 /* Prepare server to connect to */
1247 servfd = start_server(test->type, &expected_addr, addr_len);
1251 clientfd = connect_to_server(test->type, &requested_addr, addr_len);
1255 /* Make sure src and dst addrs were overridden properly */
1256 if (cmp_peer_addr(clientfd, &expected_addr))
1259 if (cmp_local_ip(clientfd, &expected_src_addr))
1262 if (test->type == SOCK_STREAM) {
1263 /* Test TCP Fast Open scenario */
1264 clientfd = fastconnect_to_server(&requested_addr, addr_len);
1268 /* Make sure src and dst addrs were overridden properly */
1269 if (cmp_peer_addr(clientfd, &expected_addr))
1272 if (cmp_local_ip(clientfd, &expected_src_addr))
1285 static int run_sendmsg_test_case(const struct sock_addr_test *test)
1287 socklen_t addr_len = sizeof(struct sockaddr_storage);
1288 struct sockaddr_storage expected_src_addr;
1289 struct sockaddr_storage requested_addr;
1290 struct sockaddr_storage expected_addr;
1291 struct sockaddr_storage real_src_addr;
1297 if (test->type != SOCK_DGRAM)
1300 if (init_addrs(test, &requested_addr, &expected_addr,
1301 &expected_src_addr))
1304 /* Prepare server to sendmsg to */
1305 servfd = start_server(test->type, &expected_addr, addr_len);
1309 for (set_cmsg = 0; set_cmsg <= 1; ++set_cmsg) {
1313 clientfd = sendmsg_to_server(test->type, &requested_addr,
1314 addr_len, set_cmsg, /*flags*/0,
1318 else if (clientfd == -1)
1321 /* Try to receive message on server instead of using
1322 * getpeername(2) on client socket, to check that client's
1323 * destination address was rewritten properly, since
1324 * getpeername(2) doesn't work with unconnected datagram
1327 * Get source address from recvmsg(2) as well to make sure
1328 * source was rewritten properly: getsockname(2) can't be used
1329 * since socket is unconnected and source defined for one
1330 * specific packet may differ from the one used by default and
1331 * returned by getsockname(2).
1333 if (recvmsg_from_client(servfd, &real_src_addr) == -1)
1336 if (cmp_addr(&real_src_addr, &expected_src_addr, /*cmp_port*/0))
1349 static int run_test_case(int cgfd, const struct sock_addr_test *test)
1354 printf("Test case: %s .. ", test->descr);
1356 progfd = test->loadfn(test);
1357 if (test->expected_result == LOAD_REJECT && progfd < 0)
1359 else if (test->expected_result == LOAD_REJECT || progfd < 0)
1362 err = bpf_prog_attach(progfd, cgfd, test->attach_type,
1363 BPF_F_ALLOW_OVERRIDE);
1364 if (test->expected_result == ATTACH_REJECT && err) {
1365 err = 0; /* error was expected, reset it */
1367 } else if (test->expected_result == ATTACH_REJECT || err) {
1371 switch (test->attach_type) {
1372 case BPF_CGROUP_INET4_BIND:
1373 case BPF_CGROUP_INET6_BIND:
1374 err = run_bind_test_case(test);
1376 case BPF_CGROUP_INET4_CONNECT:
1377 case BPF_CGROUP_INET6_CONNECT:
1378 err = run_connect_test_case(test);
1380 case BPF_CGROUP_UDP4_SENDMSG:
1381 case BPF_CGROUP_UDP6_SENDMSG:
1382 err = run_sendmsg_test_case(test);
1388 if (test->expected_result == SYSCALL_EPERM && err == EPERM) {
1389 err = 0; /* error was expected, reset it */
1393 if (test->expected_result == SYSCALL_ENOTSUPP && err == ENOTSUPP) {
1394 err = 0; /* error was expected, reset it */
1398 if (err || test->expected_result != SUCCESS)
1405 /* Detaching w/o checking return code: best effort attempt. */
1407 bpf_prog_detach(cgfd, test->attach_type);
1409 printf("[%s]\n", err ? "FAIL" : "PASS");
1413 static int run_tests(int cgfd)
1419 for (i = 0; i < ARRAY_SIZE(tests); ++i) {
1420 if (run_test_case(cgfd, &tests[i]))
1425 printf("Summary: %d PASSED, %d FAILED\n", passes, fails);
1426 return fails ? -1 : 0;
1429 int main(int argc, char **argv)
1436 "%s has to be run via %s.sh. Skip direct run.\n",
1441 if (setup_cgroup_environment())
1444 cgfd = create_and_get_cgroup(CG_PATH);
1448 if (join_cgroup(CG_PATH))
1451 if (run_tests(cgfd))
1459 cleanup_cgroup_environment();