Loading...
1// SPDX-License-Identifier: GPL-2.0
2#include <test_progs.h>
3
4ssize_t get_base_addr() {
5 size_t start;
6 char buf[256];
7 FILE *f;
8
9 f = fopen("/proc/self/maps", "r");
10 if (!f)
11 return -errno;
12
13 while (fscanf(f, "%zx-%*x %s %*s\n", &start, buf) == 2) {
14 if (strcmp(buf, "r-xp") == 0) {
15 fclose(f);
16 return start;
17 }
18 }
19
20 fclose(f);
21 return -EINVAL;
22}
23
24void test_attach_probe(void)
25{
26 const char *kprobe_name = "kprobe/sys_nanosleep";
27 const char *kretprobe_name = "kretprobe/sys_nanosleep";
28 const char *uprobe_name = "uprobe/trigger_func";
29 const char *uretprobe_name = "uretprobe/trigger_func";
30 const int kprobe_idx = 0, kretprobe_idx = 1;
31 const int uprobe_idx = 2, uretprobe_idx = 3;
32 const char *file = "./test_attach_probe.o";
33 struct bpf_program *kprobe_prog, *kretprobe_prog;
34 struct bpf_program *uprobe_prog, *uretprobe_prog;
35 struct bpf_object *obj;
36 int err, prog_fd, duration = 0, res;
37 struct bpf_link *kprobe_link = NULL;
38 struct bpf_link *kretprobe_link = NULL;
39 struct bpf_link *uprobe_link = NULL;
40 struct bpf_link *uretprobe_link = NULL;
41 int results_map_fd;
42 size_t uprobe_offset;
43 ssize_t base_addr;
44
45 base_addr = get_base_addr();
46 if (CHECK(base_addr < 0, "get_base_addr",
47 "failed to find base addr: %zd", base_addr))
48 return;
49 uprobe_offset = (size_t)&get_base_addr - base_addr;
50
51 /* load programs */
52 err = bpf_prog_load(file, BPF_PROG_TYPE_KPROBE, &obj, &prog_fd);
53 if (CHECK(err, "obj_load", "err %d errno %d\n", err, errno))
54 return;
55
56 kprobe_prog = bpf_object__find_program_by_title(obj, kprobe_name);
57 if (CHECK(!kprobe_prog, "find_probe",
58 "prog '%s' not found\n", kprobe_name))
59 goto cleanup;
60 kretprobe_prog = bpf_object__find_program_by_title(obj, kretprobe_name);
61 if (CHECK(!kretprobe_prog, "find_probe",
62 "prog '%s' not found\n", kretprobe_name))
63 goto cleanup;
64 uprobe_prog = bpf_object__find_program_by_title(obj, uprobe_name);
65 if (CHECK(!uprobe_prog, "find_probe",
66 "prog '%s' not found\n", uprobe_name))
67 goto cleanup;
68 uretprobe_prog = bpf_object__find_program_by_title(obj, uretprobe_name);
69 if (CHECK(!uretprobe_prog, "find_probe",
70 "prog '%s' not found\n", uretprobe_name))
71 goto cleanup;
72
73 /* load maps */
74 results_map_fd = bpf_find_map(__func__, obj, "results_map");
75 if (CHECK(results_map_fd < 0, "find_results_map",
76 "err %d\n", results_map_fd))
77 goto cleanup;
78
79 kprobe_link = bpf_program__attach_kprobe(kprobe_prog,
80 false /* retprobe */,
81 SYS_NANOSLEEP_KPROBE_NAME);
82 if (CHECK(IS_ERR(kprobe_link), "attach_kprobe",
83 "err %ld\n", PTR_ERR(kprobe_link))) {
84 kprobe_link = NULL;
85 goto cleanup;
86 }
87 kretprobe_link = bpf_program__attach_kprobe(kretprobe_prog,
88 true /* retprobe */,
89 SYS_NANOSLEEP_KPROBE_NAME);
90 if (CHECK(IS_ERR(kretprobe_link), "attach_kretprobe",
91 "err %ld\n", PTR_ERR(kretprobe_link))) {
92 kretprobe_link = NULL;
93 goto cleanup;
94 }
95 uprobe_link = bpf_program__attach_uprobe(uprobe_prog,
96 false /* retprobe */,
97 0 /* self pid */,
98 "/proc/self/exe",
99 uprobe_offset);
100 if (CHECK(IS_ERR(uprobe_link), "attach_uprobe",
101 "err %ld\n", PTR_ERR(uprobe_link))) {
102 uprobe_link = NULL;
103 goto cleanup;
104 }
105 uretprobe_link = bpf_program__attach_uprobe(uretprobe_prog,
106 true /* retprobe */,
107 -1 /* any pid */,
108 "/proc/self/exe",
109 uprobe_offset);
110 if (CHECK(IS_ERR(uretprobe_link), "attach_uretprobe",
111 "err %ld\n", PTR_ERR(uretprobe_link))) {
112 uretprobe_link = NULL;
113 goto cleanup;
114 }
115
116 /* trigger & validate kprobe && kretprobe */
117 usleep(1);
118
119 err = bpf_map_lookup_elem(results_map_fd, &kprobe_idx, &res);
120 if (CHECK(err, "get_kprobe_res",
121 "failed to get kprobe res: %d\n", err))
122 goto cleanup;
123 if (CHECK(res != kprobe_idx + 1, "check_kprobe_res",
124 "wrong kprobe res: %d\n", res))
125 goto cleanup;
126
127 err = bpf_map_lookup_elem(results_map_fd, &kretprobe_idx, &res);
128 if (CHECK(err, "get_kretprobe_res",
129 "failed to get kretprobe res: %d\n", err))
130 goto cleanup;
131 if (CHECK(res != kretprobe_idx + 1, "check_kretprobe_res",
132 "wrong kretprobe res: %d\n", res))
133 goto cleanup;
134
135 /* trigger & validate uprobe & uretprobe */
136 get_base_addr();
137
138 err = bpf_map_lookup_elem(results_map_fd, &uprobe_idx, &res);
139 if (CHECK(err, "get_uprobe_res",
140 "failed to get uprobe res: %d\n", err))
141 goto cleanup;
142 if (CHECK(res != uprobe_idx + 1, "check_uprobe_res",
143 "wrong uprobe res: %d\n", res))
144 goto cleanup;
145
146 err = bpf_map_lookup_elem(results_map_fd, &uretprobe_idx, &res);
147 if (CHECK(err, "get_uretprobe_res",
148 "failed to get uretprobe res: %d\n", err))
149 goto cleanup;
150 if (CHECK(res != uretprobe_idx + 1, "check_uretprobe_res",
151 "wrong uretprobe res: %d\n", res))
152 goto cleanup;
153
154cleanup:
155 bpf_link__destroy(kprobe_link);
156 bpf_link__destroy(kretprobe_link);
157 bpf_link__destroy(uprobe_link);
158 bpf_link__destroy(uretprobe_link);
159 bpf_object__close(obj);
160}
1// SPDX-License-Identifier: GPL-2.0
2#include <test_progs.h>
3#include "test_attach_probe.skel.h"
4
5#if defined(__powerpc64__) && defined(_CALL_ELF) && _CALL_ELF == 2
6
7#define OP_RT_RA_MASK 0xffff0000UL
8#define LIS_R2 0x3c400000UL
9#define ADDIS_R2_R12 0x3c4c0000UL
10#define ADDI_R2_R2 0x38420000UL
11
12static ssize_t get_offset(ssize_t addr, ssize_t base)
13{
14 u32 *insn = (u32 *) addr;
15
16 /*
17 * A PPC64 ABIv2 function may have a local and a global entry
18 * point. We need to use the local entry point when patching
19 * functions, so identify and step over the global entry point
20 * sequence.
21 *
22 * The global entry point sequence is always of the form:
23 *
24 * addis r2,r12,XXXX
25 * addi r2,r2,XXXX
26 *
27 * A linker optimisation may convert the addis to lis:
28 *
29 * lis r2,XXXX
30 * addi r2,r2,XXXX
31 */
32 if ((((*insn & OP_RT_RA_MASK) == ADDIS_R2_R12) ||
33 ((*insn & OP_RT_RA_MASK) == LIS_R2)) &&
34 ((*(insn + 1) & OP_RT_RA_MASK) == ADDI_R2_R2))
35 return (ssize_t)(insn + 2) - base;
36 else
37 return addr - base;
38}
39#else
40#define get_offset(addr, base) (addr - base)
41#endif
42
43ssize_t get_base_addr() {
44 size_t start, offset;
45 char buf[256];
46 FILE *f;
47
48 f = fopen("/proc/self/maps", "r");
49 if (!f)
50 return -errno;
51
52 while (fscanf(f, "%zx-%*x %s %zx %*[^\n]\n",
53 &start, buf, &offset) == 3) {
54 if (strcmp(buf, "r-xp") == 0) {
55 fclose(f);
56 return start - offset;
57 }
58 }
59
60 fclose(f);
61 return -EINVAL;
62}
63
64void test_attach_probe(void)
65{
66 int duration = 0;
67 struct bpf_link *kprobe_link, *kretprobe_link;
68 struct bpf_link *uprobe_link, *uretprobe_link;
69 struct test_attach_probe* skel;
70 size_t uprobe_offset;
71 ssize_t base_addr;
72
73 base_addr = get_base_addr();
74 if (CHECK(base_addr < 0, "get_base_addr",
75 "failed to find base addr: %zd", base_addr))
76 return;
77 uprobe_offset = get_offset((size_t)&get_base_addr, base_addr);
78
79 skel = test_attach_probe__open_and_load();
80 if (CHECK(!skel, "skel_open", "failed to open skeleton\n"))
81 return;
82 if (CHECK(!skel->bss, "check_bss", ".bss wasn't mmap()-ed\n"))
83 goto cleanup;
84
85 kprobe_link = bpf_program__attach_kprobe(skel->progs.handle_kprobe,
86 false /* retprobe */,
87 SYS_NANOSLEEP_KPROBE_NAME);
88 if (!ASSERT_OK_PTR(kprobe_link, "attach_kprobe"))
89 goto cleanup;
90 skel->links.handle_kprobe = kprobe_link;
91
92 kretprobe_link = bpf_program__attach_kprobe(skel->progs.handle_kretprobe,
93 true /* retprobe */,
94 SYS_NANOSLEEP_KPROBE_NAME);
95 if (!ASSERT_OK_PTR(kretprobe_link, "attach_kretprobe"))
96 goto cleanup;
97 skel->links.handle_kretprobe = kretprobe_link;
98
99 uprobe_link = bpf_program__attach_uprobe(skel->progs.handle_uprobe,
100 false /* retprobe */,
101 0 /* self pid */,
102 "/proc/self/exe",
103 uprobe_offset);
104 if (!ASSERT_OK_PTR(uprobe_link, "attach_uprobe"))
105 goto cleanup;
106 skel->links.handle_uprobe = uprobe_link;
107
108 uretprobe_link = bpf_program__attach_uprobe(skel->progs.handle_uretprobe,
109 true /* retprobe */,
110 -1 /* any pid */,
111 "/proc/self/exe",
112 uprobe_offset);
113 if (!ASSERT_OK_PTR(uretprobe_link, "attach_uretprobe"))
114 goto cleanup;
115 skel->links.handle_uretprobe = uretprobe_link;
116
117 /* trigger & validate kprobe && kretprobe */
118 usleep(1);
119
120 if (CHECK(skel->bss->kprobe_res != 1, "check_kprobe_res",
121 "wrong kprobe res: %d\n", skel->bss->kprobe_res))
122 goto cleanup;
123 if (CHECK(skel->bss->kretprobe_res != 2, "check_kretprobe_res",
124 "wrong kretprobe res: %d\n", skel->bss->kretprobe_res))
125 goto cleanup;
126
127 /* trigger & validate uprobe & uretprobe */
128 get_base_addr();
129
130 if (CHECK(skel->bss->uprobe_res != 3, "check_uprobe_res",
131 "wrong uprobe res: %d\n", skel->bss->uprobe_res))
132 goto cleanup;
133 if (CHECK(skel->bss->uretprobe_res != 4, "check_uretprobe_res",
134 "wrong uretprobe res: %d\n", skel->bss->uretprobe_res))
135 goto cleanup;
136
137cleanup:
138 test_attach_probe__destroy(skel);
139}