175b37157SJiri Olsa // SPDX-License-Identifier: GPL-2.0
275b37157SJiri Olsa #include <linux/bpf.h>
375b37157SJiri Olsa #include <bpf/bpf_helpers.h>
475b37157SJiri Olsa #include <bpf/bpf_tracing.h>
575b37157SJiri Olsa #include <stdbool.h>
675b37157SJiri Olsa 
775b37157SJiri Olsa char _license[] SEC("license") = "GPL";
875b37157SJiri Olsa 
975b37157SJiri Olsa __u64 uprobe_multi_func_1_addr = 0;
1075b37157SJiri Olsa __u64 uprobe_multi_func_2_addr = 0;
1175b37157SJiri Olsa __u64 uprobe_multi_func_3_addr = 0;
1275b37157SJiri Olsa 
1375b37157SJiri Olsa __u64 uprobe_multi_func_1_result = 0;
1475b37157SJiri Olsa __u64 uprobe_multi_func_2_result = 0;
1575b37157SJiri Olsa __u64 uprobe_multi_func_3_result = 0;
1675b37157SJiri Olsa 
1775b37157SJiri Olsa __u64 uretprobe_multi_func_1_result = 0;
1875b37157SJiri Olsa __u64 uretprobe_multi_func_2_result = 0;
1975b37157SJiri Olsa __u64 uretprobe_multi_func_3_result = 0;
2075b37157SJiri Olsa 
2175b37157SJiri Olsa __u64 uprobe_multi_sleep_result = 0;
2275b37157SJiri Olsa 
2375b37157SJiri Olsa int pid = 0;
24d571efaeSJiri Olsa int child_pid = 0;
25d571efaeSJiri Olsa 
2675b37157SJiri Olsa bool test_cookie = false;
2775b37157SJiri Olsa void *user_ptr = 0;
2875b37157SJiri Olsa 
verify_sleepable_user_copy(void)2975b37157SJiri Olsa static __always_inline bool verify_sleepable_user_copy(void)
3075b37157SJiri Olsa {
3175b37157SJiri Olsa 	char data[9];
3275b37157SJiri Olsa 
3375b37157SJiri Olsa 	bpf_copy_from_user(data, sizeof(data), user_ptr);
3475b37157SJiri Olsa 	return bpf_strncmp(data, sizeof(data), "test_data") == 0;
3575b37157SJiri Olsa }
3675b37157SJiri Olsa 
uprobe_multi_check(void * ctx,bool is_return,bool is_sleep)3775b37157SJiri Olsa static void uprobe_multi_check(void *ctx, bool is_return, bool is_sleep)
3875b37157SJiri Olsa {
39d571efaeSJiri Olsa 	child_pid = bpf_get_current_pid_tgid() >> 32;
40d571efaeSJiri Olsa 
41d571efaeSJiri Olsa 	if (pid && child_pid != pid)
4275b37157SJiri Olsa 		return;
4375b37157SJiri Olsa 
4475b37157SJiri Olsa 	__u64 cookie = test_cookie ? bpf_get_attach_cookie(ctx) : 0;
4575b37157SJiri Olsa 	__u64 addr = bpf_get_func_ip(ctx);
4675b37157SJiri Olsa 
4775b37157SJiri Olsa #define SET(__var, __addr, __cookie) ({			\
4875b37157SJiri Olsa 	if (addr == __addr &&				\
4975b37157SJiri Olsa 	   (!test_cookie || (cookie == __cookie)))	\
5075b37157SJiri Olsa 		__var += 1;				\
5175b37157SJiri Olsa })
5275b37157SJiri Olsa 
5375b37157SJiri Olsa 	if (is_return) {
5475b37157SJiri Olsa 		SET(uretprobe_multi_func_1_result, uprobe_multi_func_1_addr, 2);
5575b37157SJiri Olsa 		SET(uretprobe_multi_func_2_result, uprobe_multi_func_2_addr, 3);
5675b37157SJiri Olsa 		SET(uretprobe_multi_func_3_result, uprobe_multi_func_3_addr, 1);
5775b37157SJiri Olsa 	} else {
5875b37157SJiri Olsa 		SET(uprobe_multi_func_1_result, uprobe_multi_func_1_addr, 3);
5975b37157SJiri Olsa 		SET(uprobe_multi_func_2_result, uprobe_multi_func_2_addr, 1);
6075b37157SJiri Olsa 		SET(uprobe_multi_func_3_result, uprobe_multi_func_3_addr, 2);
6175b37157SJiri Olsa 	}
6275b37157SJiri Olsa 
6375b37157SJiri Olsa #undef SET
6475b37157SJiri Olsa 
6575b37157SJiri Olsa 	if (is_sleep && verify_sleepable_user_copy())
6675b37157SJiri Olsa 		uprobe_multi_sleep_result += 1;
6775b37157SJiri Olsa }
6875b37157SJiri Olsa 
6975b37157SJiri Olsa SEC("uprobe.multi//proc/self/exe:uprobe_multi_func_*")
uprobe(struct pt_regs * ctx)7075b37157SJiri Olsa int uprobe(struct pt_regs *ctx)
7175b37157SJiri Olsa {
7275b37157SJiri Olsa 	uprobe_multi_check(ctx, false, false);
7375b37157SJiri Olsa 	return 0;
7475b37157SJiri Olsa }
7575b37157SJiri Olsa 
7675b37157SJiri Olsa SEC("uretprobe.multi//proc/self/exe:uprobe_multi_func_*")
uretprobe(struct pt_regs * ctx)7775b37157SJiri Olsa int uretprobe(struct pt_regs *ctx)
7875b37157SJiri Olsa {
7975b37157SJiri Olsa 	uprobe_multi_check(ctx, true, false);
8075b37157SJiri Olsa 	return 0;
8175b37157SJiri Olsa }
8275b37157SJiri Olsa 
8375b37157SJiri Olsa SEC("uprobe.multi.s//proc/self/exe:uprobe_multi_func_*")
uprobe_sleep(struct pt_regs * ctx)8475b37157SJiri Olsa int uprobe_sleep(struct pt_regs *ctx)
8575b37157SJiri Olsa {
8675b37157SJiri Olsa 	uprobe_multi_check(ctx, false, true);
8775b37157SJiri Olsa 	return 0;
8875b37157SJiri Olsa }
8975b37157SJiri Olsa 
9075b37157SJiri Olsa SEC("uretprobe.multi.s//proc/self/exe:uprobe_multi_func_*")
uretprobe_sleep(struct pt_regs * ctx)9175b37157SJiri Olsa int uretprobe_sleep(struct pt_regs *ctx)
9275b37157SJiri Olsa {
9375b37157SJiri Olsa 	uprobe_multi_check(ctx, true, true);
9475b37157SJiri Olsa 	return 0;
9575b37157SJiri Olsa }
96*8909a939SJiri Olsa 
97*8909a939SJiri Olsa SEC("uprobe.multi//proc/self/exe:uprobe_multi_func_*")
uprobe_extra(struct pt_regs * ctx)98*8909a939SJiri Olsa int uprobe_extra(struct pt_regs *ctx)
99*8909a939SJiri Olsa {
100*8909a939SJiri Olsa 	return 0;
101*8909a939SJiri Olsa }
102