1*387f9dfdSAndroid Build Coastguard Worker // SPDX-License-Identifier: GPL-2.0
2*387f9dfdSAndroid Build Coastguard Worker // Copyright (c) 2020 Wenbo Zhang
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_core_read.h>
6*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_tracing.h>
7*387f9dfdSAndroid Build Coastguard Worker #include "cpudist.h"
8*387f9dfdSAndroid Build Coastguard Worker #include "bits.bpf.h"
9*387f9dfdSAndroid Build Coastguard Worker #include "core_fixes.bpf.h"
10*387f9dfdSAndroid Build Coastguard Worker
11*387f9dfdSAndroid Build Coastguard Worker #define TASK_RUNNING 0
12*387f9dfdSAndroid Build Coastguard Worker
13*387f9dfdSAndroid Build Coastguard Worker const volatile bool filter_cg = false;
14*387f9dfdSAndroid Build Coastguard Worker const volatile bool targ_per_process = false;
15*387f9dfdSAndroid Build Coastguard Worker const volatile bool targ_per_thread = false;
16*387f9dfdSAndroid Build Coastguard Worker const volatile bool targ_offcpu = false;
17*387f9dfdSAndroid Build Coastguard Worker const volatile bool targ_ms = false;
18*387f9dfdSAndroid Build Coastguard Worker const volatile pid_t targ_tgid = -1;
19*387f9dfdSAndroid Build Coastguard Worker
20*387f9dfdSAndroid Build Coastguard Worker struct {
21*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_CGROUP_ARRAY);
22*387f9dfdSAndroid Build Coastguard Worker __type(key, u32);
23*387f9dfdSAndroid Build Coastguard Worker __type(value, u32);
24*387f9dfdSAndroid Build Coastguard Worker __uint(max_entries, 1);
25*387f9dfdSAndroid Build Coastguard Worker } cgroup_map SEC(".maps");
26*387f9dfdSAndroid Build Coastguard Worker
27*387f9dfdSAndroid Build Coastguard Worker struct {
28*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
29*387f9dfdSAndroid Build Coastguard Worker __type(key, u32);
30*387f9dfdSAndroid Build Coastguard Worker __type(value, u64);
31*387f9dfdSAndroid Build Coastguard Worker } start SEC(".maps");
32*387f9dfdSAndroid Build Coastguard Worker
33*387f9dfdSAndroid Build Coastguard Worker static struct hist initial_hist;
34*387f9dfdSAndroid Build Coastguard Worker
35*387f9dfdSAndroid Build Coastguard Worker struct {
36*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
37*387f9dfdSAndroid Build Coastguard Worker __type(key, u32);
38*387f9dfdSAndroid Build Coastguard Worker __type(value, struct hist);
39*387f9dfdSAndroid Build Coastguard Worker } hists SEC(".maps");
40*387f9dfdSAndroid Build Coastguard Worker
store_start(u32 tgid,u32 pid,u64 ts)41*387f9dfdSAndroid Build Coastguard Worker static __always_inline void store_start(u32 tgid, u32 pid, u64 ts)
42*387f9dfdSAndroid Build Coastguard Worker {
43*387f9dfdSAndroid Build Coastguard Worker if (targ_tgid != -1 && targ_tgid != tgid)
44*387f9dfdSAndroid Build Coastguard Worker return;
45*387f9dfdSAndroid Build Coastguard Worker bpf_map_update_elem(&start, &pid, &ts, 0);
46*387f9dfdSAndroid Build Coastguard Worker }
47*387f9dfdSAndroid Build Coastguard Worker
update_hist(struct task_struct * task,u32 tgid,u32 pid,u64 ts)48*387f9dfdSAndroid Build Coastguard Worker static __always_inline void update_hist(struct task_struct *task,
49*387f9dfdSAndroid Build Coastguard Worker u32 tgid, u32 pid, u64 ts)
50*387f9dfdSAndroid Build Coastguard Worker {
51*387f9dfdSAndroid Build Coastguard Worker u64 delta, *tsp, slot;
52*387f9dfdSAndroid Build Coastguard Worker struct hist *histp;
53*387f9dfdSAndroid Build Coastguard Worker u32 id;
54*387f9dfdSAndroid Build Coastguard Worker
55*387f9dfdSAndroid Build Coastguard Worker if (targ_tgid != -1 && targ_tgid != tgid)
56*387f9dfdSAndroid Build Coastguard Worker return;
57*387f9dfdSAndroid Build Coastguard Worker
58*387f9dfdSAndroid Build Coastguard Worker tsp = bpf_map_lookup_elem(&start, &pid);
59*387f9dfdSAndroid Build Coastguard Worker if (!tsp || ts < *tsp)
60*387f9dfdSAndroid Build Coastguard Worker return;
61*387f9dfdSAndroid Build Coastguard Worker
62*387f9dfdSAndroid Build Coastguard Worker if (targ_per_process)
63*387f9dfdSAndroid Build Coastguard Worker id = tgid;
64*387f9dfdSAndroid Build Coastguard Worker else if (targ_per_thread)
65*387f9dfdSAndroid Build Coastguard Worker id = pid;
66*387f9dfdSAndroid Build Coastguard Worker else
67*387f9dfdSAndroid Build Coastguard Worker id = -1;
68*387f9dfdSAndroid Build Coastguard Worker histp = bpf_map_lookup_elem(&hists, &id);
69*387f9dfdSAndroid Build Coastguard Worker if (!histp) {
70*387f9dfdSAndroid Build Coastguard Worker bpf_map_update_elem(&hists, &id, &initial_hist, 0);
71*387f9dfdSAndroid Build Coastguard Worker histp = bpf_map_lookup_elem(&hists, &id);
72*387f9dfdSAndroid Build Coastguard Worker if (!histp)
73*387f9dfdSAndroid Build Coastguard Worker return;
74*387f9dfdSAndroid Build Coastguard Worker BPF_CORE_READ_STR_INTO(&histp->comm, task, comm);
75*387f9dfdSAndroid Build Coastguard Worker }
76*387f9dfdSAndroid Build Coastguard Worker delta = ts - *tsp;
77*387f9dfdSAndroid Build Coastguard Worker if (targ_ms)
78*387f9dfdSAndroid Build Coastguard Worker delta /= 1000000;
79*387f9dfdSAndroid Build Coastguard Worker else
80*387f9dfdSAndroid Build Coastguard Worker delta /= 1000;
81*387f9dfdSAndroid Build Coastguard Worker slot = log2l(delta);
82*387f9dfdSAndroid Build Coastguard Worker if (slot >= MAX_SLOTS)
83*387f9dfdSAndroid Build Coastguard Worker slot = MAX_SLOTS - 1;
84*387f9dfdSAndroid Build Coastguard Worker __sync_fetch_and_add(&histp->slots[slot], 1);
85*387f9dfdSAndroid Build Coastguard Worker }
86*387f9dfdSAndroid Build Coastguard Worker
handle_switch(struct task_struct * prev,struct task_struct * next)87*387f9dfdSAndroid Build Coastguard Worker static int handle_switch(struct task_struct *prev, struct task_struct *next)
88*387f9dfdSAndroid Build Coastguard Worker {
89*387f9dfdSAndroid Build Coastguard Worker u32 prev_tgid = BPF_CORE_READ(prev, tgid), prev_pid = BPF_CORE_READ(prev, pid);
90*387f9dfdSAndroid Build Coastguard Worker u32 tgid = BPF_CORE_READ(next, tgid), pid = BPF_CORE_READ(next, pid);
91*387f9dfdSAndroid Build Coastguard Worker u64 ts = bpf_ktime_get_ns();
92*387f9dfdSAndroid Build Coastguard Worker
93*387f9dfdSAndroid Build Coastguard Worker if (filter_cg && !bpf_current_task_under_cgroup(&cgroup_map, 0))
94*387f9dfdSAndroid Build Coastguard Worker return 0;
95*387f9dfdSAndroid Build Coastguard Worker
96*387f9dfdSAndroid Build Coastguard Worker if (targ_offcpu) {
97*387f9dfdSAndroid Build Coastguard Worker store_start(prev_tgid, prev_pid, ts);
98*387f9dfdSAndroid Build Coastguard Worker update_hist(next, tgid, pid, ts);
99*387f9dfdSAndroid Build Coastguard Worker } else {
100*387f9dfdSAndroid Build Coastguard Worker if (get_task_state(prev) == TASK_RUNNING)
101*387f9dfdSAndroid Build Coastguard Worker update_hist(prev, prev_tgid, prev_pid, ts);
102*387f9dfdSAndroid Build Coastguard Worker store_start(tgid, pid, ts);
103*387f9dfdSAndroid Build Coastguard Worker }
104*387f9dfdSAndroid Build Coastguard Worker return 0;
105*387f9dfdSAndroid Build Coastguard Worker }
106*387f9dfdSAndroid Build Coastguard Worker
107*387f9dfdSAndroid Build Coastguard Worker SEC("tp_btf/sched_switch")
BPF_PROG(sched_switch_btf,bool preempt,struct task_struct * prev,struct task_struct * next)108*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(sched_switch_btf, bool preempt, struct task_struct *prev,
109*387f9dfdSAndroid Build Coastguard Worker struct task_struct *next)
110*387f9dfdSAndroid Build Coastguard Worker {
111*387f9dfdSAndroid Build Coastguard Worker return handle_switch(prev, next);
112*387f9dfdSAndroid Build Coastguard Worker }
113*387f9dfdSAndroid Build Coastguard Worker
114*387f9dfdSAndroid Build Coastguard Worker SEC("raw_tp/sched_switch")
BPF_PROG(sched_switch_tp,bool preempt,struct task_struct * prev,struct task_struct * next)115*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(sched_switch_tp, bool preempt, struct task_struct *prev,
116*387f9dfdSAndroid Build Coastguard Worker struct task_struct *next)
117*387f9dfdSAndroid Build Coastguard Worker {
118*387f9dfdSAndroid Build Coastguard Worker return handle_switch(prev, next);
119*387f9dfdSAndroid Build Coastguard Worker }
120*387f9dfdSAndroid Build Coastguard Worker
121*387f9dfdSAndroid Build Coastguard Worker char LICENSE[] SEC("license") = "GPL";
122