146 lines · c
1// SPDX-License-Identifier: GPL-2.02 3#include "vmlinux.h"4#include <bpf/bpf_helpers.h>5#include <bpf/bpf_endian.h>6 7#include "bpf_tracing_net.h"8 9__be16 serv_port = 0;10 11int bpf_sock_destroy(struct sock_common *sk) __ksym;12 13struct {14 __uint(type, BPF_MAP_TYPE_ARRAY);15 __uint(max_entries, 1);16 __type(key, __u32);17 __type(value, __u64);18} tcp_conn_sockets SEC(".maps");19 20struct {21 __uint(type, BPF_MAP_TYPE_ARRAY);22 __uint(max_entries, 1);23 __type(key, __u32);24 __type(value, __u64);25} udp_conn_sockets SEC(".maps");26 27SEC("cgroup/connect6")28int sock_connect(struct bpf_sock_addr *ctx)29{30 __u64 sock_cookie = 0;31 int key = 0;32 __u32 keyc = 0;33 34 if (ctx->family != AF_INET6 || ctx->user_family != AF_INET6)35 return 1;36 37 sock_cookie = bpf_get_socket_cookie(ctx);38 if (ctx->protocol == IPPROTO_TCP)39 bpf_map_update_elem(&tcp_conn_sockets, &key, &sock_cookie, 0);40 else if (ctx->protocol == IPPROTO_UDP)41 bpf_map_update_elem(&udp_conn_sockets, &keyc, &sock_cookie, 0);42 else43 return 1;44 45 return 1;46}47 48SEC("iter/tcp")49int iter_tcp6_client(struct bpf_iter__tcp *ctx)50{51 struct sock_common *sk_common = ctx->sk_common;52 __u64 sock_cookie = 0;53 __u64 *val;54 int key = 0;55 56 if (!sk_common)57 return 0;58 59 if (sk_common->skc_family != AF_INET6)60 return 0;61 62 sock_cookie = bpf_get_socket_cookie(sk_common);63 val = bpf_map_lookup_elem(&tcp_conn_sockets, &key);64 if (!val)65 return 0;66 /* Destroy connected client sockets. */67 if (sock_cookie == *val)68 bpf_sock_destroy(sk_common);69 70 return 0;71}72 73SEC("iter/tcp")74int iter_tcp6_server(struct bpf_iter__tcp *ctx)75{76 struct sock_common *sk_common = ctx->sk_common;77 const struct inet_connection_sock *icsk;78 const struct inet_sock *inet;79 struct tcp6_sock *tcp_sk;80 __be16 srcp;81 82 if (!sk_common)83 return 0;84 85 if (sk_common->skc_family != AF_INET6)86 return 0;87 88 tcp_sk = bpf_skc_to_tcp6_sock(sk_common);89 if (!tcp_sk)90 return 0;91 92 icsk = &tcp_sk->tcp.inet_conn;93 inet = &icsk->icsk_inet;94 srcp = inet->inet_sport;95 96 /* Destroy server sockets. */97 if (srcp == serv_port)98 bpf_sock_destroy(sk_common);99 100 return 0;101}102 103 104SEC("iter/udp")105int iter_udp6_client(struct bpf_iter__udp *ctx)106{107 struct udp_sock *udp_sk = ctx->udp_sk;108 struct sock *sk = (struct sock *) udp_sk;109 __u64 sock_cookie = 0, *val;110 int key = 0;111 112 if (!sk)113 return 0;114 115 sock_cookie = bpf_get_socket_cookie(sk);116 val = bpf_map_lookup_elem(&udp_conn_sockets, &key);117 if (!val)118 return 0;119 /* Destroy connected client sockets. */120 if (sock_cookie == *val)121 bpf_sock_destroy((struct sock_common *)sk);122 123 return 0;124}125 126SEC("iter/udp")127int iter_udp6_server(struct bpf_iter__udp *ctx)128{129 struct udp_sock *udp_sk = ctx->udp_sk;130 struct sock *sk = (struct sock *) udp_sk;131 struct inet_sock *inet;132 __be16 srcp;133 134 if (!sk)135 return 0;136 137 inet = &udp_sk->inet;138 srcp = inet->inet_sport;139 if (srcp == serv_port)140 bpf_sock_destroy((struct sock_common *)sk);141 142 return 0;143}144 145char _license[] SEC("license") = "GPL";146