1*387f9dfdSAndroid Build Coastguard Worker // SPDX-License-Identifier: GPL-2.0
2*387f9dfdSAndroid Build Coastguard Worker // Copyright (c) 2019 Facebook
3*387f9dfdSAndroid Build Coastguard Worker #include <vmlinux.h>
4*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_core_read.h>
5*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_helpers.h>
6*387f9dfdSAndroid Build Coastguard Worker #include <bpf/bpf_tracing.h>
7*387f9dfdSAndroid Build Coastguard Worker #include "runqslower.h"
8*387f9dfdSAndroid Build Coastguard Worker #include "core_fixes.bpf.h"
9*387f9dfdSAndroid Build Coastguard Worker
10*387f9dfdSAndroid Build Coastguard Worker #define TASK_RUNNING 0
11*387f9dfdSAndroid Build Coastguard Worker
12*387f9dfdSAndroid Build Coastguard Worker const volatile __u64 min_us = 0;
13*387f9dfdSAndroid Build Coastguard Worker const volatile pid_t targ_pid = 0;
14*387f9dfdSAndroid Build Coastguard Worker const volatile pid_t targ_tgid = 0;
15*387f9dfdSAndroid Build Coastguard Worker
16*387f9dfdSAndroid Build Coastguard Worker struct {
17*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_HASH);
18*387f9dfdSAndroid Build Coastguard Worker __uint(max_entries, 10240);
19*387f9dfdSAndroid Build Coastguard Worker __type(key, u32);
20*387f9dfdSAndroid Build Coastguard Worker __type(value, u64);
21*387f9dfdSAndroid Build Coastguard Worker } start SEC(".maps");
22*387f9dfdSAndroid Build Coastguard Worker
23*387f9dfdSAndroid Build Coastguard Worker struct {
24*387f9dfdSAndroid Build Coastguard Worker __uint(type, BPF_MAP_TYPE_PERF_EVENT_ARRAY);
25*387f9dfdSAndroid Build Coastguard Worker __uint(key_size, sizeof(u32));
26*387f9dfdSAndroid Build Coastguard Worker __uint(value_size, sizeof(u32));
27*387f9dfdSAndroid Build Coastguard Worker } events SEC(".maps");
28*387f9dfdSAndroid Build Coastguard Worker
29*387f9dfdSAndroid Build Coastguard Worker /* record enqueue timestamp */
trace_enqueue(u32 tgid,u32 pid)30*387f9dfdSAndroid Build Coastguard Worker static int trace_enqueue(u32 tgid, u32 pid)
31*387f9dfdSAndroid Build Coastguard Worker {
32*387f9dfdSAndroid Build Coastguard Worker u64 ts;
33*387f9dfdSAndroid Build Coastguard Worker
34*387f9dfdSAndroid Build Coastguard Worker if (!pid)
35*387f9dfdSAndroid Build Coastguard Worker return 0;
36*387f9dfdSAndroid Build Coastguard Worker if (targ_tgid && targ_tgid != tgid)
37*387f9dfdSAndroid Build Coastguard Worker return 0;
38*387f9dfdSAndroid Build Coastguard Worker if (targ_pid && targ_pid != pid)
39*387f9dfdSAndroid Build Coastguard Worker return 0;
40*387f9dfdSAndroid Build Coastguard Worker
41*387f9dfdSAndroid Build Coastguard Worker ts = bpf_ktime_get_ns();
42*387f9dfdSAndroid Build Coastguard Worker bpf_map_update_elem(&start, &pid, &ts, 0);
43*387f9dfdSAndroid Build Coastguard Worker return 0;
44*387f9dfdSAndroid Build Coastguard Worker }
45*387f9dfdSAndroid Build Coastguard Worker
handle_switch(void * ctx,struct task_struct * prev,struct task_struct * next)46*387f9dfdSAndroid Build Coastguard Worker static int handle_switch(void *ctx, struct task_struct *prev, struct task_struct *next)
47*387f9dfdSAndroid Build Coastguard Worker {
48*387f9dfdSAndroid Build Coastguard Worker struct event event = {};
49*387f9dfdSAndroid Build Coastguard Worker u64 *tsp, delta_us;
50*387f9dfdSAndroid Build Coastguard Worker u32 pid;
51*387f9dfdSAndroid Build Coastguard Worker
52*387f9dfdSAndroid Build Coastguard Worker /* ivcsw: treat like an enqueue event and store timestamp */
53*387f9dfdSAndroid Build Coastguard Worker if (get_task_state(prev) == TASK_RUNNING)
54*387f9dfdSAndroid Build Coastguard Worker trace_enqueue(BPF_CORE_READ(prev, tgid), BPF_CORE_READ(prev, pid));
55*387f9dfdSAndroid Build Coastguard Worker
56*387f9dfdSAndroid Build Coastguard Worker pid = BPF_CORE_READ(next, pid);
57*387f9dfdSAndroid Build Coastguard Worker
58*387f9dfdSAndroid Build Coastguard Worker /* fetch timestamp and calculate delta */
59*387f9dfdSAndroid Build Coastguard Worker tsp = bpf_map_lookup_elem(&start, &pid);
60*387f9dfdSAndroid Build Coastguard Worker if (!tsp)
61*387f9dfdSAndroid Build Coastguard Worker return 0; /* missed enqueue */
62*387f9dfdSAndroid Build Coastguard Worker
63*387f9dfdSAndroid Build Coastguard Worker delta_us = (bpf_ktime_get_ns() - *tsp) / 1000;
64*387f9dfdSAndroid Build Coastguard Worker if (min_us && delta_us <= min_us)
65*387f9dfdSAndroid Build Coastguard Worker return 0;
66*387f9dfdSAndroid Build Coastguard Worker
67*387f9dfdSAndroid Build Coastguard Worker event.pid = pid;
68*387f9dfdSAndroid Build Coastguard Worker event.prev_pid = BPF_CORE_READ(prev, pid);
69*387f9dfdSAndroid Build Coastguard Worker event.delta_us = delta_us;
70*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel_str(&event.task, sizeof(event.task), next->comm);
71*387f9dfdSAndroid Build Coastguard Worker bpf_probe_read_kernel_str(&event.prev_task, sizeof(event.prev_task), prev->comm);
72*387f9dfdSAndroid Build Coastguard Worker
73*387f9dfdSAndroid Build Coastguard Worker /* output */
74*387f9dfdSAndroid Build Coastguard Worker bpf_perf_event_output(ctx, &events, BPF_F_CURRENT_CPU,
75*387f9dfdSAndroid Build Coastguard Worker &event, sizeof(event));
76*387f9dfdSAndroid Build Coastguard Worker
77*387f9dfdSAndroid Build Coastguard Worker bpf_map_delete_elem(&start, &pid);
78*387f9dfdSAndroid Build Coastguard Worker return 0;
79*387f9dfdSAndroid Build Coastguard Worker }
80*387f9dfdSAndroid Build Coastguard Worker
81*387f9dfdSAndroid Build Coastguard Worker SEC("tp_btf/sched_wakeup")
BPF_PROG(sched_wakeup,struct task_struct * p)82*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(sched_wakeup, struct task_struct *p)
83*387f9dfdSAndroid Build Coastguard Worker {
84*387f9dfdSAndroid Build Coastguard Worker return trace_enqueue(p->tgid, p->pid);
85*387f9dfdSAndroid Build Coastguard Worker }
86*387f9dfdSAndroid Build Coastguard Worker
87*387f9dfdSAndroid Build Coastguard Worker SEC("tp_btf/sched_wakeup_new")
BPF_PROG(sched_wakeup_new,struct task_struct * p)88*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(sched_wakeup_new, struct task_struct *p)
89*387f9dfdSAndroid Build Coastguard Worker {
90*387f9dfdSAndroid Build Coastguard Worker return trace_enqueue(p->tgid, p->pid);
91*387f9dfdSAndroid Build Coastguard Worker }
92*387f9dfdSAndroid Build Coastguard Worker
93*387f9dfdSAndroid Build Coastguard Worker SEC("tp_btf/sched_switch")
BPF_PROG(sched_switch,bool preempt,struct task_struct * prev,struct task_struct * next)94*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(sched_switch, bool preempt, struct task_struct *prev, struct task_struct *next)
95*387f9dfdSAndroid Build Coastguard Worker {
96*387f9dfdSAndroid Build Coastguard Worker return handle_switch(ctx, prev, next);
97*387f9dfdSAndroid Build Coastguard Worker }
98*387f9dfdSAndroid Build Coastguard Worker
99*387f9dfdSAndroid Build Coastguard Worker SEC("raw_tp/sched_wakeup")
BPF_PROG(handle_sched_wakeup,struct task_struct * p)100*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(handle_sched_wakeup, struct task_struct *p)
101*387f9dfdSAndroid Build Coastguard Worker {
102*387f9dfdSAndroid Build Coastguard Worker return trace_enqueue(BPF_CORE_READ(p, tgid), BPF_CORE_READ(p, pid));
103*387f9dfdSAndroid Build Coastguard Worker }
104*387f9dfdSAndroid Build Coastguard Worker
105*387f9dfdSAndroid Build Coastguard Worker SEC("raw_tp/sched_wakeup_new")
BPF_PROG(handle_sched_wakeup_new,struct task_struct * p)106*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(handle_sched_wakeup_new, struct task_struct *p)
107*387f9dfdSAndroid Build Coastguard Worker {
108*387f9dfdSAndroid Build Coastguard Worker return trace_enqueue(BPF_CORE_READ(p, tgid), BPF_CORE_READ(p, pid));
109*387f9dfdSAndroid Build Coastguard Worker }
110*387f9dfdSAndroid Build Coastguard Worker
111*387f9dfdSAndroid Build Coastguard Worker SEC("raw_tp/sched_switch")
BPF_PROG(handle_sched_switch,bool preempt,struct task_struct * prev,struct task_struct * next)112*387f9dfdSAndroid Build Coastguard Worker int BPF_PROG(handle_sched_switch, bool preempt, struct task_struct *prev, struct task_struct *next)
113*387f9dfdSAndroid Build Coastguard Worker {
114*387f9dfdSAndroid Build Coastguard Worker return handle_switch(ctx, prev, next);
115*387f9dfdSAndroid Build Coastguard Worker }
116*387f9dfdSAndroid Build Coastguard Worker
117*387f9dfdSAndroid Build Coastguard Worker char LICENSE[] SEC("license") = "GPL";
118