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"
28 #define CG_PATH "/foo"
29 #define CONNECT4_PROG_PATH "./connect4_prog.bpf.o"
30 #define CONNECT6_PROG_PATH "./connect6_prog.bpf.o"
31 #define SENDMSG4_PROG_PATH "./sendmsg4_prog.bpf.o"
32 #define SENDMSG6_PROG_PATH "./sendmsg6_prog.bpf.o"
33 #define RECVMSG4_PROG_PATH "./recvmsg4_prog.bpf.o"
34 #define RECVMSG6_PROG_PATH "./recvmsg6_prog.bpf.o"
35 #define BIND4_PROG_PATH "./bind4_prog.bpf.o"
36 #define BIND6_PROG_PATH "./bind6_prog.bpf.o"
38 #define SERV4_IP "192.168.1.254"
39 #define SERV4_REWRITE_IP "127.0.0.1"
40 #define SRC4_IP "172.16.0.1"
41 #define SRC4_REWRITE_IP "127.0.0.4"
42 #define SERV4_PORT 4040
43 #define SERV4_REWRITE_PORT 4444
45 #define SERV6_IP "face:b00c:1234:5678::abcd"
46 #define SERV6_REWRITE_IP "::1"
47 #define SERV6_V4MAPPED_IP "::ffff:192.168.0.4"
49 #define SRC6_REWRITE_IP "::6"
50 #define WILDCARD6_IP "::"
51 #define SERV6_PORT 6060
52 #define SERV6_REWRITE_PORT 6666
54 #define INET_NTOP_BUF 40
56 struct sock_addr_test;
58 typedef int (*load_fn)(const struct sock_addr_test *test);
59 typedef int (*info_fn)(int, struct sockaddr *, socklen_t *);
61 char bpf_log_buf[BPF_LOG_BUF_SIZE];
63 struct sock_addr_test {
65 /* BPF prog properties */
67 enum bpf_attach_type expected_attach_type;
68 enum bpf_attach_type attach_type;
69 /* Socket properties */
72 /* IP:port pairs for BPF prog to override */
73 const char *requested_ip;
74 unsigned short requested_port;
75 const char *expected_ip;
76 unsigned short expected_port;
77 const char *expected_src_ip;
78 /* Expected test result */
89 static int bind4_prog_load(const struct sock_addr_test *test);
90 static int bind6_prog_load(const struct sock_addr_test *test);
91 static int connect4_prog_load(const struct sock_addr_test *test);
92 static int connect6_prog_load(const struct sock_addr_test *test);
93 static int sendmsg_allow_prog_load(const struct sock_addr_test *test);
94 static int sendmsg_deny_prog_load(const struct sock_addr_test *test);
95 static int recvmsg_allow_prog_load(const struct sock_addr_test *test);
96 static int recvmsg_deny_prog_load(const struct sock_addr_test *test);
97 static int sendmsg4_rw_asm_prog_load(const struct sock_addr_test *test);
98 static int recvmsg4_rw_c_prog_load(const struct sock_addr_test *test);
99 static int sendmsg4_rw_c_prog_load(const struct sock_addr_test *test);
100 static int sendmsg6_rw_asm_prog_load(const struct sock_addr_test *test);
101 static int recvmsg6_rw_c_prog_load(const struct sock_addr_test *test);
102 static int sendmsg6_rw_c_prog_load(const struct sock_addr_test *test);
103 static int sendmsg6_rw_v4mapped_prog_load(const struct sock_addr_test *test);
104 static int sendmsg6_rw_wildcard_prog_load(const struct sock_addr_test *test);
106 static struct sock_addr_test tests[] = {
109 "bind4: load prog with wrong expected attach type",
111 BPF_CGROUP_INET6_BIND,
112 BPF_CGROUP_INET4_BIND,
123 "bind4: attach prog with wrong attach type",
125 BPF_CGROUP_INET4_BIND,
126 BPF_CGROUP_INET6_BIND,
137 "bind4: rewrite IP & TCP port in",
139 BPF_CGROUP_INET4_BIND,
140 BPF_CGROUP_INET4_BIND,
151 "bind4: rewrite IP & UDP port in",
153 BPF_CGROUP_INET4_BIND,
154 BPF_CGROUP_INET4_BIND,
165 "bind6: load prog with wrong expected attach type",
167 BPF_CGROUP_INET4_BIND,
168 BPF_CGROUP_INET6_BIND,
179 "bind6: attach prog with wrong attach type",
181 BPF_CGROUP_INET6_BIND,
182 BPF_CGROUP_INET4_BIND,
193 "bind6: rewrite IP & TCP port in",
195 BPF_CGROUP_INET6_BIND,
196 BPF_CGROUP_INET6_BIND,
207 "bind6: rewrite IP & UDP port in",
209 BPF_CGROUP_INET6_BIND,
210 BPF_CGROUP_INET6_BIND,
223 "connect4: load prog with wrong expected attach type",
225 BPF_CGROUP_INET6_CONNECT,
226 BPF_CGROUP_INET4_CONNECT,
237 "connect4: attach prog with wrong attach type",
239 BPF_CGROUP_INET4_CONNECT,
240 BPF_CGROUP_INET6_CONNECT,
251 "connect4: rewrite IP & TCP port",
253 BPF_CGROUP_INET4_CONNECT,
254 BPF_CGROUP_INET4_CONNECT,
265 "connect4: rewrite IP & UDP port",
267 BPF_CGROUP_INET4_CONNECT,
268 BPF_CGROUP_INET4_CONNECT,
279 "connect6: load prog with wrong expected attach type",
281 BPF_CGROUP_INET4_CONNECT,
282 BPF_CGROUP_INET6_CONNECT,
293 "connect6: attach prog with wrong attach type",
295 BPF_CGROUP_INET6_CONNECT,
296 BPF_CGROUP_INET4_CONNECT,
307 "connect6: rewrite IP & TCP port",
309 BPF_CGROUP_INET6_CONNECT,
310 BPF_CGROUP_INET6_CONNECT,
321 "connect6: rewrite IP & UDP port",
323 BPF_CGROUP_INET6_CONNECT,
324 BPF_CGROUP_INET6_CONNECT,
337 "sendmsg4: load prog with wrong expected attach type",
338 sendmsg4_rw_asm_prog_load,
339 BPF_CGROUP_UDP6_SENDMSG,
340 BPF_CGROUP_UDP4_SENDMSG,
351 "sendmsg4: attach prog with wrong attach type",
352 sendmsg4_rw_asm_prog_load,
353 BPF_CGROUP_UDP4_SENDMSG,
354 BPF_CGROUP_UDP6_SENDMSG,
365 "sendmsg4: rewrite IP & port (asm)",
366 sendmsg4_rw_asm_prog_load,
367 BPF_CGROUP_UDP4_SENDMSG,
368 BPF_CGROUP_UDP4_SENDMSG,
379 "sendmsg4: rewrite IP & port (C)",
380 sendmsg4_rw_c_prog_load,
381 BPF_CGROUP_UDP4_SENDMSG,
382 BPF_CGROUP_UDP4_SENDMSG,
393 "sendmsg4: deny call",
394 sendmsg_deny_prog_load,
395 BPF_CGROUP_UDP4_SENDMSG,
396 BPF_CGROUP_UDP4_SENDMSG,
407 "sendmsg6: load prog with wrong expected attach type",
408 sendmsg6_rw_asm_prog_load,
409 BPF_CGROUP_UDP4_SENDMSG,
410 BPF_CGROUP_UDP6_SENDMSG,
421 "sendmsg6: attach prog with wrong attach type",
422 sendmsg6_rw_asm_prog_load,
423 BPF_CGROUP_UDP6_SENDMSG,
424 BPF_CGROUP_UDP4_SENDMSG,
435 "sendmsg6: rewrite IP & port (asm)",
436 sendmsg6_rw_asm_prog_load,
437 BPF_CGROUP_UDP6_SENDMSG,
438 BPF_CGROUP_UDP6_SENDMSG,
449 "sendmsg6: rewrite IP & port (C)",
450 sendmsg6_rw_c_prog_load,
451 BPF_CGROUP_UDP6_SENDMSG,
452 BPF_CGROUP_UDP6_SENDMSG,
463 "sendmsg6: IPv4-mapped IPv6",
464 sendmsg6_rw_v4mapped_prog_load,
465 BPF_CGROUP_UDP6_SENDMSG,
466 BPF_CGROUP_UDP6_SENDMSG,
477 "sendmsg6: set dst IP = [::] (BSD'ism)",
478 sendmsg6_rw_wildcard_prog_load,
479 BPF_CGROUP_UDP6_SENDMSG,
480 BPF_CGROUP_UDP6_SENDMSG,
491 "sendmsg6: preserve dst IP = [::] (BSD'ism)",
492 sendmsg_allow_prog_load,
493 BPF_CGROUP_UDP6_SENDMSG,
494 BPF_CGROUP_UDP6_SENDMSG,
505 "sendmsg6: deny call",
506 sendmsg_deny_prog_load,
507 BPF_CGROUP_UDP6_SENDMSG,
508 BPF_CGROUP_UDP6_SENDMSG,
521 "recvmsg4: return code ok",
522 recvmsg_allow_prog_load,
523 BPF_CGROUP_UDP4_RECVMSG,
524 BPF_CGROUP_UDP4_RECVMSG,
535 "recvmsg4: return code !ok",
536 recvmsg_deny_prog_load,
537 BPF_CGROUP_UDP4_RECVMSG,
538 BPF_CGROUP_UDP4_RECVMSG,
549 "recvmsg6: return code ok",
550 recvmsg_allow_prog_load,
551 BPF_CGROUP_UDP6_RECVMSG,
552 BPF_CGROUP_UDP6_RECVMSG,
563 "recvmsg6: return code !ok",
564 recvmsg_deny_prog_load,
565 BPF_CGROUP_UDP6_RECVMSG,
566 BPF_CGROUP_UDP6_RECVMSG,
577 "recvmsg4: rewrite IP & port (C)",
578 recvmsg4_rw_c_prog_load,
579 BPF_CGROUP_UDP4_RECVMSG,
580 BPF_CGROUP_UDP4_RECVMSG,
591 "recvmsg6: rewrite IP & port (C)",
592 recvmsg6_rw_c_prog_load,
593 BPF_CGROUP_UDP6_RECVMSG,
594 BPF_CGROUP_UDP6_RECVMSG,
606 static int mk_sockaddr(int domain, const char *ip, unsigned short port,
607 struct sockaddr *addr, socklen_t addr_len)
609 struct sockaddr_in6 *addr6;
610 struct sockaddr_in *addr4;
612 if (domain != AF_INET && domain != AF_INET6) {
613 log_err("Unsupported address family");
617 memset(addr, 0, addr_len);
619 if (domain == AF_INET) {
620 if (addr_len < sizeof(struct sockaddr_in))
622 addr4 = (struct sockaddr_in *)addr;
623 addr4->sin_family = domain;
624 addr4->sin_port = htons(port);
625 if (inet_pton(domain, ip, (void *)&addr4->sin_addr) != 1) {
626 log_err("Invalid IPv4: %s", ip);
629 } else if (domain == AF_INET6) {
630 if (addr_len < sizeof(struct sockaddr_in6))
632 addr6 = (struct sockaddr_in6 *)addr;
633 addr6->sin6_family = domain;
634 addr6->sin6_port = htons(port);
635 if (inet_pton(domain, ip, (void *)&addr6->sin6_addr) != 1) {
636 log_err("Invalid IPv6: %s", ip);
644 static int load_insns(const struct sock_addr_test *test,
645 const struct bpf_insn *insns, size_t insns_cnt)
647 LIBBPF_OPTS(bpf_prog_load_opts, opts);
650 opts.expected_attach_type = test->expected_attach_type;
651 opts.log_buf = bpf_log_buf;
652 opts.log_size = BPF_LOG_BUF_SIZE;
654 ret = bpf_prog_load(BPF_PROG_TYPE_CGROUP_SOCK_ADDR, NULL, "GPL", insns, insns_cnt, &opts);
655 if (ret < 0 && test->expected_result != LOAD_REJECT) {
656 log_err(">>> Loading program error.\n"
657 ">>> Verifier output:\n%s\n-------\n", bpf_log_buf);
663 static int load_path(const struct sock_addr_test *test, const char *path)
665 struct bpf_object *obj;
666 struct bpf_program *prog;
669 obj = bpf_object__open_file(path, NULL);
670 err = libbpf_get_error(obj);
672 log_err(">>> Opening BPF object (%s) error.\n", path);
676 prog = bpf_object__next_program(obj, NULL);
680 bpf_program__set_type(prog, BPF_PROG_TYPE_CGROUP_SOCK_ADDR);
681 bpf_program__set_expected_attach_type(prog, test->expected_attach_type);
682 bpf_program__set_flags(prog, BPF_F_TEST_RND_HI32 | BPF_F_TEST_REG_INVARIANTS);
684 err = bpf_object__load(obj);
686 if (test->expected_result != LOAD_REJECT)
687 log_err(">>> Loading program (%s) error.\n", path);
691 return bpf_program__fd(prog);
693 bpf_object__close(obj);
697 static int bind4_prog_load(const struct sock_addr_test *test)
699 return load_path(test, BIND4_PROG_PATH);
702 static int bind6_prog_load(const struct sock_addr_test *test)
704 return load_path(test, BIND6_PROG_PATH);
707 static int connect4_prog_load(const struct sock_addr_test *test)
709 return load_path(test, CONNECT4_PROG_PATH);
712 static int connect6_prog_load(const struct sock_addr_test *test)
714 return load_path(test, CONNECT6_PROG_PATH);
717 static int xmsg_ret_only_prog_load(const struct sock_addr_test *test,
720 struct bpf_insn insns[] = {
722 BPF_MOV64_IMM(BPF_REG_0, rc),
725 return load_insns(test, insns, ARRAY_SIZE(insns));
728 static int sendmsg_allow_prog_load(const struct sock_addr_test *test)
730 return xmsg_ret_only_prog_load(test, /*rc*/ 1);
733 static int sendmsg_deny_prog_load(const struct sock_addr_test *test)
735 return xmsg_ret_only_prog_load(test, /*rc*/ 0);
738 static int recvmsg_allow_prog_load(const struct sock_addr_test *test)
740 return xmsg_ret_only_prog_load(test, /*rc*/ 1);
743 static int recvmsg_deny_prog_load(const struct sock_addr_test *test)
745 return xmsg_ret_only_prog_load(test, /*rc*/ 0);
748 static int sendmsg4_rw_asm_prog_load(const struct sock_addr_test *test)
750 struct sockaddr_in dst4_rw_addr;
751 struct in_addr src4_rw_ip;
753 if (inet_pton(AF_INET, SRC4_REWRITE_IP, (void *)&src4_rw_ip) != 1) {
754 log_err("Invalid IPv4: %s", SRC4_REWRITE_IP);
758 if (mk_sockaddr(AF_INET, SERV4_REWRITE_IP, SERV4_REWRITE_PORT,
759 (struct sockaddr *)&dst4_rw_addr,
760 sizeof(dst4_rw_addr)) == -1)
763 struct bpf_insn insns[] = {
764 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
766 /* if (sk.family == AF_INET && */
767 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
768 offsetof(struct bpf_sock_addr, family)),
769 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET, 8),
771 /* sk.type == SOCK_DGRAM) { */
772 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
773 offsetof(struct bpf_sock_addr, type)),
774 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, SOCK_DGRAM, 6),
776 /* msg_src_ip4 = src4_rw_ip */
777 BPF_MOV32_IMM(BPF_REG_7, src4_rw_ip.s_addr),
778 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
779 offsetof(struct bpf_sock_addr, msg_src_ip4)),
781 /* user_ip4 = dst4_rw_addr.sin_addr */
782 BPF_MOV32_IMM(BPF_REG_7, dst4_rw_addr.sin_addr.s_addr),
783 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
784 offsetof(struct bpf_sock_addr, user_ip4)),
786 /* user_port = dst4_rw_addr.sin_port */
787 BPF_MOV32_IMM(BPF_REG_7, dst4_rw_addr.sin_port),
788 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
789 offsetof(struct bpf_sock_addr, user_port)),
793 BPF_MOV64_IMM(BPF_REG_0, 1),
797 return load_insns(test, insns, ARRAY_SIZE(insns));
800 static int recvmsg4_rw_c_prog_load(const struct sock_addr_test *test)
802 return load_path(test, RECVMSG4_PROG_PATH);
805 static int sendmsg4_rw_c_prog_load(const struct sock_addr_test *test)
807 return load_path(test, SENDMSG4_PROG_PATH);
810 static int sendmsg6_rw_dst_asm_prog_load(const struct sock_addr_test *test,
811 const char *rw_dst_ip)
813 struct sockaddr_in6 dst6_rw_addr;
814 struct in6_addr src6_rw_ip;
816 if (inet_pton(AF_INET6, SRC6_REWRITE_IP, (void *)&src6_rw_ip) != 1) {
817 log_err("Invalid IPv6: %s", SRC6_REWRITE_IP);
821 if (mk_sockaddr(AF_INET6, rw_dst_ip, SERV6_REWRITE_PORT,
822 (struct sockaddr *)&dst6_rw_addr,
823 sizeof(dst6_rw_addr)) == -1)
826 struct bpf_insn insns[] = {
827 BPF_MOV64_REG(BPF_REG_6, BPF_REG_1),
829 /* if (sk.family == AF_INET6) { */
830 BPF_LDX_MEM(BPF_W, BPF_REG_7, BPF_REG_6,
831 offsetof(struct bpf_sock_addr, family)),
832 BPF_JMP_IMM(BPF_JNE, BPF_REG_7, AF_INET6, 18),
834 #define STORE_IPV6_WORD_N(DST, SRC, N) \
835 BPF_MOV32_IMM(BPF_REG_7, SRC[N]), \
836 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7, \
837 offsetof(struct bpf_sock_addr, DST[N]))
839 #define STORE_IPV6(DST, SRC) \
840 STORE_IPV6_WORD_N(DST, SRC, 0), \
841 STORE_IPV6_WORD_N(DST, SRC, 1), \
842 STORE_IPV6_WORD_N(DST, SRC, 2), \
843 STORE_IPV6_WORD_N(DST, SRC, 3)
845 STORE_IPV6(msg_src_ip6, src6_rw_ip.s6_addr32),
846 STORE_IPV6(user_ip6, dst6_rw_addr.sin6_addr.s6_addr32),
848 /* user_port = dst6_rw_addr.sin6_port */
849 BPF_MOV32_IMM(BPF_REG_7, dst6_rw_addr.sin6_port),
850 BPF_STX_MEM(BPF_W, BPF_REG_6, BPF_REG_7,
851 offsetof(struct bpf_sock_addr, user_port)),
856 BPF_MOV64_IMM(BPF_REG_0, 1),
860 return load_insns(test, insns, ARRAY_SIZE(insns));
863 static int sendmsg6_rw_asm_prog_load(const struct sock_addr_test *test)
865 return sendmsg6_rw_dst_asm_prog_load(test, SERV6_REWRITE_IP);
868 static int recvmsg6_rw_c_prog_load(const struct sock_addr_test *test)
870 return load_path(test, RECVMSG6_PROG_PATH);
873 static int sendmsg6_rw_v4mapped_prog_load(const struct sock_addr_test *test)
875 return sendmsg6_rw_dst_asm_prog_load(test, SERV6_V4MAPPED_IP);
878 static int sendmsg6_rw_wildcard_prog_load(const struct sock_addr_test *test)
880 return sendmsg6_rw_dst_asm_prog_load(test, WILDCARD6_IP);
883 static int sendmsg6_rw_c_prog_load(const struct sock_addr_test *test)
885 return load_path(test, SENDMSG6_PROG_PATH);
888 static int cmp_addr(const struct sockaddr_storage *addr1,
889 const struct sockaddr_storage *addr2, int cmp_port)
891 const struct sockaddr_in *four1, *four2;
892 const struct sockaddr_in6 *six1, *six2;
894 if (addr1->ss_family != addr2->ss_family)
897 if (addr1->ss_family == AF_INET) {
898 four1 = (const struct sockaddr_in *)addr1;
899 four2 = (const struct sockaddr_in *)addr2;
900 return !((four1->sin_port == four2->sin_port || !cmp_port) &&
901 four1->sin_addr.s_addr == four2->sin_addr.s_addr);
902 } else if (addr1->ss_family == AF_INET6) {
903 six1 = (const struct sockaddr_in6 *)addr1;
904 six2 = (const struct sockaddr_in6 *)addr2;
905 return !((six1->sin6_port == six2->sin6_port || !cmp_port) &&
906 !memcmp(&six1->sin6_addr, &six2->sin6_addr,
907 sizeof(struct in6_addr)));
913 static int cmp_sock_addr(info_fn fn, int sock1,
914 const struct sockaddr_storage *addr2, int cmp_port)
916 struct sockaddr_storage addr1;
917 socklen_t len1 = sizeof(addr1);
919 memset(&addr1, 0, len1);
920 if (fn(sock1, (struct sockaddr *)&addr1, (socklen_t *)&len1) != 0)
923 return cmp_addr(&addr1, addr2, cmp_port);
926 static int cmp_local_ip(int sock1, const struct sockaddr_storage *addr2)
928 return cmp_sock_addr(getsockname, sock1, addr2, /*cmp_port*/ 0);
931 static int cmp_local_addr(int sock1, const struct sockaddr_storage *addr2)
933 return cmp_sock_addr(getsockname, sock1, addr2, /*cmp_port*/ 1);
936 static int cmp_peer_addr(int sock1, const struct sockaddr_storage *addr2)
938 return cmp_sock_addr(getpeername, sock1, addr2, /*cmp_port*/ 1);
941 static int start_server(int type, const struct sockaddr_storage *addr,
946 fd = socket(addr->ss_family, type, 0);
948 log_err("Failed to create server socket");
952 if (bind(fd, (const struct sockaddr *)addr, addr_len) == -1) {
953 log_err("Failed to bind server socket");
957 if (type == SOCK_STREAM) {
958 if (listen(fd, 128) == -1) {
959 log_err("Failed to listen on server socket");
972 static int connect_to_server(int type, const struct sockaddr_storage *addr,
978 domain = addr->ss_family;
980 if (domain != AF_INET && domain != AF_INET6) {
981 log_err("Unsupported address family");
985 fd = socket(domain, type, 0);
987 log_err("Failed to create client socket");
991 if (connect(fd, (const struct sockaddr *)addr, addr_len) == -1) {
992 log_err("Fail to connect to server");
1004 int init_pktinfo(int domain, struct cmsghdr *cmsg)
1006 struct in6_pktinfo *pktinfo6;
1007 struct in_pktinfo *pktinfo4;
1009 if (domain == AF_INET) {
1010 cmsg->cmsg_level = SOL_IP;
1011 cmsg->cmsg_type = IP_PKTINFO;
1012 cmsg->cmsg_len = CMSG_LEN(sizeof(struct in_pktinfo));
1013 pktinfo4 = (struct in_pktinfo *)CMSG_DATA(cmsg);
1014 memset(pktinfo4, 0, sizeof(struct in_pktinfo));
1015 if (inet_pton(domain, SRC4_IP,
1016 (void *)&pktinfo4->ipi_spec_dst) != 1)
1018 } else if (domain == AF_INET6) {
1019 cmsg->cmsg_level = SOL_IPV6;
1020 cmsg->cmsg_type = IPV6_PKTINFO;
1021 cmsg->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
1022 pktinfo6 = (struct in6_pktinfo *)CMSG_DATA(cmsg);
1023 memset(pktinfo6, 0, sizeof(struct in6_pktinfo));
1024 if (inet_pton(domain, SRC6_IP,
1025 (void *)&pktinfo6->ipi6_addr) != 1)
1034 static int sendmsg_to_server(int type, const struct sockaddr_storage *addr,
1035 socklen_t addr_len, int set_cmsg, int flags,
1039 char buf[CMSG_SPACE(sizeof(struct in6_pktinfo))];
1040 struct cmsghdr align;
1043 char buf[CMSG_SPACE(sizeof(struct in_pktinfo))];
1044 struct cmsghdr align;
1052 domain = addr->ss_family;
1054 if (domain != AF_INET && domain != AF_INET6) {
1055 log_err("Unsupported address family");
1059 fd = socket(domain, type, 0);
1061 log_err("Failed to create client socket");
1065 memset(&iov, 0, sizeof(iov));
1066 iov.iov_base = &data;
1067 iov.iov_len = sizeof(data);
1069 memset(&hdr, 0, sizeof(hdr));
1070 hdr.msg_name = (void *)addr;
1071 hdr.msg_namelen = addr_len;
1076 if (domain == AF_INET) {
1077 hdr.msg_control = &control4;
1078 hdr.msg_controllen = sizeof(control4.buf);
1079 } else if (domain == AF_INET6) {
1080 hdr.msg_control = &control6;
1081 hdr.msg_controllen = sizeof(control6.buf);
1083 if (init_pktinfo(domain, CMSG_FIRSTHDR(&hdr))) {
1084 log_err("Fail to init pktinfo");
1089 if (sendmsg(fd, &hdr, flags) != sizeof(data)) {
1090 log_err("Fail to send message to server");
1091 *syscall_err = errno;
1103 static int fastconnect_to_server(const struct sockaddr_storage *addr,
1108 return sendmsg_to_server(SOCK_STREAM, addr, addr_len, /*set_cmsg*/0,
1109 MSG_FASTOPEN, &sendmsg_err);
1112 static int recvmsg_from_client(int sockfd, struct sockaddr_storage *src_addr)
1121 FD_SET(sockfd, &rfds);
1126 if (select(sockfd + 1, &rfds, NULL, NULL, &tv) <= 0 ||
1127 !FD_ISSET(sockfd, &rfds))
1130 memset(&iov, 0, sizeof(iov));
1131 iov.iov_base = data;
1132 iov.iov_len = sizeof(data);
1134 memset(&hdr, 0, sizeof(hdr));
1135 hdr.msg_name = src_addr;
1136 hdr.msg_namelen = sizeof(struct sockaddr_storage);
1140 return recvmsg(sockfd, &hdr, 0);
1143 static int init_addrs(const struct sock_addr_test *test,
1144 struct sockaddr_storage *requested_addr,
1145 struct sockaddr_storage *expected_addr,
1146 struct sockaddr_storage *expected_src_addr)
1148 socklen_t addr_len = sizeof(struct sockaddr_storage);
1150 if (mk_sockaddr(test->domain, test->expected_ip, test->expected_port,
1151 (struct sockaddr *)expected_addr, addr_len) == -1)
1154 if (mk_sockaddr(test->domain, test->requested_ip, test->requested_port,
1155 (struct sockaddr *)requested_addr, addr_len) == -1)
1158 if (test->expected_src_ip &&
1159 mk_sockaddr(test->domain, test->expected_src_ip, 0,
1160 (struct sockaddr *)expected_src_addr, addr_len) == -1)
1168 static int run_bind_test_case(const struct sock_addr_test *test)
1170 socklen_t addr_len = sizeof(struct sockaddr_storage);
1171 struct sockaddr_storage requested_addr;
1172 struct sockaddr_storage expected_addr;
1177 if (init_addrs(test, &requested_addr, &expected_addr, NULL))
1180 servfd = start_server(test->type, &requested_addr, addr_len);
1184 if (cmp_local_addr(servfd, &expected_addr))
1187 /* Try to connect to server just in case */
1188 clientfd = connect_to_server(test->type, &expected_addr, addr_len);
1201 static int run_connect_test_case(const struct sock_addr_test *test)
1203 socklen_t addr_len = sizeof(struct sockaddr_storage);
1204 struct sockaddr_storage expected_src_addr;
1205 struct sockaddr_storage requested_addr;
1206 struct sockaddr_storage expected_addr;
1211 if (init_addrs(test, &requested_addr, &expected_addr,
1212 &expected_src_addr))
1215 /* Prepare server to connect to */
1216 servfd = start_server(test->type, &expected_addr, addr_len);
1220 clientfd = connect_to_server(test->type, &requested_addr, addr_len);
1224 /* Make sure src and dst addrs were overridden properly */
1225 if (cmp_peer_addr(clientfd, &expected_addr))
1228 if (cmp_local_ip(clientfd, &expected_src_addr))
1231 if (test->type == SOCK_STREAM) {
1232 /* Test TCP Fast Open scenario */
1233 clientfd = fastconnect_to_server(&requested_addr, addr_len);
1237 /* Make sure src and dst addrs were overridden properly */
1238 if (cmp_peer_addr(clientfd, &expected_addr))
1241 if (cmp_local_ip(clientfd, &expected_src_addr))
1254 static int run_xmsg_test_case(const struct sock_addr_test *test, int max_cmsg)
1256 socklen_t addr_len = sizeof(struct sockaddr_storage);
1257 struct sockaddr_storage expected_addr;
1258 struct sockaddr_storage server_addr;
1259 struct sockaddr_storage sendmsg_addr;
1260 struct sockaddr_storage recvmsg_addr;
1266 if (test->type != SOCK_DGRAM)
1269 if (init_addrs(test, &sendmsg_addr, &server_addr, &expected_addr))
1272 /* Prepare server to sendmsg to */
1273 servfd = start_server(test->type, &server_addr, addr_len);
1277 for (set_cmsg = 0; set_cmsg <= max_cmsg; ++set_cmsg) {
1281 clientfd = sendmsg_to_server(test->type, &sendmsg_addr,
1282 addr_len, set_cmsg, /*flags*/0,
1286 else if (clientfd == -1)
1289 /* Try to receive message on server instead of using
1290 * getpeername(2) on client socket, to check that client's
1291 * destination address was rewritten properly, since
1292 * getpeername(2) doesn't work with unconnected datagram
1295 * Get source address from recvmsg(2) as well to make sure
1296 * source was rewritten properly: getsockname(2) can't be used
1297 * since socket is unconnected and source defined for one
1298 * specific packet may differ from the one used by default and
1299 * returned by getsockname(2).
1301 if (recvmsg_from_client(servfd, &recvmsg_addr) == -1)
1304 if (cmp_addr(&recvmsg_addr, &expected_addr, /*cmp_port*/0))
1317 static int run_test_case(int cgfd, const struct sock_addr_test *test)
1322 printf("Test case: %s .. ", test->descr);
1324 progfd = test->loadfn(test);
1325 if (test->expected_result == LOAD_REJECT && progfd < 0)
1327 else if (test->expected_result == LOAD_REJECT || progfd < 0)
1330 err = bpf_prog_attach(progfd, cgfd, test->attach_type,
1331 BPF_F_ALLOW_OVERRIDE);
1332 if (test->expected_result == ATTACH_REJECT && err) {
1333 err = 0; /* error was expected, reset it */
1335 } else if (test->expected_result == ATTACH_REJECT || err) {
1337 } else if (test->expected_result == ATTACH_OKAY) {
1342 switch (test->attach_type) {
1343 case BPF_CGROUP_INET4_BIND:
1344 case BPF_CGROUP_INET6_BIND:
1345 err = run_bind_test_case(test);
1347 case BPF_CGROUP_INET4_CONNECT:
1348 case BPF_CGROUP_INET6_CONNECT:
1349 err = run_connect_test_case(test);
1351 case BPF_CGROUP_UDP4_SENDMSG:
1352 case BPF_CGROUP_UDP6_SENDMSG:
1353 err = run_xmsg_test_case(test, 1);
1355 case BPF_CGROUP_UDP4_RECVMSG:
1356 case BPF_CGROUP_UDP6_RECVMSG:
1357 err = run_xmsg_test_case(test, 0);
1363 if (test->expected_result == SYSCALL_EPERM && err == EPERM) {
1364 err = 0; /* error was expected, reset it */
1368 if (test->expected_result == SYSCALL_ENOTSUPP && err == ENOTSUPP) {
1369 err = 0; /* error was expected, reset it */
1373 if (err || test->expected_result != SUCCESS)
1380 /* Detaching w/o checking return code: best effort attempt. */
1382 bpf_prog_detach(cgfd, test->attach_type);
1384 printf("[%s]\n", err ? "FAIL" : "PASS");
1388 static int run_tests(int cgfd)
1394 for (i = 0; i < ARRAY_SIZE(tests); ++i) {
1395 if (run_test_case(cgfd, &tests[i]))
1400 printf("Summary: %d PASSED, %d FAILED\n", passes, fails);
1401 return fails ? -1 : 0;
1404 int main(int argc, char **argv)
1411 "%s has to be run via %s.sh. Skip direct run.\n",
1416 cgfd = cgroup_setup_and_join(CG_PATH);
1420 /* Use libbpf 1.0 API mode */
1421 libbpf_set_strict_mode(LIBBPF_STRICT_ALL);
1423 if (run_tests(cgfd))
1431 cleanup_cgroup_environment();