1 // SPDX-License-Identifier: (LGPL-2.1 OR BSD-2-Clause)
2 /*
3 * Ring buffer operations.
4 *
5 * Copyright (C) 2020 Facebook, Inc.
6 */
7 #ifndef _GNU_SOURCE
8 #define _GNU_SOURCE
9 #endif
10 #include <stdlib.h>
11 #include <stdio.h>
12 #include <errno.h>
13 #include <unistd.h>
14 #include <linux/err.h>
15 #include <linux/bpf.h>
16 #include <asm/barrier.h>
17 #include <sys/mman.h>
18 #include <sys/epoll.h>
19
20 #include "libbpf.h"
21 #include "libbpf_internal.h"
22 #include "bpf.h"
23
24 struct ring {
25 ring_buffer_sample_fn sample_cb;
26 void *ctx;
27 void *data;
28 unsigned long *consumer_pos;
29 unsigned long *producer_pos;
30 unsigned long mask;
31 int map_fd;
32 };
33
34 struct ring_buffer {
35 struct epoll_event *events;
36 struct ring *rings;
37 size_t page_size;
38 int epoll_fd;
39 int ring_cnt;
40 };
41
ringbuf_unmap_ring(struct ring_buffer * rb,struct ring * r)42 static void ringbuf_unmap_ring(struct ring_buffer *rb, struct ring *r)
43 {
44 if (r->consumer_pos) {
45 munmap(r->consumer_pos, rb->page_size);
46 r->consumer_pos = NULL;
47 }
48 if (r->producer_pos) {
49 munmap(r->producer_pos, rb->page_size + 2 * (r->mask + 1));
50 r->producer_pos = NULL;
51 }
52 }
53
54 /* Add extra RINGBUF maps to this ring buffer manager */
ring_buffer__add(struct ring_buffer * rb,int map_fd,ring_buffer_sample_fn sample_cb,void * ctx)55 int ring_buffer__add(struct ring_buffer *rb, int map_fd,
56 ring_buffer_sample_fn sample_cb, void *ctx)
57 {
58 struct bpf_map_info info;
59 __u32 len = sizeof(info);
60 struct epoll_event *e;
61 struct ring *r;
62 void *tmp;
63 int err;
64
65 memset(&info, 0, sizeof(info));
66
67 err = bpf_obj_get_info_by_fd(map_fd, &info, &len);
68 if (err) {
69 err = -errno;
70 pr_warn("ringbuf: failed to get map info for fd=%d: %d\n",
71 map_fd, err);
72 return err;
73 }
74
75 if (info.type != BPF_MAP_TYPE_RINGBUF) {
76 pr_warn("ringbuf: map fd=%d is not BPF_MAP_TYPE_RINGBUF\n",
77 map_fd);
78 return -EINVAL;
79 }
80
81 tmp = libbpf_reallocarray(rb->rings, rb->ring_cnt + 1, sizeof(*rb->rings));
82 if (!tmp)
83 return -ENOMEM;
84 rb->rings = tmp;
85
86 tmp = libbpf_reallocarray(rb->events, rb->ring_cnt + 1, sizeof(*rb->events));
87 if (!tmp)
88 return -ENOMEM;
89 rb->events = tmp;
90
91 r = &rb->rings[rb->ring_cnt];
92 memset(r, 0, sizeof(*r));
93
94 r->map_fd = map_fd;
95 r->sample_cb = sample_cb;
96 r->ctx = ctx;
97 r->mask = info.max_entries - 1;
98
99 /* Map writable consumer page */
100 tmp = mmap(NULL, rb->page_size, PROT_READ | PROT_WRITE, MAP_SHARED,
101 map_fd, 0);
102 if (tmp == MAP_FAILED) {
103 err = -errno;
104 pr_warn("ringbuf: failed to mmap consumer page for map fd=%d: %d\n",
105 map_fd, err);
106 return err;
107 }
108 r->consumer_pos = tmp;
109
110 /* Map read-only producer page and data pages. We map twice as big
111 * data size to allow simple reading of samples that wrap around the
112 * end of a ring buffer. See kernel implementation for details.
113 * */
114 tmp = mmap(NULL, rb->page_size + 2 * info.max_entries, PROT_READ,
115 MAP_SHARED, map_fd, rb->page_size);
116 if (tmp == MAP_FAILED) {
117 err = -errno;
118 ringbuf_unmap_ring(rb, r);
119 pr_warn("ringbuf: failed to mmap data pages for map fd=%d: %d\n",
120 map_fd, err);
121 return err;
122 }
123 r->producer_pos = tmp;
124 r->data = tmp + rb->page_size;
125
126 e = &rb->events[rb->ring_cnt];
127 memset(e, 0, sizeof(*e));
128
129 e->events = EPOLLIN;
130 e->data.fd = rb->ring_cnt;
131 if (epoll_ctl(rb->epoll_fd, EPOLL_CTL_ADD, map_fd, e) < 0) {
132 err = -errno;
133 ringbuf_unmap_ring(rb, r);
134 pr_warn("ringbuf: failed to epoll add map fd=%d: %d\n",
135 map_fd, err);
136 return err;
137 }
138
139 rb->ring_cnt++;
140 return 0;
141 }
142
ring_buffer__free(struct ring_buffer * rb)143 void ring_buffer__free(struct ring_buffer *rb)
144 {
145 int i;
146
147 if (!rb)
148 return;
149
150 for (i = 0; i < rb->ring_cnt; ++i)
151 ringbuf_unmap_ring(rb, &rb->rings[i]);
152 if (rb->epoll_fd >= 0)
153 close(rb->epoll_fd);
154
155 free(rb->events);
156 free(rb->rings);
157 free(rb);
158 }
159
160 struct ring_buffer *
ring_buffer__new(int map_fd,ring_buffer_sample_fn sample_cb,void * ctx,const struct ring_buffer_opts * opts)161 ring_buffer__new(int map_fd, ring_buffer_sample_fn sample_cb, void *ctx,
162 const struct ring_buffer_opts *opts)
163 {
164 struct ring_buffer *rb;
165 int err;
166
167 if (!OPTS_VALID(opts, ring_buffer_opts))
168 return NULL;
169
170 rb = calloc(1, sizeof(*rb));
171 if (!rb)
172 return NULL;
173
174 rb->page_size = getpagesize();
175
176 rb->epoll_fd = epoll_create1(EPOLL_CLOEXEC);
177 if (rb->epoll_fd < 0) {
178 err = -errno;
179 pr_warn("ringbuf: failed to create epoll instance: %d\n", err);
180 goto err_out;
181 }
182
183 err = ring_buffer__add(rb, map_fd, sample_cb, ctx);
184 if (err)
185 goto err_out;
186
187 return rb;
188
189 err_out:
190 ring_buffer__free(rb);
191 return NULL;
192 }
193
roundup_len(__u32 len)194 static inline int roundup_len(__u32 len)
195 {
196 /* clear out top 2 bits (discard and busy, if set) */
197 len <<= 2;
198 len >>= 2;
199 /* add length prefix */
200 len += BPF_RINGBUF_HDR_SZ;
201 /* round up to 8 byte alignment */
202 return (len + 7) / 8 * 8;
203 }
204
ringbuf_process_ring(struct ring * r)205 static int ringbuf_process_ring(struct ring* r)
206 {
207 int *len_ptr, len, err, cnt = 0;
208 unsigned long cons_pos, prod_pos;
209 bool got_new_data;
210 void *sample;
211
212 cons_pos = smp_load_acquire(r->consumer_pos);
213 do {
214 got_new_data = false;
215 prod_pos = smp_load_acquire(r->producer_pos);
216 while (cons_pos < prod_pos) {
217 len_ptr = r->data + (cons_pos & r->mask);
218 len = smp_load_acquire(len_ptr);
219
220 /* sample not committed yet, bail out for now */
221 if (len & BPF_RINGBUF_BUSY_BIT)
222 goto done;
223
224 got_new_data = true;
225 cons_pos += roundup_len(len);
226
227 if ((len & BPF_RINGBUF_DISCARD_BIT) == 0) {
228 sample = (void *)len_ptr + BPF_RINGBUF_HDR_SZ;
229 err = r->sample_cb(r->ctx, sample, len);
230 if (err) {
231 /* update consumer pos and bail out */
232 smp_store_release(r->consumer_pos,
233 cons_pos);
234 return err;
235 }
236 cnt++;
237 }
238
239 smp_store_release(r->consumer_pos, cons_pos);
240 }
241 } while (got_new_data);
242 done:
243 return cnt;
244 }
245
246 /* Consume available ring buffer(s) data without event polling.
247 * Returns number of records consumed across all registered ring buffers, or
248 * negative number if any of the callbacks return error.
249 */
ring_buffer__consume(struct ring_buffer * rb)250 int ring_buffer__consume(struct ring_buffer *rb)
251 {
252 int i, err, res = 0;
253
254 for (i = 0; i < rb->ring_cnt; i++) {
255 struct ring *ring = &rb->rings[i];
256
257 err = ringbuf_process_ring(ring);
258 if (err < 0)
259 return err;
260 res += err;
261 }
262 return res;
263 }
264
265 /* Poll for available data and consume records, if any are available.
266 * Returns number of records consumed, or negative number, if any of the
267 * registered callbacks returned error.
268 */
ring_buffer__poll(struct ring_buffer * rb,int timeout_ms)269 int ring_buffer__poll(struct ring_buffer *rb, int timeout_ms)
270 {
271 int i, cnt, err, res = 0;
272
273 cnt = epoll_wait(rb->epoll_fd, rb->events, rb->ring_cnt, timeout_ms);
274 for (i = 0; i < cnt; i++) {
275 __u32 ring_id = rb->events[i].data.fd;
276 struct ring *ring = &rb->rings[ring_id];
277
278 err = ringbuf_process_ring(ring);
279 if (err < 0)
280 return err;
281 res += err;
282 }
283 return cnt < 0 ? -errno : res;
284 }
285
