1*387f9dfdSAndroid Build Coastguard Worker // SPDX-License-Identifier: (LGPL-2.1 OR BSD-2-Clause)
2*387f9dfdSAndroid Build Coastguard Worker /* Copyright (c) 2021 Hengqi Chen */
3*387f9dfdSAndroid Build Coastguard Worker #include <vmlinux.h>
4*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_helpers.h>
5*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_tracing.h>
6*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_core_read.h>
7*387f9dfdSAndroid Build Coastguard Worker #include "tcpstates.h"
8*387f9dfdSAndroid Build Coastguard Worker
9*387f9dfdSAndroid Build Coastguard Worker #define MAX_ENTRIES 10240
10*387f9dfdSAndroid Build Coastguard Worker #define AF_INET 2
11*387f9dfdSAndroid Build Coastguard Worker #define AF_INET6 10
12*387f9dfdSAndroid Build Coastguard Worker
13*387f9dfdSAndroid Build Coastguard Worker const volatile bool filter_by_sport = false;
14*387f9dfdSAndroid Build Coastguard Worker const volatile bool filter_by_dport = false;
15*387f9dfdSAndroid Build Coastguard Worker const volatile short target_family = 0;
16*387f9dfdSAndroid Build Coastguard Worker
17*387f9dfdSAndroid Build Coastguard Worker struct {
18*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
19*387f9dfdSAndroid Build Coastguard Worker __uint(max_entries, MAX_ENTRIES);
20*387f9dfdSAndroid Build Coastguard Worker __type(key, __u16);
21*387f9dfdSAndroid Build Coastguard Worker __type(value, __u16);
22*387f9dfdSAndroid Build Coastguard Worker } sports SEC(".maps");
23*387f9dfdSAndroid Build Coastguard Worker
24*387f9dfdSAndroid Build Coastguard Worker struct {
25*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
26*387f9dfdSAndroid Build Coastguard Worker __uint(max_entries, MAX_ENTRIES);
27*387f9dfdSAndroid Build Coastguard Worker __type(key, __u16);
28*387f9dfdSAndroid Build Coastguard Worker __type(value, __u16);
29*387f9dfdSAndroid Build Coastguard Worker } dports SEC(".maps");
30*387f9dfdSAndroid Build Coastguard Worker
31*387f9dfdSAndroid Build Coastguard Worker struct {
32*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
33*387f9dfdSAndroid Build Coastguard Worker __uint(max_entries, MAX_ENTRIES);
34*387f9dfdSAndroid Build Coastguard Worker __type(key, struct sock *);
35*387f9dfdSAndroid Build Coastguard Worker __type(value, __u64);
36*387f9dfdSAndroid Build Coastguard Worker } timestamps SEC(".maps");
37*387f9dfdSAndroid Build Coastguard Worker
38*387f9dfdSAndroid Build Coastguard Worker struct {
39*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_PERF_EVENT_ARRAY);
40*387f9dfdSAndroid Build Coastguard Worker __uint(key_size, sizeof(__u32));
41*387f9dfdSAndroid Build Coastguard Worker __uint(value_size, sizeof(__u32));
42*387f9dfdSAndroid Build Coastguard Worker } events SEC(".maps");
43*387f9dfdSAndroid Build Coastguard Worker
44*387f9dfdSAndroid Build Coastguard Worker SEC("tracepoint/sock/inet_sock_set_state")
handle_set_state(struct trace_event_raw_inet_sock_set_state * ctx)45*387f9dfdSAndroid Build Coastguard Worker int handle_set_state(struct trace_event_raw_inet_sock_set_state *ctx)
46*387f9dfdSAndroid Build Coastguard Worker {
47*387f9dfdSAndroid Build Coastguard Worker struct sock *sk = (struct sock *)ctx->skaddr;
48*387f9dfdSAndroid Build Coastguard Worker __u16 family = ctx->family;
49*387f9dfdSAndroid Build Coastguard Worker __u16 sport = ctx->sport;
50*387f9dfdSAndroid Build Coastguard Worker __u16 dport = ctx->dport;
51*387f9dfdSAndroid Build Coastguard Worker __u64 *tsp, delta_us, ts;
52*387f9dfdSAndroid Build Coastguard Worker struct event event = {};
53*387f9dfdSAndroid Build Coastguard Worker
54*387f9dfdSAndroid Build Coastguard Worker if (ctx->protocol != IPPROTO_TCP)
55*387f9dfdSAndroid Build Coastguard Worker return 0;
56*387f9dfdSAndroid Build Coastguard Worker
57*387f9dfdSAndroid Build Coastguard Worker if (target_family && target_family != family)
58*387f9dfdSAndroid Build Coastguard Worker return 0;
59*387f9dfdSAndroid Build Coastguard Worker
60*387f9dfdSAndroid Build Coastguard Worker if (filter_by_sport && !bpf_map_lookup_elem(&sports, &sport))
61*387f9dfdSAndroid Build Coastguard Worker return 0;
62*387f9dfdSAndroid Build Coastguard Worker
63*387f9dfdSAndroid Build Coastguard Worker if (filter_by_dport && !bpf_map_lookup_elem(&dports, &dport))
64*387f9dfdSAndroid Build Coastguard Worker return 0;
65*387f9dfdSAndroid Build Coastguard Worker
66*387f9dfdSAndroid Build Coastguard Worker tsp = bpf_map_lookup_elem(×tamps, &sk);
67*387f9dfdSAndroid Build Coastguard Worker ts = bpf_ktime_get_ns();
68*387f9dfdSAndroid Build Coastguard Worker if (!tsp)
69*387f9dfdSAndroid Build Coastguard Worker delta_us = 0;
70*387f9dfdSAndroid Build Coastguard Worker else
71*387f9dfdSAndroid Build Coastguard Worker delta_us = (ts - *tsp) / 1000;
72*387f9dfdSAndroid Build Coastguard Worker
73*387f9dfdSAndroid Build Coastguard Worker event.skaddr = (__u64)sk;
74*387f9dfdSAndroid Build Coastguard Worker event.ts_us = ts / 1000;
75*387f9dfdSAndroid Build Coastguard Worker event.delta_us = delta_us;
76*387f9dfdSAndroid Build Coastguard Worker event.pid = bpf_get_current_pid_tgid() >> 32;
77*387f9dfdSAndroid Build Coastguard Worker event.oldstate = ctx->oldstate;
78*387f9dfdSAndroid Build Coastguard Worker event.newstate = ctx->newstate;
79*387f9dfdSAndroid Build Coastguard Worker event.family = family;
80*387f9dfdSAndroid Build Coastguard Worker event.sport = sport;
81*387f9dfdSAndroid Build Coastguard Worker event.dport = dport;
82*387f9dfdSAndroid Build Coastguard Worker bpf_get_current_comm(&event.task, sizeof(event.task));
83*387f9dfdSAndroid Build Coastguard Worker
84*387f9dfdSAndroid Build Coastguard Worker if (family == AF_INET) {
85*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel(&event.saddr, sizeof(event.saddr), &sk->__sk_common.skc_rcv_saddr);
86*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel(&event.daddr, sizeof(event.daddr), &sk->__sk_common.skc_daddr);
87*387f9dfdSAndroid Build Coastguard Worker } else { /* family == AF_INET6 */
88*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel(&event.saddr, sizeof(event.saddr), &sk->__sk_common.skc_v6_rcv_saddr.in6_u.u6_addr32);
89*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel(&event.daddr, sizeof(event.daddr), &sk->__sk_common.skc_v6_daddr.in6_u.u6_addr32);
90*387f9dfdSAndroid Build Coastguard Worker }
91*387f9dfdSAndroid Build Coastguard Worker
92*387f9dfdSAndroid Build Coastguard Worker bpf_perf_event_output(ctx, &events, BPF_F_CURRENT_CPU, &event, sizeof(event));
93*387f9dfdSAndroid Build Coastguard Worker
94*387f9dfdSAndroid Build Coastguard Worker if (ctx->newstate == TCP_CLOSE)
95*387f9dfdSAndroid Build Coastguard Worker bpf_map_delete_elem(×tamps, &sk);
96*387f9dfdSAndroid Build Coastguard Worker else
97*387f9dfdSAndroid Build Coastguard Worker bpf_map_update_elem(×tamps, &sk, &ts, BPF_ANY);
98*387f9dfdSAndroid Build Coastguard Worker
99*387f9dfdSAndroid Build Coastguard Worker return 0;
100*387f9dfdSAndroid Build Coastguard Worker }
101*387f9dfdSAndroid Build Coastguard Worker
102*387f9dfdSAndroid Build Coastguard Worker char LICENSE[] SEC("license") = "Dual BSD/GPL";
103