162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci#include <linux/bpf.h>
362306a36Sopenharmony_ci#include <bpf/bpf_helpers.h>
462306a36Sopenharmony_ci#include <bpf/bpf_tracing.h>
562306a36Sopenharmony_ci#include <stdbool.h>
662306a36Sopenharmony_ci
762306a36Sopenharmony_cichar _license[] SEC("license") = "GPL";
862306a36Sopenharmony_ci
962306a36Sopenharmony_ciextern const void bpf_fentry_test1 __ksym;
1062306a36Sopenharmony_ciextern const void bpf_fentry_test2 __ksym;
1162306a36Sopenharmony_ciextern const void bpf_fentry_test3 __ksym;
1262306a36Sopenharmony_ciextern const void bpf_fentry_test4 __ksym;
1362306a36Sopenharmony_ciextern const void bpf_fentry_test5 __ksym;
1462306a36Sopenharmony_ciextern const void bpf_fentry_test6 __ksym;
1562306a36Sopenharmony_ciextern const void bpf_fentry_test7 __ksym;
1662306a36Sopenharmony_ciextern const void bpf_fentry_test8 __ksym;
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ciint pid = 0;
1962306a36Sopenharmony_cibool test_cookie = false;
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci__u64 kprobe_test1_result = 0;
2262306a36Sopenharmony_ci__u64 kprobe_test2_result = 0;
2362306a36Sopenharmony_ci__u64 kprobe_test3_result = 0;
2462306a36Sopenharmony_ci__u64 kprobe_test4_result = 0;
2562306a36Sopenharmony_ci__u64 kprobe_test5_result = 0;
2662306a36Sopenharmony_ci__u64 kprobe_test6_result = 0;
2762306a36Sopenharmony_ci__u64 kprobe_test7_result = 0;
2862306a36Sopenharmony_ci__u64 kprobe_test8_result = 0;
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci__u64 kretprobe_test1_result = 0;
3162306a36Sopenharmony_ci__u64 kretprobe_test2_result = 0;
3262306a36Sopenharmony_ci__u64 kretprobe_test3_result = 0;
3362306a36Sopenharmony_ci__u64 kretprobe_test4_result = 0;
3462306a36Sopenharmony_ci__u64 kretprobe_test5_result = 0;
3562306a36Sopenharmony_ci__u64 kretprobe_test6_result = 0;
3662306a36Sopenharmony_ci__u64 kretprobe_test7_result = 0;
3762306a36Sopenharmony_ci__u64 kretprobe_test8_result = 0;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_cistatic void kprobe_multi_check(void *ctx, bool is_return)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	if (bpf_get_current_pid_tgid() >> 32 != pid)
4262306a36Sopenharmony_ci		return;
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	__u64 cookie = test_cookie ? bpf_get_attach_cookie(ctx) : 0;
4562306a36Sopenharmony_ci	__u64 addr = bpf_get_func_ip(ctx);
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci#define SET(__var, __addr, __cookie) ({			\
4862306a36Sopenharmony_ci	if (((const void *) addr == __addr) &&		\
4962306a36Sopenharmony_ci	     (!test_cookie || (cookie == __cookie)))	\
5062306a36Sopenharmony_ci		__var = 1;				\
5162306a36Sopenharmony_ci})
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_ci	if (is_return) {
5462306a36Sopenharmony_ci		SET(kretprobe_test1_result, &bpf_fentry_test1, 8);
5562306a36Sopenharmony_ci		SET(kretprobe_test2_result, &bpf_fentry_test2, 2);
5662306a36Sopenharmony_ci		SET(kretprobe_test3_result, &bpf_fentry_test3, 7);
5762306a36Sopenharmony_ci		SET(kretprobe_test4_result, &bpf_fentry_test4, 6);
5862306a36Sopenharmony_ci		SET(kretprobe_test5_result, &bpf_fentry_test5, 5);
5962306a36Sopenharmony_ci		SET(kretprobe_test6_result, &bpf_fentry_test6, 4);
6062306a36Sopenharmony_ci		SET(kretprobe_test7_result, &bpf_fentry_test7, 3);
6162306a36Sopenharmony_ci		SET(kretprobe_test8_result, &bpf_fentry_test8, 1);
6262306a36Sopenharmony_ci	} else {
6362306a36Sopenharmony_ci		SET(kprobe_test1_result, &bpf_fentry_test1, 1);
6462306a36Sopenharmony_ci		SET(kprobe_test2_result, &bpf_fentry_test2, 7);
6562306a36Sopenharmony_ci		SET(kprobe_test3_result, &bpf_fentry_test3, 2);
6662306a36Sopenharmony_ci		SET(kprobe_test4_result, &bpf_fentry_test4, 3);
6762306a36Sopenharmony_ci		SET(kprobe_test5_result, &bpf_fentry_test5, 4);
6862306a36Sopenharmony_ci		SET(kprobe_test6_result, &bpf_fentry_test6, 5);
6962306a36Sopenharmony_ci		SET(kprobe_test7_result, &bpf_fentry_test7, 6);
7062306a36Sopenharmony_ci		SET(kprobe_test8_result, &bpf_fentry_test8, 8);
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci#undef SET
7462306a36Sopenharmony_ci}
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci/*
7762306a36Sopenharmony_ci * No tests in here, just to trigger 'bpf_fentry_test*'
7862306a36Sopenharmony_ci * through tracing test_run
7962306a36Sopenharmony_ci */
8062306a36Sopenharmony_ciSEC("fentry/bpf_modify_return_test")
8162306a36Sopenharmony_ciint BPF_PROG(trigger)
8262306a36Sopenharmony_ci{
8362306a36Sopenharmony_ci	return 0;
8462306a36Sopenharmony_ci}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ciSEC("kprobe.multi/bpf_fentry_tes??")
8762306a36Sopenharmony_ciint test_kprobe(struct pt_regs *ctx)
8862306a36Sopenharmony_ci{
8962306a36Sopenharmony_ci	kprobe_multi_check(ctx, false);
9062306a36Sopenharmony_ci	return 0;
9162306a36Sopenharmony_ci}
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ciSEC("kretprobe.multi/bpf_fentry_test*")
9462306a36Sopenharmony_ciint test_kretprobe(struct pt_regs *ctx)
9562306a36Sopenharmony_ci{
9662306a36Sopenharmony_ci	kprobe_multi_check(ctx, true);
9762306a36Sopenharmony_ci	return 0;
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ciSEC("kprobe.multi")
10162306a36Sopenharmony_ciint test_kprobe_manual(struct pt_regs *ctx)
10262306a36Sopenharmony_ci{
10362306a36Sopenharmony_ci	kprobe_multi_check(ctx, false);
10462306a36Sopenharmony_ci	return 0;
10562306a36Sopenharmony_ci}
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ciSEC("kretprobe.multi")
10862306a36Sopenharmony_ciint test_kretprobe_manual(struct pt_regs *ctx)
10962306a36Sopenharmony_ci{
11062306a36Sopenharmony_ci	kprobe_multi_check(ctx, true);
11162306a36Sopenharmony_ci	return 0;
11262306a36Sopenharmony_ci}
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ciextern const void bpf_testmod_fentry_test1 __ksym;
11562306a36Sopenharmony_ciextern const void bpf_testmod_fentry_test2 __ksym;
11662306a36Sopenharmony_ciextern const void bpf_testmod_fentry_test3 __ksym;
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci__u64 kprobe_testmod_test1_result = 0;
11962306a36Sopenharmony_ci__u64 kprobe_testmod_test2_result = 0;
12062306a36Sopenharmony_ci__u64 kprobe_testmod_test3_result = 0;
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci__u64 kretprobe_testmod_test1_result = 0;
12362306a36Sopenharmony_ci__u64 kretprobe_testmod_test2_result = 0;
12462306a36Sopenharmony_ci__u64 kretprobe_testmod_test3_result = 0;
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_cistatic void kprobe_multi_testmod_check(void *ctx, bool is_return)
12762306a36Sopenharmony_ci{
12862306a36Sopenharmony_ci	if (bpf_get_current_pid_tgid() >> 32 != pid)
12962306a36Sopenharmony_ci		return;
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci	__u64 addr = bpf_get_func_ip(ctx);
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	if (is_return) {
13462306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test1)
13562306a36Sopenharmony_ci			kretprobe_testmod_test1_result = 1;
13662306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test2)
13762306a36Sopenharmony_ci			kretprobe_testmod_test2_result = 1;
13862306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test3)
13962306a36Sopenharmony_ci			kretprobe_testmod_test3_result = 1;
14062306a36Sopenharmony_ci	} else {
14162306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test1)
14262306a36Sopenharmony_ci			kprobe_testmod_test1_result = 1;
14362306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test2)
14462306a36Sopenharmony_ci			kprobe_testmod_test2_result = 1;
14562306a36Sopenharmony_ci		if ((const void *) addr == &bpf_testmod_fentry_test3)
14662306a36Sopenharmony_ci			kprobe_testmod_test3_result = 1;
14762306a36Sopenharmony_ci	}
14862306a36Sopenharmony_ci}
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ciSEC("kprobe.multi")
15162306a36Sopenharmony_ciint test_kprobe_testmod(struct pt_regs *ctx)
15262306a36Sopenharmony_ci{
15362306a36Sopenharmony_ci	kprobe_multi_testmod_check(ctx, false);
15462306a36Sopenharmony_ci	return 0;
15562306a36Sopenharmony_ci}
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ciSEC("kretprobe.multi")
15862306a36Sopenharmony_ciint test_kretprobe_testmod(struct pt_regs *ctx)
15962306a36Sopenharmony_ci{
16062306a36Sopenharmony_ci	kprobe_multi_testmod_check(ctx, true);
16162306a36Sopenharmony_ci	return 0;
16262306a36Sopenharmony_ci}
163