19c01546dSAndrii Nakryiko // SPDX-License-Identifier: GPL-2.0
29c01546dSAndrii Nakryiko // Copyright (c) 2019 Facebook
39c01546dSAndrii Nakryiko #include "vmlinux.h"
45b554ce5SToke Høiland-Jørgensen #include <bpf/bpf_helpers.h>
59c01546dSAndrii Nakryiko #include "runqslower.h"
69c01546dSAndrii Nakryiko 
79c01546dSAndrii Nakryiko #define TASK_RUNNING 0
837ccc12bSAndrii Nakryiko #define BPF_F_CURRENT_CPU 0xffffffffULL
99c01546dSAndrii Nakryiko 
109c01546dSAndrii Nakryiko const volatile __u64 min_us = 0;
119c01546dSAndrii Nakryiko const volatile pid_t targ_pid = 0;
129c01546dSAndrii Nakryiko 
139c01546dSAndrii Nakryiko struct {
149c01546dSAndrii Nakryiko 	__uint(type, BPF_MAP_TYPE_HASH);
159c01546dSAndrii Nakryiko 	__uint(max_entries, 10240);
169c01546dSAndrii Nakryiko 	__type(key, u32);
179c01546dSAndrii Nakryiko 	__type(value, u64);
189c01546dSAndrii Nakryiko } start SEC(".maps");
199c01546dSAndrii Nakryiko 
209c01546dSAndrii Nakryiko struct {
219c01546dSAndrii Nakryiko 	__uint(type, BPF_MAP_TYPE_PERF_EVENT_ARRAY);
229c01546dSAndrii Nakryiko 	__uint(key_size, sizeof(u32));
239c01546dSAndrii Nakryiko 	__uint(value_size, sizeof(u32));
249c01546dSAndrii Nakryiko } events SEC(".maps");
259c01546dSAndrii Nakryiko 
269c01546dSAndrii Nakryiko /* record enqueue timestamp */
279c01546dSAndrii Nakryiko __always_inline
289c01546dSAndrii Nakryiko static int trace_enqueue(u32 tgid, u32 pid)
299c01546dSAndrii Nakryiko {
309c01546dSAndrii Nakryiko 	u64 ts;
319c01546dSAndrii Nakryiko 
329c01546dSAndrii Nakryiko 	if (!pid || (targ_pid && targ_pid != pid))
339c01546dSAndrii Nakryiko 		return 0;
349c01546dSAndrii Nakryiko 
359c01546dSAndrii Nakryiko 	ts = bpf_ktime_get_ns();
369c01546dSAndrii Nakryiko 	bpf_map_update_elem(&start, &pid, &ts, 0);
379c01546dSAndrii Nakryiko 	return 0;
389c01546dSAndrii Nakryiko }
399c01546dSAndrii Nakryiko 
409c01546dSAndrii Nakryiko SEC("tp_btf/sched_wakeup")
419c01546dSAndrii Nakryiko int handle__sched_wakeup(u64 *ctx)
429c01546dSAndrii Nakryiko {
439c01546dSAndrii Nakryiko 	/* TP_PROTO(struct task_struct *p) */
449c01546dSAndrii Nakryiko 	struct task_struct *p = (void *)ctx[0];
459c01546dSAndrii Nakryiko 
469c01546dSAndrii Nakryiko 	return trace_enqueue(p->tgid, p->pid);
479c01546dSAndrii Nakryiko }
489c01546dSAndrii Nakryiko 
499c01546dSAndrii Nakryiko SEC("tp_btf/sched_wakeup_new")
509c01546dSAndrii Nakryiko int handle__sched_wakeup_new(u64 *ctx)
519c01546dSAndrii Nakryiko {
529c01546dSAndrii Nakryiko 	/* TP_PROTO(struct task_struct *p) */
539c01546dSAndrii Nakryiko 	struct task_struct *p = (void *)ctx[0];
549c01546dSAndrii Nakryiko 
559c01546dSAndrii Nakryiko 	return trace_enqueue(p->tgid, p->pid);
569c01546dSAndrii Nakryiko }
579c01546dSAndrii Nakryiko 
589c01546dSAndrii Nakryiko SEC("tp_btf/sched_switch")
599c01546dSAndrii Nakryiko int handle__sched_switch(u64 *ctx)
609c01546dSAndrii Nakryiko {
619c01546dSAndrii Nakryiko 	/* TP_PROTO(bool preempt, struct task_struct *prev,
629c01546dSAndrii Nakryiko 	 *	    struct task_struct *next)
639c01546dSAndrii Nakryiko 	 */
649c01546dSAndrii Nakryiko 	struct task_struct *prev = (struct task_struct *)ctx[1];
659c01546dSAndrii Nakryiko 	struct task_struct *next = (struct task_struct *)ctx[2];
669c01546dSAndrii Nakryiko 	struct event event = {};
679c01546dSAndrii Nakryiko 	u64 *tsp, delta_us;
689c01546dSAndrii Nakryiko 	long state;
699c01546dSAndrii Nakryiko 	u32 pid;
709c01546dSAndrii Nakryiko 
719c01546dSAndrii Nakryiko 	/* ivcsw: treat like an enqueue event and store timestamp */
729c01546dSAndrii Nakryiko 	if (prev->state == TASK_RUNNING)
739c01546dSAndrii Nakryiko 		trace_enqueue(prev->tgid, prev->pid);
749c01546dSAndrii Nakryiko 
759c01546dSAndrii Nakryiko 	pid = next->pid;
769c01546dSAndrii Nakryiko 
779c01546dSAndrii Nakryiko 	/* fetch timestamp and calculate delta */
789c01546dSAndrii Nakryiko 	tsp = bpf_map_lookup_elem(&start, &pid);
799c01546dSAndrii Nakryiko 	if (!tsp)
809c01546dSAndrii Nakryiko 		return 0;   /* missed enqueue */
819c01546dSAndrii Nakryiko 
829c01546dSAndrii Nakryiko 	delta_us = (bpf_ktime_get_ns() - *tsp) / 1000;
839c01546dSAndrii Nakryiko 	if (min_us && delta_us <= min_us)
849c01546dSAndrii Nakryiko 		return 0;
859c01546dSAndrii Nakryiko 
869c01546dSAndrii Nakryiko 	event.pid = pid;
879c01546dSAndrii Nakryiko 	event.delta_us = delta_us;
889c01546dSAndrii Nakryiko 	bpf_get_current_comm(&event.task, sizeof(event.task));
899c01546dSAndrii Nakryiko 
909c01546dSAndrii Nakryiko 	/* output */
919c01546dSAndrii Nakryiko 	bpf_perf_event_output(ctx, &events, BPF_F_CURRENT_CPU,
929c01546dSAndrii Nakryiko 			      &event, sizeof(event));
939c01546dSAndrii Nakryiko 
949c01546dSAndrii Nakryiko 	bpf_map_delete_elem(&start, &pid);
959c01546dSAndrii Nakryiko 	return 0;
969c01546dSAndrii Nakryiko }
979c01546dSAndrii Nakryiko 
989c01546dSAndrii Nakryiko char LICENSE[] SEC("license") = "GPL";
99