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