]> git.proxmox.com Git - mirror_iproute2.git/blame - lib/bpf.c
bpf: expose bpf_parse_common() and bpf_load_common()
[mirror_iproute2.git] / lib / bpf.c
CommitLineData
1d129d19 1/*
e4225669 2 * bpf.c BPF common code
1d129d19
JP
3 *
4 * This program is free software; you can distribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
e4225669 9 * Authors: Daniel Borkmann <daniel@iogearbox.net>
1d129d19 10 * Jiri Pirko <jiri@resnulli.us>
e4225669 11 * Alexei Starovoitov <ast@kernel.org>
1d129d19
JP
12 */
13
14#include <stdio.h>
15#include <stdlib.h>
16#include <unistd.h>
17#include <string.h>
18#include <stdbool.h>
473d7840 19#include <stdint.h>
1d129d19 20#include <errno.h>
11c39b5e
DB
21#include <fcntl.h>
22#include <stdarg.h>
5c5a0f3d 23#include <limits.h>
e4225669 24#include <assert.h>
1d129d19 25
11c39b5e
DB
26#ifdef HAVE_ELF
27#include <libelf.h>
28#include <gelf.h>
29#endif
30
32e93fb7
DB
31#include <sys/types.h>
32#include <sys/stat.h>
33#include <sys/un.h>
34#include <sys/vfs.h>
35#include <sys/mount.h>
36#include <sys/syscall.h>
37#include <sys/sendfile.h>
38#include <sys/resource.h>
39
8187b012
DB
40#include <arpa/inet.h>
41
1d129d19 42#include "utils.h"
bc2d4d83 43#include "json_print.h"
6256f8c9 44
e4225669 45#include "bpf_util.h"
6256f8c9
DB
46#include "bpf_elf.h"
47#include "bpf_scm.h"
48
e4225669
DB
49struct bpf_prog_meta {
50 const char *type;
51 const char *subdir;
52 const char *section;
53 bool may_uds_export;
54};
1d129d19 55
e4225669
DB
56static const enum bpf_prog_type __bpf_types[] = {
57 BPF_PROG_TYPE_SCHED_CLS,
58 BPF_PROG_TYPE_SCHED_ACT,
c7272ca7 59 BPF_PROG_TYPE_XDP,
b15f440e
TG
60 BPF_PROG_TYPE_LWT_IN,
61 BPF_PROG_TYPE_LWT_OUT,
62 BPF_PROG_TYPE_LWT_XMIT,
e4225669 63};
67584e3a 64
e4225669
DB
65static const struct bpf_prog_meta __bpf_prog_meta[] = {
66 [BPF_PROG_TYPE_SCHED_CLS] = {
67 .type = "cls",
68 .subdir = "tc",
69 .section = ELF_SECTION_CLASSIFIER,
70 .may_uds_export = true,
71 },
72 [BPF_PROG_TYPE_SCHED_ACT] = {
73 .type = "act",
74 .subdir = "tc",
75 .section = ELF_SECTION_ACTION,
76 .may_uds_export = true,
77 },
c7272ca7
DB
78 [BPF_PROG_TYPE_XDP] = {
79 .type = "xdp",
80 .subdir = "xdp",
81 .section = ELF_SECTION_PROG,
82 },
b15f440e
TG
83 [BPF_PROG_TYPE_LWT_IN] = {
84 .type = "lwt_in",
85 .subdir = "ip",
86 .section = ELF_SECTION_PROG,
87 },
88 [BPF_PROG_TYPE_LWT_OUT] = {
89 .type = "lwt_out",
90 .subdir = "ip",
91 .section = ELF_SECTION_PROG,
92 },
93 [BPF_PROG_TYPE_LWT_XMIT] = {
94 .type = "lwt_xmit",
95 .subdir = "ip",
96 .section = ELF_SECTION_PROG,
97 },
e4225669
DB
98};
99
100static const char *bpf_prog_to_subdir(enum bpf_prog_type type)
101{
102 assert(type < ARRAY_SIZE(__bpf_prog_meta) &&
103 __bpf_prog_meta[type].subdir);
104 return __bpf_prog_meta[type].subdir;
105}
106
107const char *bpf_prog_to_default_section(enum bpf_prog_type type)
108{
109 assert(type < ARRAY_SIZE(__bpf_prog_meta) &&
110 __bpf_prog_meta[type].section);
111 return __bpf_prog_meta[type].section;
112}
e77fa41d 113
32e93fb7
DB
114#ifdef HAVE_ELF
115static int bpf_obj_open(const char *path, enum bpf_prog_type type,
116 const char *sec, bool verbose);
117#else
118static int bpf_obj_open(const char *path, enum bpf_prog_type type,
119 const char *sec, bool verbose)
120{
121 fprintf(stderr, "No ELF library support compiled in.\n");
122 errno = ENOSYS;
123 return -1;
124}
125#endif
126
127static inline __u64 bpf_ptr_to_u64(const void *ptr)
128{
129 return (__u64)(unsigned long)ptr;
130}
131
132static int bpf(int cmd, union bpf_attr *attr, unsigned int size)
133{
134#ifdef __NR_bpf
135 return syscall(__NR_bpf, cmd, attr, size);
136#else
137 fprintf(stderr, "No bpf syscall, kernel headers too old?\n");
138 errno = ENOSYS;
139 return -1;
140#endif
141}
142
91d88eeb
DB
143static int bpf_map_update(int fd, const void *key, const void *value,
144 uint64_t flags)
32e93fb7 145{
d17b136f 146 union bpf_attr attr = {};
67584e3a 147
67584e3a
ND
148 attr.map_fd = fd;
149 attr.key = bpf_ptr_to_u64(key);
150 attr.value = bpf_ptr_to_u64(value);
151 attr.flags = flags;
32e93fb7 152
91d88eeb 153 return bpf(BPF_MAP_UPDATE_ELEM, &attr, sizeof(attr));
32e93fb7
DB
154}
155
779525cd
DB
156static int bpf_prog_fd_by_id(uint32_t id)
157{
158 union bpf_attr attr = {};
159
160 attr.prog_id = id;
161
162 return bpf(BPF_PROG_GET_FD_BY_ID, &attr, sizeof(attr));
163}
164
165static int bpf_prog_info_by_fd(int fd, struct bpf_prog_info *info,
166 uint32_t *info_len)
167{
168 union bpf_attr attr = {};
169 int ret;
170
171 attr.info.bpf_fd = fd;
172 attr.info.info = bpf_ptr_to_u64(info);
173 attr.info.info_len = *info_len;
174
175 *info_len = 0;
176 ret = bpf(BPF_OBJ_GET_INFO_BY_FD, &attr, sizeof(attr));
177 if (!ret)
178 *info_len = attr.info.info_len;
179
180 return ret;
181}
182
a0b5b7cf 183int bpf_dump_prog_info(FILE *f, uint32_t id)
779525cd
DB
184{
185 struct bpf_prog_info info = {};
186 uint32_t len = sizeof(info);
a0b5b7cf
DB
187 int fd, ret, dump_ok = 0;
188 SPRINT_BUF(tmp);
779525cd 189
bc2d4d83
DB
190 open_json_object("prog");
191 print_uint(PRINT_ANY, "id", "id %u ", id);
779525cd
DB
192
193 fd = bpf_prog_fd_by_id(id);
194 if (fd < 0)
bc2d4d83 195 goto out;
779525cd
DB
196
197 ret = bpf_prog_info_by_fd(fd, &info, &len);
198 if (!ret && len) {
bc2d4d83
DB
199 int jited = !!info.jited_prog_len;
200
201 print_string(PRINT_ANY, "tag", "tag %s ",
202 hexstring_n2a(info.tag, sizeof(info.tag),
203 tmp, sizeof(tmp)));
204 print_uint(PRINT_JSON, "jited", NULL, jited);
205 if (jited && !is_json_context())
779525cd 206 fprintf(f, "jited ");
a0b5b7cf 207 dump_ok = 1;
779525cd
DB
208 }
209
210 close(fd);
bc2d4d83
DB
211out:
212 close_json_object();
a0b5b7cf 213 return dump_ok;
779525cd
DB
214}
215
32e93fb7
DB
216static int bpf_parse_string(char *arg, bool from_file, __u16 *bpf_len,
217 char **bpf_string, bool *need_release,
218 const char separator)
1d129d19
JP
219{
220 char sp;
221
222 if (from_file) {
223 size_t tmp_len, op_len = sizeof("65535 255 255 4294967295,");
7c87c7fe 224 char *tmp_string, *pos, c_prev = ' ';
1d129d19 225 FILE *fp;
7c87c7fe 226 int c;
1d129d19
JP
227
228 tmp_len = sizeof("4096,") + BPF_MAXINSNS * op_len;
3da3ebfc 229 tmp_string = pos = calloc(1, tmp_len);
1d129d19
JP
230 if (tmp_string == NULL)
231 return -ENOMEM;
232
1d129d19
JP
233 fp = fopen(arg, "r");
234 if (fp == NULL) {
235 perror("Cannot fopen");
236 free(tmp_string);
237 return -ENOENT;
238 }
239
3da3ebfc
PS
240 while ((c = fgetc(fp)) != EOF) {
241 switch (c) {
242 case '\n':
243 if (c_prev != ',')
244 *(pos++) = ',';
7c87c7fe 245 c_prev = ',';
3da3ebfc
PS
246 break;
247 case ' ':
248 case '\t':
249 if (c_prev != ' ')
250 *(pos++) = c;
7c87c7fe 251 c_prev = ' ';
3da3ebfc
PS
252 break;
253 default:
254 *(pos++) = c;
7c87c7fe 255 c_prev = c;
3da3ebfc
PS
256 }
257 if (pos - tmp_string == tmp_len)
258 break;
3da3ebfc
PS
259 }
260
261 if (!feof(fp)) {
1d129d19
JP
262 free(tmp_string);
263 fclose(fp);
3da3ebfc 264 return -E2BIG;
1d129d19
JP
265 }
266
267 fclose(fp);
3da3ebfc 268 *pos = 0;
e4225669 269
1d129d19
JP
270 *need_release = true;
271 *bpf_string = tmp_string;
272 } else {
273 *need_release = false;
274 *bpf_string = arg;
275 }
276
277 if (sscanf(*bpf_string, "%hu%c", bpf_len, &sp) != 2 ||
278 sp != separator) {
279 if (*need_release)
280 free(*bpf_string);
281 return -EINVAL;
282 }
283
284 return 0;
285}
286
32e93fb7
DB
287static int bpf_ops_parse(int argc, char **argv, struct sock_filter *bpf_ops,
288 bool from_file)
1d129d19
JP
289{
290 char *bpf_string, *token, separator = ',';
291 int ret = 0, i = 0;
292 bool need_release;
293 __u16 bpf_len = 0;
294
295 if (argc < 1)
296 return -EINVAL;
297 if (bpf_parse_string(argv[0], from_file, &bpf_len, &bpf_string,
298 &need_release, separator))
299 return -EINVAL;
300 if (bpf_len == 0 || bpf_len > BPF_MAXINSNS) {
301 ret = -EINVAL;
302 goto out;
303 }
304
305 token = bpf_string;
306 while ((token = strchr(token, separator)) && (++token)[0]) {
307 if (i >= bpf_len) {
32a121cb 308 fprintf(stderr, "Real program length exceeds encoded length parameter!\n");
1d129d19
JP
309 ret = -EINVAL;
310 goto out;
311 }
312
313 if (sscanf(token, "%hu %hhu %hhu %u,",
314 &bpf_ops[i].code, &bpf_ops[i].jt,
315 &bpf_ops[i].jf, &bpf_ops[i].k) != 4) {
316 fprintf(stderr, "Error at instruction %d!\n", i);
317 ret = -EINVAL;
318 goto out;
319 }
320
321 i++;
322 }
323
324 if (i != bpf_len) {
afc1a200 325 fprintf(stderr, "Parsed program length is less than encoded length parameter!\n");
1d129d19
JP
326 ret = -EINVAL;
327 goto out;
328 }
329 ret = bpf_len;
1d129d19
JP
330out:
331 if (need_release)
332 free(bpf_string);
333
334 return ret;
335}
336
337void bpf_print_ops(FILE *f, struct rtattr *bpf_ops, __u16 len)
338{
d896797c 339 struct sock_filter *ops = RTA_DATA(bpf_ops);
1d129d19
JP
340 int i;
341
342 if (len == 0)
343 return;
344
345 fprintf(f, "bytecode \'%u,", len);
346
347 for (i = 0; i < len - 1; i++)
348 fprintf(f, "%hu %hhu %hhu %u,", ops[i].code, ops[i].jt,
349 ops[i].jf, ops[i].k);
350
6256f8c9 351 fprintf(f, "%hu %hhu %hhu %u\'", ops[i].code, ops[i].jt,
1d129d19
JP
352 ops[i].jf, ops[i].k);
353}
11c39b5e 354
afc1a200
DB
355static void bpf_map_pin_report(const struct bpf_elf_map *pin,
356 const struct bpf_elf_map *obj)
357{
358 fprintf(stderr, "Map specification differs from pinned file!\n");
359
360 if (obj->type != pin->type)
361 fprintf(stderr, " - Type: %u (obj) != %u (pin)\n",
362 obj->type, pin->type);
363 if (obj->size_key != pin->size_key)
364 fprintf(stderr, " - Size key: %u (obj) != %u (pin)\n",
365 obj->size_key, pin->size_key);
366 if (obj->size_value != pin->size_value)
367 fprintf(stderr, " - Size value: %u (obj) != %u (pin)\n",
368 obj->size_value, pin->size_value);
369 if (obj->max_elem != pin->max_elem)
370 fprintf(stderr, " - Max elems: %u (obj) != %u (pin)\n",
371 obj->max_elem, pin->max_elem);
4dd3f50a
DB
372 if (obj->flags != pin->flags)
373 fprintf(stderr, " - Flags: %#x (obj) != %#x (pin)\n",
374 obj->flags, pin->flags);
afc1a200
DB
375
376 fprintf(stderr, "\n");
377}
378
ecb05c0f
DB
379struct bpf_prog_data {
380 unsigned int type;
381 unsigned int jited;
382};
383
384struct bpf_map_ext {
385 struct bpf_prog_data owner;
386};
387
388static int bpf_derive_elf_map_from_fdinfo(int fd, struct bpf_elf_map *map,
389 struct bpf_map_ext *ext)
9e607f2e 390{
ecb05c0f 391 unsigned int val, owner_type = 0, owner_jited = 0;
9e607f2e 392 char file[PATH_MAX], buff[4096];
9e607f2e
DB
393 FILE *fp;
394
395 snprintf(file, sizeof(file), "/proc/%d/fdinfo/%d", getpid(), fd);
ecb05c0f 396 memset(map, 0, sizeof(*map));
9e607f2e
DB
397
398 fp = fopen(file, "r");
399 if (!fp) {
400 fprintf(stderr, "No procfs support?!\n");
401 return -EIO;
402 }
403
9e607f2e
DB
404 while (fgets(buff, sizeof(buff), fp)) {
405 if (sscanf(buff, "map_type:\t%u", &val) == 1)
ecb05c0f 406 map->type = val;
9e607f2e 407 else if (sscanf(buff, "key_size:\t%u", &val) == 1)
ecb05c0f 408 map->size_key = val;
9e607f2e 409 else if (sscanf(buff, "value_size:\t%u", &val) == 1)
ecb05c0f 410 map->size_value = val;
9e607f2e 411 else if (sscanf(buff, "max_entries:\t%u", &val) == 1)
ecb05c0f 412 map->max_elem = val;
4dd3f50a 413 else if (sscanf(buff, "map_flags:\t%i", &val) == 1)
ecb05c0f 414 map->flags = val;
fb24802b
DB
415 else if (sscanf(buff, "owner_prog_type:\t%i", &val) == 1)
416 owner_type = val;
ecb05c0f
DB
417 else if (sscanf(buff, "owner_jited:\t%i", &val) == 1)
418 owner_jited = val;
9e607f2e
DB
419 }
420
421 fclose(fp);
ecb05c0f
DB
422 if (ext) {
423 memset(ext, 0, sizeof(*ext));
424 ext->owner.type = owner_type;
425 ext->owner.jited = owner_jited;
426 }
427
428 return 0;
429}
430
431static int bpf_map_selfcheck_pinned(int fd, const struct bpf_elf_map *map,
432 struct bpf_map_ext *ext, int length,
433 enum bpf_prog_type type)
434{
435 struct bpf_elf_map tmp, zero = {};
436 int ret;
437
438 ret = bpf_derive_elf_map_from_fdinfo(fd, &tmp, ext);
439 if (ret < 0)
440 return ret;
9e607f2e 441
fb24802b
DB
442 /* The decision to reject this is on kernel side eventually, but
443 * at least give the user a chance to know what's wrong.
444 */
ecb05c0f 445 if (ext->owner.type && ext->owner.type != type)
fb24802b 446 fprintf(stderr, "Program array map owner types differ: %u (obj) != %u (pin)\n",
ecb05c0f 447 type, ext->owner.type);
fb24802b 448
91d88eeb 449 if (!memcmp(&tmp, map, length)) {
9e607f2e
DB
450 return 0;
451 } else {
9e607f2e
DB
452 /* If kernel doesn't have eBPF-related fdinfo, we cannot do much,
453 * so just accept it. We know we do have an eBPF fd and in this
454 * case, everything is 0. It is guaranteed that no such map exists
455 * since map type of 0 is unloadable BPF_MAP_TYPE_UNSPEC.
456 */
91d88eeb 457 if (!memcmp(&tmp, &zero, length))
9e607f2e
DB
458 return 0;
459
afc1a200 460 bpf_map_pin_report(&tmp, map);
9e607f2e
DB
461 return -EINVAL;
462 }
463}
464
91d88eeb
DB
465static int bpf_mnt_fs(const char *target)
466{
467 bool bind_done = false;
468
469 while (mount("", target, "none", MS_PRIVATE | MS_REC, NULL)) {
470 if (errno != EINVAL || bind_done) {
471 fprintf(stderr, "mount --make-private %s failed: %s\n",
472 target, strerror(errno));
473 return -1;
474 }
475
476 if (mount(target, target, "none", MS_BIND, NULL)) {
477 fprintf(stderr, "mount --bind %s %s failed: %s\n",
478 target, target, strerror(errno));
479 return -1;
480 }
481
482 bind_done = true;
483 }
484
e4225669 485 if (mount("bpf", target, "bpf", 0, "mode=0700")) {
91d88eeb
DB
486 fprintf(stderr, "mount -t bpf bpf %s failed: %s\n",
487 target, strerror(errno));
488 return -1;
489 }
490
491 return 0;
492}
493
95ae9a48
DB
494static int bpf_mnt_check_target(const char *target)
495{
496 struct stat sb = {};
497 int ret;
498
499 ret = stat(target, &sb);
500 if (ret) {
501 ret = mkdir(target, S_IRWXU);
502 if (ret) {
503 fprintf(stderr, "mkdir %s failed: %s\n", target,
504 strerror(errno));
505 return ret;
506 }
507 }
508
509 return 0;
510}
511
32e93fb7
DB
512static int bpf_valid_mntpt(const char *mnt, unsigned long magic)
513{
514 struct statfs st_fs;
515
516 if (statfs(mnt, &st_fs) < 0)
517 return -ENOENT;
518 if ((unsigned long)st_fs.f_type != magic)
519 return -ENOENT;
520
521 return 0;
522}
523
95ae9a48
DB
524static const char *bpf_find_mntpt_single(unsigned long magic, char *mnt,
525 int len, const char *mntpt)
526{
527 int ret;
528
529 ret = bpf_valid_mntpt(mntpt, magic);
530 if (!ret) {
18f156bf 531 strlcpy(mnt, mntpt, len);
95ae9a48
DB
532 return mnt;
533 }
534
535 return NULL;
536}
537
32e93fb7
DB
538static const char *bpf_find_mntpt(const char *fstype, unsigned long magic,
539 char *mnt, int len,
540 const char * const *known_mnts)
541{
542 const char * const *ptr;
543 char type[100];
544 FILE *fp;
545
546 if (known_mnts) {
547 ptr = known_mnts;
548 while (*ptr) {
95ae9a48 549 if (bpf_find_mntpt_single(magic, mnt, len, *ptr))
32e93fb7 550 return mnt;
32e93fb7
DB
551 ptr++;
552 }
553 }
554
c3724e4b
PS
555 if (len != PATH_MAX)
556 return NULL;
557
32e93fb7 558 fp = fopen("/proc/mounts", "r");
c3724e4b 559 if (fp == NULL)
32e93fb7
DB
560 return NULL;
561
562 while (fscanf(fp, "%*s %" textify(PATH_MAX) "s %99s %*s %*d %*d\n",
563 mnt, type) == 2) {
564 if (strcmp(type, fstype) == 0)
565 break;
566 }
567
568 fclose(fp);
569 if (strcmp(type, fstype) != 0)
570 return NULL;
571
572 return mnt;
573}
574
575int bpf_trace_pipe(void)
576{
577 char tracefs_mnt[PATH_MAX] = TRACE_DIR_MNT;
578 static const char * const tracefs_known_mnts[] = {
579 TRACE_DIR_MNT,
580 "/sys/kernel/debug/tracing",
581 "/tracing",
582 "/trace",
583 0,
584 };
1b736dc4 585 int fd_in, fd_out = STDERR_FILENO;
32e93fb7
DB
586 char tpipe[PATH_MAX];
587 const char *mnt;
32e93fb7
DB
588
589 mnt = bpf_find_mntpt("tracefs", TRACEFS_MAGIC, tracefs_mnt,
590 sizeof(tracefs_mnt), tracefs_known_mnts);
591 if (!mnt) {
592 fprintf(stderr, "tracefs not mounted?\n");
593 return -1;
594 }
595
596 snprintf(tpipe, sizeof(tpipe), "%s/trace_pipe", mnt);
597
1b736dc4
DB
598 fd_in = open(tpipe, O_RDONLY);
599 if (fd_in < 0)
32e93fb7
DB
600 return -1;
601
602 fprintf(stderr, "Running! Hang up with ^C!\n\n");
603 while (1) {
604 static char buff[4096];
605 ssize_t ret;
606
1b736dc4
DB
607 ret = read(fd_in, buff, sizeof(buff));
608 if (ret > 0 && write(fd_out, buff, ret) == ret)
609 continue;
610 break;
32e93fb7
DB
611 }
612
1b736dc4
DB
613 close(fd_in);
614 return -1;
32e93fb7
DB
615}
616
e4225669 617static int bpf_gen_global(const char *bpf_sub_dir)
91d88eeb 618{
e4225669
DB
619 char bpf_glo_dir[PATH_MAX];
620 int ret;
621
622 snprintf(bpf_glo_dir, sizeof(bpf_glo_dir), "%s/%s/",
623 bpf_sub_dir, BPF_DIR_GLOBALS);
624
625 ret = mkdir(bpf_glo_dir, S_IRWXU);
626 if (ret && errno != EEXIST) {
627 fprintf(stderr, "mkdir %s failed: %s\n", bpf_glo_dir,
628 strerror(errno));
629 return ret;
630 }
631
632 return 0;
633}
634
635static int bpf_gen_master(const char *base, const char *name)
636{
637 char bpf_sub_dir[PATH_MAX];
638 int ret;
639
640 snprintf(bpf_sub_dir, sizeof(bpf_sub_dir), "%s%s/", base, name);
641
642 ret = mkdir(bpf_sub_dir, S_IRWXU);
643 if (ret && errno != EEXIST) {
644 fprintf(stderr, "mkdir %s failed: %s\n", bpf_sub_dir,
645 strerror(errno));
646 return ret;
647 }
648
649 return bpf_gen_global(bpf_sub_dir);
650}
651
652static int bpf_slave_via_bind_mnt(const char *full_name,
653 const char *full_link)
654{
655 int ret;
656
657 ret = mkdir(full_name, S_IRWXU);
658 if (ret) {
659 assert(errno != EEXIST);
660 fprintf(stderr, "mkdir %s failed: %s\n", full_name,
661 strerror(errno));
662 return ret;
663 }
664
665 ret = mount(full_link, full_name, "none", MS_BIND, NULL);
666 if (ret) {
667 rmdir(full_name);
668 fprintf(stderr, "mount --bind %s %s failed: %s\n",
669 full_link, full_name, strerror(errno));
670 }
671
672 return ret;
673}
674
675static int bpf_gen_slave(const char *base, const char *name,
676 const char *link)
677{
678 char bpf_lnk_dir[PATH_MAX];
679 char bpf_sub_dir[PATH_MAX];
680 struct stat sb = {};
681 int ret;
682
683 snprintf(bpf_lnk_dir, sizeof(bpf_lnk_dir), "%s%s/", base, link);
684 snprintf(bpf_sub_dir, sizeof(bpf_sub_dir), "%s%s", base, name);
685
686 ret = symlink(bpf_lnk_dir, bpf_sub_dir);
687 if (ret) {
688 if (errno != EEXIST) {
689 if (errno != EPERM) {
690 fprintf(stderr, "symlink %s failed: %s\n",
691 bpf_sub_dir, strerror(errno));
692 return ret;
693 }
694
695 return bpf_slave_via_bind_mnt(bpf_sub_dir,
696 bpf_lnk_dir);
697 }
698
699 ret = lstat(bpf_sub_dir, &sb);
700 if (ret) {
701 fprintf(stderr, "lstat %s failed: %s\n",
702 bpf_sub_dir, strerror(errno));
703 return ret;
704 }
705
706 if ((sb.st_mode & S_IFMT) != S_IFLNK)
707 return bpf_gen_global(bpf_sub_dir);
708 }
709
710 return 0;
711}
712
713static int bpf_gen_hierarchy(const char *base)
714{
715 int ret, i;
716
717 ret = bpf_gen_master(base, bpf_prog_to_subdir(__bpf_types[0]));
718 for (i = 1; i < ARRAY_SIZE(__bpf_types) && !ret; i++)
719 ret = bpf_gen_slave(base,
720 bpf_prog_to_subdir(__bpf_types[i]),
721 bpf_prog_to_subdir(__bpf_types[0]));
722 return ret;
723}
724
725static const char *bpf_get_work_dir(enum bpf_prog_type type)
726{
727 static char bpf_tmp[PATH_MAX] = BPF_DIR_MNT;
728 static char bpf_wrk_dir[PATH_MAX];
91d88eeb 729 static const char *mnt;
e4225669 730 static bool bpf_mnt_cached;
95ae9a48 731 const char *mnt_env = getenv(BPF_ENV_MNT);
91d88eeb
DB
732 static const char * const bpf_known_mnts[] = {
733 BPF_DIR_MNT,
e4225669 734 "/bpf",
91d88eeb
DB
735 0,
736 };
91d88eeb
DB
737 int ret;
738
e4225669
DB
739 if (bpf_mnt_cached) {
740 const char *out = mnt;
741
51361a9f 742 if (out && type) {
e4225669
DB
743 snprintf(bpf_tmp, sizeof(bpf_tmp), "%s%s/",
744 out, bpf_prog_to_subdir(type));
745 out = bpf_tmp;
746 }
747 return out;
748 }
91d88eeb 749
95ae9a48
DB
750 if (mnt_env)
751 mnt = bpf_find_mntpt_single(BPF_FS_MAGIC, bpf_tmp,
752 sizeof(bpf_tmp), mnt_env);
753 else
754 mnt = bpf_find_mntpt("bpf", BPF_FS_MAGIC, bpf_tmp,
755 sizeof(bpf_tmp), bpf_known_mnts);
91d88eeb 756 if (!mnt) {
95ae9a48
DB
757 mnt = mnt_env ? : BPF_DIR_MNT;
758 ret = bpf_mnt_check_target(mnt);
759 if (!ret)
760 ret = bpf_mnt_fs(mnt);
91d88eeb
DB
761 if (ret) {
762 mnt = NULL;
763 goto out;
764 }
765 }
766
e4225669 767 snprintf(bpf_wrk_dir, sizeof(bpf_wrk_dir), "%s/", mnt);
91d88eeb 768
e4225669
DB
769 ret = bpf_gen_hierarchy(bpf_wrk_dir);
770 if (ret) {
91d88eeb
DB
771 mnt = NULL;
772 goto out;
773 }
774
e4225669 775 mnt = bpf_wrk_dir;
91d88eeb
DB
776out:
777 bpf_mnt_cached = true;
91d88eeb
DB
778 return mnt;
779}
780
e4225669 781static int bpf_obj_get(const char *pathname, enum bpf_prog_type type)
91d88eeb 782{
d17b136f 783 union bpf_attr attr = {};
91d88eeb
DB
784 char tmp[PATH_MAX];
785
786 if (strlen(pathname) > 2 && pathname[0] == 'm' &&
e4225669 787 pathname[1] == ':' && bpf_get_work_dir(type)) {
91d88eeb 788 snprintf(tmp, sizeof(tmp), "%s/%s",
e4225669 789 bpf_get_work_dir(type), pathname + 2);
91d88eeb
DB
790 pathname = tmp;
791 }
792
91d88eeb
DB
793 attr.pathname = bpf_ptr_to_u64(pathname);
794
795 return bpf(BPF_OBJ_GET, &attr, sizeof(attr));
796}
797
21856018
DB
798static int bpf_obj_pinned(const char *pathname, enum bpf_prog_type type)
799{
800 int prog_fd = bpf_obj_get(pathname, type);
801
802 if (prog_fd < 0)
803 fprintf(stderr, "Couldn\'t retrieve pinned program \'%s\': %s\n",
804 pathname, strerror(errno));
805 return prog_fd;
806}
807
3f0b9e62 808static int bpf_do_parse(struct bpf_cfg_in *cfg, const bool *opt_tbl)
32e93fb7 809{
32e93fb7 810 const char *file, *section, *uds_name;
32e93fb7 811 bool verbose = false;
e4225669 812 int i, ret, argc;
91d88eeb
DB
813 char **argv;
814
e4225669
DB
815 argv = cfg->argv;
816 argc = cfg->argc;
91d88eeb
DB
817
818 if (opt_tbl[CBPF_BYTECODE] &&
819 (matches(*argv, "bytecode") == 0 ||
820 strcmp(*argv, "bc") == 0)) {
f20ff2f1 821 cfg->mode = CBPF_BYTECODE;
91d88eeb
DB
822 } else if (opt_tbl[CBPF_FILE] &&
823 (matches(*argv, "bytecode-file") == 0 ||
824 strcmp(*argv, "bcf") == 0)) {
f20ff2f1 825 cfg->mode = CBPF_FILE;
91d88eeb
DB
826 } else if (opt_tbl[EBPF_OBJECT] &&
827 (matches(*argv, "object-file") == 0 ||
828 strcmp(*argv, "obj") == 0)) {
f20ff2f1 829 cfg->mode = EBPF_OBJECT;
91d88eeb
DB
830 } else if (opt_tbl[EBPF_PINNED] &&
831 (matches(*argv, "object-pinned") == 0 ||
832 matches(*argv, "pinned") == 0 ||
833 matches(*argv, "fd") == 0)) {
f20ff2f1 834 cfg->mode = EBPF_PINNED;
32e93fb7
DB
835 } else {
836 fprintf(stderr, "What mode is \"%s\"?\n", *argv);
837 return -1;
838 }
839
840 NEXT_ARG();
841 file = section = uds_name = NULL;
f20ff2f1 842 if (cfg->mode == EBPF_OBJECT || cfg->mode == EBPF_PINNED) {
32e93fb7
DB
843 file = *argv;
844 NEXT_ARG_FWD();
845
658cfebc 846 if (cfg->type == BPF_PROG_TYPE_UNSPEC) {
91d88eeb
DB
847 if (argc > 0 && matches(*argv, "type") == 0) {
848 NEXT_ARG();
e4225669
DB
849 for (i = 0; i < ARRAY_SIZE(__bpf_prog_meta);
850 i++) {
851 if (!__bpf_prog_meta[i].type)
852 continue;
853 if (!matches(*argv,
854 __bpf_prog_meta[i].type)) {
658cfebc 855 cfg->type = i;
e4225669
DB
856 break;
857 }
858 }
859
658cfebc 860 if (cfg->type == BPF_PROG_TYPE_UNSPEC) {
91d88eeb
DB
861 fprintf(stderr, "What type is \"%s\"?\n",
862 *argv);
863 return -1;
864 }
865 NEXT_ARG_FWD();
866 } else {
658cfebc 867 cfg->type = BPF_PROG_TYPE_SCHED_CLS;
91d88eeb
DB
868 }
869 }
870
658cfebc 871 section = bpf_prog_to_default_section(cfg->type);
32e93fb7
DB
872 if (argc > 0 && matches(*argv, "section") == 0) {
873 NEXT_ARG();
874 section = *argv;
875 NEXT_ARG_FWD();
876 }
877
658cfebc 878 if (__bpf_prog_meta[cfg->type].may_uds_export) {
e4225669
DB
879 uds_name = getenv(BPF_ENV_UDS);
880 if (argc > 0 && !uds_name &&
881 matches(*argv, "export") == 0) {
882 NEXT_ARG();
883 uds_name = *argv;
884 NEXT_ARG_FWD();
885 }
32e93fb7
DB
886 }
887
888 if (argc > 0 && matches(*argv, "verbose") == 0) {
889 verbose = true;
890 NEXT_ARG_FWD();
891 }
892
893 PREV_ARG();
894 }
895
3f0b9e62 896 if (cfg->mode == CBPF_BYTECODE || cfg->mode == CBPF_FILE) {
51be7546 897 ret = bpf_ops_parse(argc, argv, cfg->opcodes,
f20ff2f1 898 cfg->mode == CBPF_FILE);
3f0b9e62
JK
899 cfg->n_opcodes = ret;
900 } else if (cfg->mode == EBPF_OBJECT) {
901 ret = 0; /* program will be loaded by load stage */
902 } else if (cfg->mode == EBPF_PINNED) {
658cfebc 903 ret = bpf_obj_pinned(file, cfg->type);
3f0b9e62
JK
904 cfg->prog_fd = ret;
905 } else {
32e93fb7 906 return -1;
3f0b9e62 907 }
32e93fb7 908
e4225669
DB
909 cfg->object = file;
910 cfg->section = section;
911 cfg->uds = uds_name;
912 cfg->argc = argc;
913 cfg->argv = argv;
3f0b9e62 914 cfg->verbose = verbose;
91d88eeb
DB
915
916 return ret;
917}
918
3f0b9e62
JK
919static int bpf_do_load(struct bpf_cfg_in *cfg)
920{
921 if (cfg->mode == EBPF_OBJECT) {
922 cfg->prog_fd = bpf_obj_open(cfg->object, cfg->type,
923 cfg->section, cfg->verbose);
924 return cfg->prog_fd;
925 }
926 return 0;
927}
928
4a847fcb
JK
929int bpf_load_common(struct bpf_cfg_in *cfg, const struct bpf_cfg_ops *ops,
930 void *nl)
91d88eeb 931{
91d88eeb 932 char annotation[256];
91d88eeb
DB
933 int ret;
934
3f0b9e62 935 ret = bpf_do_load(cfg);
91d88eeb
DB
936 if (ret < 0)
937 return ret;
938
f20ff2f1 939 if (cfg->mode == CBPF_BYTECODE || cfg->mode == CBPF_FILE)
3f0b9e62 940 ops->cbpf_cb(nl, cfg->opcodes, cfg->n_opcodes);
f20ff2f1 941 if (cfg->mode == EBPF_OBJECT || cfg->mode == EBPF_PINNED) {
32e93fb7 942 snprintf(annotation, sizeof(annotation), "%s:[%s]",
f20ff2f1 943 basename(cfg->object), cfg->mode == EBPF_PINNED ?
e4225669 944 "*fsobj" : cfg->section);
3f0b9e62 945 ops->ebpf_cb(nl, cfg->prog_fd, annotation);
32e93fb7
DB
946 }
947
91d88eeb
DB
948 return 0;
949}
32e93fb7 950
4a847fcb 951int bpf_parse_common(struct bpf_cfg_in *cfg, const struct bpf_cfg_ops *ops)
e4225669
DB
952{
953 bool opt_tbl[BPF_MODE_MAX] = {};
954
955 if (ops->cbpf_cb) {
956 opt_tbl[CBPF_BYTECODE] = true;
957 opt_tbl[CBPF_FILE] = true;
958 }
959
960 if (ops->ebpf_cb) {
961 opt_tbl[EBPF_OBJECT] = true;
962 opt_tbl[EBPF_PINNED] = true;
963 }
964
4a847fcb
JK
965 return bpf_do_parse(cfg, opt_tbl);
966}
967
968int bpf_parse_and_load_common(struct bpf_cfg_in *cfg,
969 const struct bpf_cfg_ops *ops, void *nl)
970{
971 int ret;
972
973 ret = bpf_parse_common(cfg, ops);
974 if (ret < 0)
975 return ret;
976
977 return bpf_load_common(cfg, ops, nl);
e4225669
DB
978}
979
91d88eeb
DB
980int bpf_graft_map(const char *map_path, uint32_t *key, int argc, char **argv)
981{
91d88eeb 982 const bool opt_tbl[BPF_MODE_MAX] = {
91d88eeb
DB
983 [EBPF_OBJECT] = true,
984 [EBPF_PINNED] = true,
985 };
986 const struct bpf_elf_map test = {
987 .type = BPF_MAP_TYPE_PROG_ARRAY,
988 .size_key = sizeof(int),
989 .size_value = sizeof(int),
990 };
e4225669 991 struct bpf_cfg_in cfg = {
658cfebc 992 .type = BPF_PROG_TYPE_UNSPEC,
e4225669
DB
993 .argc = argc,
994 .argv = argv,
995 };
ecb05c0f 996 struct bpf_map_ext ext = {};
91d88eeb 997 int ret, prog_fd, map_fd;
91d88eeb
DB
998 uint32_t map_key;
999
3f0b9e62
JK
1000 ret = bpf_do_parse(&cfg, opt_tbl);
1001 if (ret < 0)
1002 return ret;
1003
1004 ret = bpf_do_load(&cfg);
1005 if (ret < 0)
1006 return ret;
1007
1008 prog_fd = cfg.prog_fd;
1009
91d88eeb
DB
1010 if (key) {
1011 map_key = *key;
1012 } else {
e4225669 1013 ret = sscanf(cfg.section, "%*i/%i", &map_key);
91d88eeb 1014 if (ret != 1) {
32a121cb 1015 fprintf(stderr, "Couldn\'t infer map key from section name! Please provide \'key\' argument!\n");
91d88eeb
DB
1016 ret = -EINVAL;
1017 goto out_prog;
1018 }
1019 }
32e93fb7 1020
658cfebc 1021 map_fd = bpf_obj_get(map_path, cfg.type);
91d88eeb
DB
1022 if (map_fd < 0) {
1023 fprintf(stderr, "Couldn\'t retrieve pinned map \'%s\': %s\n",
1024 map_path, strerror(errno));
1025 ret = map_fd;
1026 goto out_prog;
1027 }
1028
ecb05c0f 1029 ret = bpf_map_selfcheck_pinned(map_fd, &test, &ext,
fb24802b 1030 offsetof(struct bpf_elf_map, max_elem),
658cfebc 1031 cfg.type);
91d88eeb
DB
1032 if (ret < 0) {
1033 fprintf(stderr, "Map \'%s\' self-check failed!\n", map_path);
1034 goto out_map;
1035 }
1036
1037 ret = bpf_map_update(map_fd, &map_key, &prog_fd, BPF_ANY);
1038 if (ret < 0)
1039 fprintf(stderr, "Map update failed: %s\n", strerror(errno));
1040out_map:
1041 close(map_fd);
1042out_prog:
1043 close(prog_fd);
1044 return ret;
32e93fb7
DB
1045}
1046
fc4ccce0
DA
1047int bpf_prog_attach_fd(int prog_fd, int target_fd, enum bpf_attach_type type)
1048{
1049 union bpf_attr attr = {};
1050
1051 attr.target_fd = target_fd;
1052 attr.attach_bpf_fd = prog_fd;
1053 attr.attach_type = type;
1054
1055 return bpf(BPF_PROG_ATTACH, &attr, sizeof(attr));
1056}
1057
1058int bpf_prog_detach_fd(int target_fd, enum bpf_attach_type type)
1059{
1060 union bpf_attr attr = {};
1061
1062 attr.target_fd = target_fd;
1063 attr.attach_type = type;
1064
1065 return bpf(BPF_PROG_DETACH, &attr, sizeof(attr));
1066}
1067
869d889e
DA
1068int bpf_prog_load(enum bpf_prog_type type, const struct bpf_insn *insns,
1069 size_t size_insns, const char *license, char *log,
1070 size_t size_log)
1071{
1072 union bpf_attr attr = {};
1073
1074 attr.prog_type = type;
1075 attr.insns = bpf_ptr_to_u64(insns);
1076 attr.insn_cnt = size_insns / sizeof(struct bpf_insn);
1077 attr.license = bpf_ptr_to_u64(license);
1078
1079 if (size_log > 0) {
1080 attr.log_buf = bpf_ptr_to_u64(log);
1081 attr.log_size = size_log;
1082 attr.log_level = 1;
1083 }
1084
1085 return bpf(BPF_PROG_LOAD, &attr, sizeof(attr));
1086}
1087
6256f8c9 1088#ifdef HAVE_ELF
32e93fb7
DB
1089struct bpf_elf_prog {
1090 enum bpf_prog_type type;
1091 const struct bpf_insn *insns;
1092 size_t size;
1093 const char *license;
1094};
1095
f6793eec
DB
1096struct bpf_hash_entry {
1097 unsigned int pinning;
1098 const char *subpath;
1099 struct bpf_hash_entry *next;
1100};
1101
ecb05c0f
DB
1102struct bpf_config {
1103 unsigned int jit_enabled;
1104};
1105
32e93fb7 1106struct bpf_elf_ctx {
ecb05c0f 1107 struct bpf_config cfg;
32e93fb7
DB
1108 Elf *elf_fd;
1109 GElf_Ehdr elf_hdr;
1110 Elf_Data *sym_tab;
1111 Elf_Data *str_tab;
1112 int obj_fd;
1113 int map_fds[ELF_MAX_MAPS];
1114 struct bpf_elf_map maps[ELF_MAX_MAPS];
ecb05c0f 1115 struct bpf_map_ext maps_ext[ELF_MAX_MAPS];
32e93fb7
DB
1116 int sym_num;
1117 int map_num;
e4225669 1118 int map_len;
32e93fb7
DB
1119 bool *sec_done;
1120 int sec_maps;
1121 char license[ELF_MAX_LICENSE_LEN];
1122 enum bpf_prog_type type;
1123 bool verbose;
1124 struct bpf_elf_st stat;
f6793eec 1125 struct bpf_hash_entry *ht[256];
f31645d1
DB
1126 char *log;
1127 size_t log_size;
32e93fb7
DB
1128};
1129
6256f8c9 1130struct bpf_elf_sec_data {
32e93fb7
DB
1131 GElf_Shdr sec_hdr;
1132 Elf_Data *sec_data;
1133 const char *sec_name;
6256f8c9
DB
1134};
1135
1136struct bpf_map_data {
32e93fb7
DB
1137 int *fds;
1138 const char *obj;
1139 struct bpf_elf_st *st;
1140 struct bpf_elf_map *ent;
6256f8c9
DB
1141};
1142
f31645d1
DB
1143static __check_format_string(2, 3) void
1144bpf_dump_error(struct bpf_elf_ctx *ctx, const char *format, ...)
11c39b5e
DB
1145{
1146 va_list vl;
1147
1148 va_start(vl, format);
1149 vfprintf(stderr, format, vl);
1150 va_end(vl);
1151
f31645d1 1152 if (ctx->log && ctx->log[0]) {
afc1a200
DB
1153 if (ctx->verbose) {
1154 fprintf(stderr, "%s\n", ctx->log);
1155 } else {
1156 unsigned int off = 0, len = strlen(ctx->log);
1157
1158 if (len > BPF_MAX_LOG) {
1159 off = len - BPF_MAX_LOG;
1160 fprintf(stderr, "Skipped %u bytes, use \'verb\' option for the full verbose log.\n[...]\n",
1161 off);
1162 }
1163 fprintf(stderr, "%s\n", ctx->log + off);
1164 }
1165
f31645d1
DB
1166 memset(ctx->log, 0, ctx->log_size);
1167 }
1168}
1169
1170static int bpf_log_realloc(struct bpf_elf_ctx *ctx)
1171{
0f74d0f3 1172 const size_t log_max = UINT_MAX >> 8;
f31645d1 1173 size_t log_size = ctx->log_size;
f6a54d72 1174 char *ptr;
f31645d1
DB
1175
1176 if (!ctx->log) {
1177 log_size = 65536;
0f74d0f3 1178 } else if (log_size < log_max) {
f31645d1 1179 log_size <<= 1;
0f74d0f3
TG
1180 if (log_size > log_max)
1181 log_size = log_max;
1182 } else {
1183 return -EINVAL;
d937a74b 1184 }
f31645d1
DB
1185
1186 ptr = realloc(ctx->log, log_size);
1187 if (!ptr)
1188 return -ENOMEM;
1189
f6a54d72 1190 ptr[0] = 0;
f31645d1
DB
1191 ctx->log = ptr;
1192 ctx->log_size = log_size;
1193
1194 return 0;
11c39b5e
DB
1195}
1196
4dd3f50a
DB
1197static int bpf_map_create(enum bpf_map_type type, uint32_t size_key,
1198 uint32_t size_value, uint32_t max_elem,
612ff099 1199 uint32_t flags, int inner_fd)
11c39b5e 1200{
d17b136f 1201 union bpf_attr attr = {};
67584e3a 1202
67584e3a
ND
1203 attr.map_type = type;
1204 attr.key_size = size_key;
612ff099 1205 attr.value_size = inner_fd ? sizeof(int) : size_value;
67584e3a 1206 attr.max_entries = max_elem;
4dd3f50a 1207 attr.map_flags = flags;
612ff099 1208 attr.inner_map_fd = inner_fd;
11c39b5e
DB
1209
1210 return bpf(BPF_MAP_CREATE, &attr, sizeof(attr));
1211}
11c39b5e 1212
32e93fb7 1213static int bpf_obj_pin(int fd, const char *pathname)
11c39b5e 1214{
d17b136f 1215 union bpf_attr attr = {};
67584e3a 1216
67584e3a
ND
1217 attr.pathname = bpf_ptr_to_u64(pathname);
1218 attr.bpf_fd = fd;
32e93fb7
DB
1219
1220 return bpf(BPF_OBJ_PIN, &attr, sizeof(attr));
1221}
11c39b5e 1222
32e93fb7
DB
1223static int bpf_obj_hash(const char *object, uint8_t *out, size_t len)
1224{
1225 struct sockaddr_alg alg = {
1226 .salg_family = AF_ALG,
1227 .salg_type = "hash",
1228 .salg_name = "sha1",
1229 };
1230 int ret, cfd, ofd, ffd;
1231 struct stat stbuff;
1232 ssize_t size;
1233
1234 if (!object || len != 20)
1235 return -EINVAL;
1236
1237 cfd = socket(AF_ALG, SOCK_SEQPACKET, 0);
1238 if (cfd < 0) {
1239 fprintf(stderr, "Cannot get AF_ALG socket: %s\n",
1240 strerror(errno));
1241 return cfd;
1242 }
1243
1244 ret = bind(cfd, (struct sockaddr *)&alg, sizeof(alg));
1245 if (ret < 0) {
1246 fprintf(stderr, "Error binding socket: %s\n", strerror(errno));
1247 goto out_cfd;
1248 }
1249
1250 ofd = accept(cfd, NULL, 0);
1251 if (ofd < 0) {
1252 fprintf(stderr, "Error accepting socket: %s\n",
1253 strerror(errno));
1254 ret = ofd;
1255 goto out_cfd;
1256 }
1257
1258 ffd = open(object, O_RDONLY);
1259 if (ffd < 0) {
1260 fprintf(stderr, "Error opening object %s: %s\n",
1261 object, strerror(errno));
1262 ret = ffd;
1263 goto out_ofd;
1264 }
1265
32a121cb 1266 ret = fstat(ffd, &stbuff);
32e93fb7
DB
1267 if (ret < 0) {
1268 fprintf(stderr, "Error doing fstat: %s\n",
1269 strerror(errno));
1270 goto out_ffd;
d937a74b 1271 }
11c39b5e 1272
32e93fb7
DB
1273 size = sendfile(ofd, ffd, NULL, stbuff.st_size);
1274 if (size != stbuff.st_size) {
1275 fprintf(stderr, "Error from sendfile (%zd vs %zu bytes): %s\n",
1276 size, stbuff.st_size, strerror(errno));
1277 ret = -1;
1278 goto out_ffd;
1279 }
1280
1281 size = read(ofd, out, len);
1282 if (size != len) {
1283 fprintf(stderr, "Error from read (%zd vs %zu bytes): %s\n",
1284 size, len, strerror(errno));
1285 ret = -1;
1286 } else {
1287 ret = 0;
1288 }
1289out_ffd:
1290 close(ffd);
1291out_ofd:
1292 close(ofd);
1293out_cfd:
1294 close(cfd);
1295 return ret;
11c39b5e
DB
1296}
1297
32e93fb7 1298static const char *bpf_get_obj_uid(const char *pathname)
11c39b5e 1299{
32a121cb 1300 static bool bpf_uid_cached;
32e93fb7
DB
1301 static char bpf_uid[64];
1302 uint8_t tmp[20];
1303 int ret;
11c39b5e 1304
32e93fb7
DB
1305 if (bpf_uid_cached)
1306 goto done;
11c39b5e 1307
32e93fb7
DB
1308 ret = bpf_obj_hash(pathname, tmp, sizeof(tmp));
1309 if (ret) {
1310 fprintf(stderr, "Object hashing failed!\n");
1311 return NULL;
1312 }
1313
1314 hexstring_n2a(tmp, sizeof(tmp), bpf_uid, sizeof(bpf_uid));
1315 bpf_uid_cached = true;
1316done:
1317 return bpf_uid;
11c39b5e
DB
1318}
1319
32e93fb7
DB
1320static int bpf_init_env(const char *pathname)
1321{
1322 struct rlimit limit = {
1323 .rlim_cur = RLIM_INFINITY,
1324 .rlim_max = RLIM_INFINITY,
1325 };
1326
1327 /* Don't bother in case we fail! */
1328 setrlimit(RLIMIT_MEMLOCK, &limit);
1329
e4225669 1330 if (!bpf_get_work_dir(BPF_PROG_TYPE_UNSPEC)) {
32a121cb 1331 fprintf(stderr, "Continuing without mounted eBPF fs. Too old kernel?\n");
32e93fb7
DB
1332 return 0;
1333 }
1334
1335 if (!bpf_get_obj_uid(pathname))
1336 return -1;
1337
1338 return 0;
6256f8c9
DB
1339}
1340
f6793eec
DB
1341static const char *bpf_custom_pinning(const struct bpf_elf_ctx *ctx,
1342 uint32_t pinning)
1343{
1344 struct bpf_hash_entry *entry;
1345
1346 entry = ctx->ht[pinning & (ARRAY_SIZE(ctx->ht) - 1)];
1347 while (entry && entry->pinning != pinning)
1348 entry = entry->next;
1349
1350 return entry ? entry->subpath : NULL;
1351}
1352
1353static bool bpf_no_pinning(const struct bpf_elf_ctx *ctx,
1354 uint32_t pinning)
11c39b5e 1355{
32e93fb7
DB
1356 switch (pinning) {
1357 case PIN_OBJECT_NS:
1358 case PIN_GLOBAL_NS:
1359 return false;
1360 case PIN_NONE:
32e93fb7 1361 return true;
f6793eec
DB
1362 default:
1363 return !bpf_custom_pinning(ctx, pinning);
32e93fb7
DB
1364 }
1365}
1366
1367static void bpf_make_pathname(char *pathname, size_t len, const char *name,
f6793eec 1368 const struct bpf_elf_ctx *ctx, uint32_t pinning)
32e93fb7
DB
1369{
1370 switch (pinning) {
1371 case PIN_OBJECT_NS:
e4225669
DB
1372 snprintf(pathname, len, "%s/%s/%s",
1373 bpf_get_work_dir(ctx->type),
32e93fb7
DB
1374 bpf_get_obj_uid(NULL), name);
1375 break;
1376 case PIN_GLOBAL_NS:
e4225669
DB
1377 snprintf(pathname, len, "%s/%s/%s",
1378 bpf_get_work_dir(ctx->type),
32e93fb7
DB
1379 BPF_DIR_GLOBALS, name);
1380 break;
f6793eec 1381 default:
e4225669
DB
1382 snprintf(pathname, len, "%s/../%s/%s",
1383 bpf_get_work_dir(ctx->type),
f6793eec
DB
1384 bpf_custom_pinning(ctx, pinning), name);
1385 break;
32e93fb7
DB
1386 }
1387}
1388
f6793eec
DB
1389static int bpf_probe_pinned(const char *name, const struct bpf_elf_ctx *ctx,
1390 uint32_t pinning)
32e93fb7
DB
1391{
1392 char pathname[PATH_MAX];
1393
e4225669 1394 if (bpf_no_pinning(ctx, pinning) || !bpf_get_work_dir(ctx->type))
32e93fb7
DB
1395 return 0;
1396
f6793eec 1397 bpf_make_pathname(pathname, sizeof(pathname), name, ctx, pinning);
e4225669 1398 return bpf_obj_get(pathname, ctx->type);
32e93fb7
DB
1399}
1400
e4225669 1401static int bpf_make_obj_path(const struct bpf_elf_ctx *ctx)
32e93fb7 1402{
f6793eec 1403 char tmp[PATH_MAX];
32e93fb7
DB
1404 int ret;
1405
e4225669 1406 snprintf(tmp, sizeof(tmp), "%s/%s", bpf_get_work_dir(ctx->type),
f6793eec
DB
1407 bpf_get_obj_uid(NULL));
1408
1409 ret = mkdir(tmp, S_IRWXU);
1410 if (ret && errno != EEXIST) {
1411 fprintf(stderr, "mkdir %s failed: %s\n", tmp, strerror(errno));
1412 return ret;
1413 }
1414
1415 return 0;
1416}
1417
e4225669
DB
1418static int bpf_make_custom_path(const struct bpf_elf_ctx *ctx,
1419 const char *todo)
f6793eec
DB
1420{
1421 char tmp[PATH_MAX], rem[PATH_MAX], *sub;
1422 int ret;
1423
e4225669 1424 snprintf(tmp, sizeof(tmp), "%s/../", bpf_get_work_dir(ctx->type));
f6793eec
DB
1425 snprintf(rem, sizeof(rem), "%s/", todo);
1426 sub = strtok(rem, "/");
32e93fb7 1427
f6793eec
DB
1428 while (sub) {
1429 if (strlen(tmp) + strlen(sub) + 2 > PATH_MAX)
1430 return -EINVAL;
1431
1432 strcat(tmp, sub);
1433 strcat(tmp, "/");
32e93fb7 1434
f6793eec 1435 ret = mkdir(tmp, S_IRWXU);
32e93fb7 1436 if (ret && errno != EEXIST) {
f6793eec 1437 fprintf(stderr, "mkdir %s failed: %s\n", tmp,
32e93fb7
DB
1438 strerror(errno));
1439 return ret;
1440 }
f6793eec
DB
1441
1442 sub = strtok(NULL, "/");
32e93fb7
DB
1443 }
1444
f6793eec
DB
1445 return 0;
1446}
1447
1448static int bpf_place_pinned(int fd, const char *name,
1449 const struct bpf_elf_ctx *ctx, uint32_t pinning)
1450{
1451 char pathname[PATH_MAX];
1452 const char *tmp;
1453 int ret = 0;
1454
e4225669 1455 if (bpf_no_pinning(ctx, pinning) || !bpf_get_work_dir(ctx->type))
f6793eec
DB
1456 return 0;
1457
1458 if (pinning == PIN_OBJECT_NS)
e4225669 1459 ret = bpf_make_obj_path(ctx);
f6793eec 1460 else if ((tmp = bpf_custom_pinning(ctx, pinning)))
e4225669 1461 ret = bpf_make_custom_path(ctx, tmp);
f6793eec
DB
1462 if (ret < 0)
1463 return ret;
1464
1465 bpf_make_pathname(pathname, sizeof(pathname), name, ctx, pinning);
32e93fb7
DB
1466 return bpf_obj_pin(fd, pathname);
1467}
1468
f31645d1
DB
1469static void bpf_prog_report(int fd, const char *section,
1470 const struct bpf_elf_prog *prog,
1471 struct bpf_elf_ctx *ctx)
32e93fb7 1472{
afc1a200
DB
1473 unsigned int insns = prog->size / sizeof(struct bpf_insn);
1474
1475 fprintf(stderr, "\nProg section \'%s\' %s%s (%d)!\n", section,
f31645d1
DB
1476 fd < 0 ? "rejected: " : "loaded",
1477 fd < 0 ? strerror(errno) : "",
1478 fd < 0 ? errno : fd);
1479
1480 fprintf(stderr, " - Type: %u\n", prog->type);
afc1a200
DB
1481 fprintf(stderr, " - Instructions: %u (%u over limit)\n",
1482 insns, insns > BPF_MAXINSNS ? insns - BPF_MAXINSNS : 0);
f31645d1
DB
1483 fprintf(stderr, " - License: %s\n\n", prog->license);
1484
1485 bpf_dump_error(ctx, "Verifier analysis:\n\n");
1486}
32e93fb7 1487
f31645d1
DB
1488static int bpf_prog_attach(const char *section,
1489 const struct bpf_elf_prog *prog,
1490 struct bpf_elf_ctx *ctx)
1491{
1492 int tries = 0, fd;
1493retry:
32e93fb7
DB
1494 errno = 0;
1495 fd = bpf_prog_load(prog->type, prog->insns, prog->size,
f31645d1
DB
1496 prog->license, ctx->log, ctx->log_size);
1497 if (fd < 0 || ctx->verbose) {
1498 /* The verifier log is pretty chatty, sometimes so chatty
1499 * on larger programs, that we could fail to dump everything
1500 * into our buffer. Still, try to give a debuggable error
1501 * log for the user, so enlarge it and re-fail.
1502 */
1503 if (fd < 0 && (errno == ENOSPC || !ctx->log_size)) {
0f74d0f3 1504 if (tries++ < 10 && !bpf_log_realloc(ctx))
f31645d1
DB
1505 goto retry;
1506
32a121cb 1507 fprintf(stderr, "Log buffer too small to dump verifier log %zu bytes (%d tries)!\n",
f31645d1
DB
1508 ctx->log_size, tries);
1509 return fd;
1510 }
1511
1512 bpf_prog_report(fd, section, prog, ctx);
32e93fb7
DB
1513 }
1514
1515 return fd;
1516}
1517
f31645d1
DB
1518static void bpf_map_report(int fd, const char *name,
1519 const struct bpf_elf_map *map,
612ff099 1520 struct bpf_elf_ctx *ctx, int inner_fd)
f31645d1
DB
1521{
1522 fprintf(stderr, "Map object \'%s\' %s%s (%d)!\n", name,
1523 fd < 0 ? "rejected: " : "loaded",
1524 fd < 0 ? strerror(errno) : "",
1525 fd < 0 ? errno : fd);
1526
1527 fprintf(stderr, " - Type: %u\n", map->type);
1528 fprintf(stderr, " - Identifier: %u\n", map->id);
1529 fprintf(stderr, " - Pinning: %u\n", map->pinning);
1530 fprintf(stderr, " - Size key: %u\n", map->size_key);
612ff099
DB
1531 fprintf(stderr, " - Size value: %u\n",
1532 inner_fd ? (int)sizeof(int) : map->size_value);
4dd3f50a
DB
1533 fprintf(stderr, " - Max elems: %u\n", map->max_elem);
1534 fprintf(stderr, " - Flags: %#x\n\n", map->flags);
f31645d1
DB
1535}
1536
612ff099
DB
1537static int bpf_find_map_id(const struct bpf_elf_ctx *ctx, uint32_t id)
1538{
1539 int i;
1540
1541 for (i = 0; i < ctx->map_num; i++) {
1542 if (ctx->maps[i].id != id)
1543 continue;
1544 if (ctx->map_fds[i] < 0)
1545 return -EINVAL;
1546
1547 return ctx->map_fds[i];
1548 }
1549
1550 return -ENOENT;
1551}
1552
0b5eadc5 1553static void bpf_report_map_in_map(int outer_fd, uint32_t idx)
612ff099
DB
1554{
1555 struct bpf_elf_map outer_map;
1556 int ret;
1557
1558 fprintf(stderr, "Cannot insert map into map! ");
1559
ecb05c0f 1560 ret = bpf_derive_elf_map_from_fdinfo(outer_fd, &outer_map, NULL);
612ff099
DB
1561 if (!ret) {
1562 if (idx >= outer_map.max_elem &&
1563 outer_map.type == BPF_MAP_TYPE_ARRAY_OF_MAPS) {
1564 fprintf(stderr, "Outer map has %u elements, index %u is invalid!\n",
1565 outer_map.max_elem, idx);
1566 return;
1567 }
1568 }
1569
1570 fprintf(stderr, "Different map specs used for outer and inner map?\n");
1571}
1572
1573static bool bpf_is_map_in_map_type(const struct bpf_elf_map *map)
1574{
1575 return map->type == BPF_MAP_TYPE_ARRAY_OF_MAPS ||
1576 map->type == BPF_MAP_TYPE_HASH_OF_MAPS;
1577}
1578
ecb05c0f
DB
1579static int bpf_map_attach(const char *name, struct bpf_elf_ctx *ctx,
1580 const struct bpf_elf_map *map, struct bpf_map_ext *ext,
1581 int *have_map_in_map)
32e93fb7 1582{
612ff099 1583 int fd, ret, map_inner_fd = 0;
32e93fb7 1584
f6793eec 1585 fd = bpf_probe_pinned(name, ctx, map->pinning);
32e93fb7 1586 if (fd > 0) {
ecb05c0f 1587 ret = bpf_map_selfcheck_pinned(fd, map, ext,
91d88eeb 1588 offsetof(struct bpf_elf_map,
fb24802b 1589 id), ctx->type);
9e607f2e
DB
1590 if (ret < 0) {
1591 close(fd);
1592 fprintf(stderr, "Map \'%s\' self-check failed!\n",
1593 name);
1594 return ret;
1595 }
f31645d1 1596 if (ctx->verbose)
32e93fb7
DB
1597 fprintf(stderr, "Map \'%s\' loaded as pinned!\n",
1598 name);
1599 return fd;
1600 }
1601
612ff099
DB
1602 if (have_map_in_map && bpf_is_map_in_map_type(map)) {
1603 (*have_map_in_map)++;
1604 if (map->inner_id)
1605 return 0;
1606 fprintf(stderr, "Map \'%s\' cannot be created since no inner map ID defined!\n",
1607 name);
1608 return -EINVAL;
1609 }
1610
1611 if (!have_map_in_map && bpf_is_map_in_map_type(map)) {
1612 map_inner_fd = bpf_find_map_id(ctx, map->inner_id);
1613 if (map_inner_fd < 0) {
1614 fprintf(stderr, "Map \'%s\' cannot be loaded. Inner map with ID %u not found!\n",
1615 name, map->inner_id);
1616 return -EINVAL;
1617 }
1618 }
1619
32e93fb7
DB
1620 errno = 0;
1621 fd = bpf_map_create(map->type, map->size_key, map->size_value,
612ff099 1622 map->max_elem, map->flags, map_inner_fd);
f31645d1 1623 if (fd < 0 || ctx->verbose) {
612ff099 1624 bpf_map_report(fd, name, map, ctx, map_inner_fd);
32e93fb7
DB
1625 if (fd < 0)
1626 return fd;
1627 }
1628
f6793eec 1629 ret = bpf_place_pinned(fd, name, ctx, map->pinning);
32e93fb7
DB
1630 if (ret < 0 && errno != EEXIST) {
1631 fprintf(stderr, "Could not pin %s map: %s\n", name,
1632 strerror(errno));
1633 close(fd);
1634 return ret;
1635 }
1636
1637 return fd;
1638}
1639
32e93fb7
DB
1640static const char *bpf_str_tab_name(const struct bpf_elf_ctx *ctx,
1641 const GElf_Sym *sym)
1642{
1643 return ctx->str_tab->d_buf + sym->st_name;
1644}
1645
1646static const char *bpf_map_fetch_name(struct bpf_elf_ctx *ctx, int which)
1647{
1648 GElf_Sym sym;
11c39b5e
DB
1649 int i;
1650
32e93fb7
DB
1651 for (i = 0; i < ctx->sym_num; i++) {
1652 if (gelf_getsym(ctx->sym_tab, i, &sym) != &sym)
1653 continue;
1654
5230a2ed
DB
1655 if (GELF_ST_BIND(sym.st_info) != STB_GLOBAL ||
1656 GELF_ST_TYPE(sym.st_info) != STT_NOTYPE ||
32e93fb7 1657 sym.st_shndx != ctx->sec_maps ||
e4225669 1658 sym.st_value / ctx->map_len != which)
32e93fb7
DB
1659 continue;
1660
1661 return bpf_str_tab_name(ctx, &sym);
11c39b5e 1662 }
32e93fb7
DB
1663
1664 return NULL;
11c39b5e
DB
1665}
1666
32e93fb7 1667static int bpf_maps_attach_all(struct bpf_elf_ctx *ctx)
11c39b5e 1668{
612ff099 1669 int i, j, ret, fd, inner_fd, inner_idx, have_map_in_map = 0;
32e93fb7 1670 const char *map_name;
11c39b5e 1671
32e93fb7
DB
1672 for (i = 0; i < ctx->map_num; i++) {
1673 map_name = bpf_map_fetch_name(ctx, i);
1674 if (!map_name)
1675 return -EIO;
11c39b5e 1676
ecb05c0f
DB
1677 fd = bpf_map_attach(map_name, ctx, &ctx->maps[i],
1678 &ctx->maps_ext[i], &have_map_in_map);
612ff099
DB
1679 if (fd < 0)
1680 return fd;
1681
1682 ctx->map_fds[i] = !fd ? -1 : fd;
1683 }
1684
1685 for (i = 0; have_map_in_map && i < ctx->map_num; i++) {
1686 if (ctx->map_fds[i] >= 0)
1687 continue;
1688
1689 map_name = bpf_map_fetch_name(ctx, i);
1690 if (!map_name)
1691 return -EIO;
1692
ecb05c0f
DB
1693 fd = bpf_map_attach(map_name, ctx, &ctx->maps[i],
1694 &ctx->maps_ext[i], NULL);
32e93fb7
DB
1695 if (fd < 0)
1696 return fd;
11c39b5e 1697
32e93fb7 1698 ctx->map_fds[i] = fd;
11c39b5e
DB
1699 }
1700
612ff099
DB
1701 for (i = 0; have_map_in_map && i < ctx->map_num; i++) {
1702 if (!ctx->maps[i].id ||
1703 ctx->maps[i].inner_id ||
1704 ctx->maps[i].inner_idx == -1)
1705 continue;
1706
1707 inner_fd = ctx->map_fds[i];
1708 inner_idx = ctx->maps[i].inner_idx;
1709
1710 for (j = 0; j < ctx->map_num; j++) {
1711 if (!bpf_is_map_in_map_type(&ctx->maps[j]))
1712 continue;
1713 if (ctx->maps[j].inner_id != ctx->maps[i].id)
1714 continue;
1715
1716 ret = bpf_map_update(ctx->map_fds[j], &inner_idx,
1717 &inner_fd, BPF_ANY);
1718 if (ret < 0) {
1719 bpf_report_map_in_map(ctx->map_fds[j],
0b5eadc5 1720 inner_idx);
612ff099
DB
1721 return ret;
1722 }
1723 }
1724 }
1725
11c39b5e 1726 return 0;
11c39b5e
DB
1727}
1728
e4225669
DB
1729static int bpf_map_num_sym(struct bpf_elf_ctx *ctx)
1730{
1731 int i, num = 0;
1732 GElf_Sym sym;
1733
1734 for (i = 0; i < ctx->sym_num; i++) {
1735 if (gelf_getsym(ctx->sym_tab, i, &sym) != &sym)
1736 continue;
1737
1738 if (GELF_ST_BIND(sym.st_info) != STB_GLOBAL ||
1739 GELF_ST_TYPE(sym.st_info) != STT_NOTYPE ||
1740 sym.st_shndx != ctx->sec_maps)
1741 continue;
1742 num++;
1743 }
1744
1745 return num;
1746}
1747
32e93fb7
DB
1748static int bpf_fill_section_data(struct bpf_elf_ctx *ctx, int section,
1749 struct bpf_elf_sec_data *data)
11c39b5e 1750{
32e93fb7 1751 Elf_Data *sec_edata;
11c39b5e
DB
1752 GElf_Shdr sec_hdr;
1753 Elf_Scn *sec_fd;
11c39b5e
DB
1754 char *sec_name;
1755
32e93fb7 1756 memset(data, 0, sizeof(*data));
11c39b5e 1757
32e93fb7 1758 sec_fd = elf_getscn(ctx->elf_fd, section);
11c39b5e
DB
1759 if (!sec_fd)
1760 return -EINVAL;
11c39b5e
DB
1761 if (gelf_getshdr(sec_fd, &sec_hdr) != &sec_hdr)
1762 return -EIO;
1763
32e93fb7 1764 sec_name = elf_strptr(ctx->elf_fd, ctx->elf_hdr.e_shstrndx,
11c39b5e
DB
1765 sec_hdr.sh_name);
1766 if (!sec_name || !sec_hdr.sh_size)
1767 return -ENOENT;
1768
1769 sec_edata = elf_getdata(sec_fd, NULL);
1770 if (!sec_edata || elf_getdata(sec_fd, sec_edata))
1771 return -EIO;
1772
32e93fb7 1773 memcpy(&data->sec_hdr, &sec_hdr, sizeof(sec_hdr));
11c39b5e 1774
32e93fb7
DB
1775 data->sec_name = sec_name;
1776 data->sec_data = sec_edata;
11c39b5e
DB
1777 return 0;
1778}
1779
e4225669
DB
1780struct bpf_elf_map_min {
1781 __u32 type;
1782 __u32 size_key;
1783 __u32 size_value;
1784 __u32 max_elem;
1785};
11c39b5e 1786
e4225669
DB
1787static int bpf_fetch_maps_begin(struct bpf_elf_ctx *ctx, int section,
1788 struct bpf_elf_sec_data *data)
1789{
1790 ctx->map_num = data->sec_data->d_size;
32e93fb7
DB
1791 ctx->sec_maps = section;
1792 ctx->sec_done[section] = true;
11c39b5e 1793
e4225669 1794 if (ctx->map_num > sizeof(ctx->maps)) {
32e93fb7
DB
1795 fprintf(stderr, "Too many BPF maps in ELF section!\n");
1796 return -ENOMEM;
1797 }
11c39b5e 1798
e4225669
DB
1799 memcpy(ctx->maps, data->sec_data->d_buf, ctx->map_num);
1800 return 0;
1801}
1802
1803static int bpf_map_verify_all_offs(struct bpf_elf_ctx *ctx, int end)
1804{
1805 GElf_Sym sym;
1806 int off, i;
1807
1808 for (off = 0; off < end; off += ctx->map_len) {
1809 /* Order doesn't need to be linear here, hence we walk
1810 * the table again.
1811 */
1812 for (i = 0; i < ctx->sym_num; i++) {
1813 if (gelf_getsym(ctx->sym_tab, i, &sym) != &sym)
1814 continue;
1815 if (GELF_ST_BIND(sym.st_info) != STB_GLOBAL ||
1816 GELF_ST_TYPE(sym.st_info) != STT_NOTYPE ||
1817 sym.st_shndx != ctx->sec_maps)
1818 continue;
1819 if (sym.st_value == off)
1820 break;
1821 if (i == ctx->sym_num - 1)
1822 return -1;
1823 }
1824 }
1825
1826 return off == end ? 0 : -1;
1827}
1828
1829static int bpf_fetch_maps_end(struct bpf_elf_ctx *ctx)
1830{
1831 struct bpf_elf_map fixup[ARRAY_SIZE(ctx->maps)] = {};
1832 int i, sym_num = bpf_map_num_sym(ctx);
1833 __u8 *buff;
1834
1835 if (sym_num == 0 || sym_num > ARRAY_SIZE(ctx->maps)) {
1836 fprintf(stderr, "%u maps not supported in current map section!\n",
1837 sym_num);
1838 return -EINVAL;
1839 }
1840
1841 if (ctx->map_num % sym_num != 0 ||
1842 ctx->map_num % sizeof(__u32) != 0) {
1843 fprintf(stderr, "Number BPF map symbols are not multiple of struct bpf_elf_map!\n");
1844 return -EINVAL;
1845 }
1846
1847 ctx->map_len = ctx->map_num / sym_num;
1848 if (bpf_map_verify_all_offs(ctx, ctx->map_num)) {
1849 fprintf(stderr, "Different struct bpf_elf_map in use!\n");
1850 return -EINVAL;
1851 }
1852
1853 if (ctx->map_len == sizeof(struct bpf_elf_map)) {
1854 ctx->map_num = sym_num;
1855 return 0;
1856 } else if (ctx->map_len > sizeof(struct bpf_elf_map)) {
1857 fprintf(stderr, "struct bpf_elf_map not supported, coming from future version?\n");
1858 return -EINVAL;
1859 } else if (ctx->map_len < sizeof(struct bpf_elf_map_min)) {
1860 fprintf(stderr, "struct bpf_elf_map too small, not supported!\n");
1861 return -EINVAL;
1862 }
1863
1864 ctx->map_num = sym_num;
1865 for (i = 0, buff = (void *)ctx->maps; i < ctx->map_num;
1866 i++, buff += ctx->map_len) {
1867 /* The fixup leaves the rest of the members as zero, which
1868 * is fine currently, but option exist to set some other
1869 * default value as well when needed in future.
1870 */
1871 memcpy(&fixup[i], buff, ctx->map_len);
1872 }
1873
1874 memcpy(ctx->maps, fixup, sizeof(fixup));
1875
1876 printf("Note: %zu bytes struct bpf_elf_map fixup performed due to size mismatch!\n",
1877 sizeof(struct bpf_elf_map) - ctx->map_len);
32e93fb7
DB
1878 return 0;
1879}
11c39b5e 1880
32e93fb7
DB
1881static int bpf_fetch_license(struct bpf_elf_ctx *ctx, int section,
1882 struct bpf_elf_sec_data *data)
1883{
1884 if (data->sec_data->d_size > sizeof(ctx->license))
1885 return -ENOMEM;
11c39b5e 1886
32e93fb7
DB
1887 memcpy(ctx->license, data->sec_data->d_buf, data->sec_data->d_size);
1888 ctx->sec_done[section] = true;
1889 return 0;
1890}
11c39b5e 1891
32e93fb7
DB
1892static int bpf_fetch_symtab(struct bpf_elf_ctx *ctx, int section,
1893 struct bpf_elf_sec_data *data)
1894{
1895 ctx->sym_tab = data->sec_data;
1896 ctx->sym_num = data->sec_hdr.sh_size / data->sec_hdr.sh_entsize;
1897 ctx->sec_done[section] = true;
11c39b5e
DB
1898 return 0;
1899}
1900
32e93fb7
DB
1901static int bpf_fetch_strtab(struct bpf_elf_ctx *ctx, int section,
1902 struct bpf_elf_sec_data *data)
11c39b5e 1903{
32e93fb7
DB
1904 ctx->str_tab = data->sec_data;
1905 ctx->sec_done[section] = true;
1906 return 0;
1907}
11c39b5e 1908
afc1a200
DB
1909static bool bpf_has_map_data(const struct bpf_elf_ctx *ctx)
1910{
1911 return ctx->sym_tab && ctx->str_tab && ctx->sec_maps;
1912}
1913
32e93fb7
DB
1914static int bpf_fetch_ancillary(struct bpf_elf_ctx *ctx)
1915{
1916 struct bpf_elf_sec_data data;
1917 int i, ret = -1;
11c39b5e 1918
32e93fb7
DB
1919 for (i = 1; i < ctx->elf_hdr.e_shnum; i++) {
1920 ret = bpf_fill_section_data(ctx, i, &data);
11c39b5e
DB
1921 if (ret < 0)
1922 continue;
1923
cce3d466
DB
1924 if (data.sec_hdr.sh_type == SHT_PROGBITS &&
1925 !strcmp(data.sec_name, ELF_SECTION_MAPS))
e4225669 1926 ret = bpf_fetch_maps_begin(ctx, i, &data);
cce3d466
DB
1927 else if (data.sec_hdr.sh_type == SHT_PROGBITS &&
1928 !strcmp(data.sec_name, ELF_SECTION_LICENSE))
32e93fb7 1929 ret = bpf_fetch_license(ctx, i, &data);
cce3d466
DB
1930 else if (data.sec_hdr.sh_type == SHT_SYMTAB &&
1931 !strcmp(data.sec_name, ".symtab"))
32e93fb7
DB
1932 ret = bpf_fetch_symtab(ctx, i, &data);
1933 else if (data.sec_hdr.sh_type == SHT_STRTAB &&
cce3d466 1934 !strcmp(data.sec_name, ".strtab"))
32e93fb7
DB
1935 ret = bpf_fetch_strtab(ctx, i, &data);
1936 if (ret < 0) {
afc1a200 1937 fprintf(stderr, "Error parsing section %d! Perhaps check with readelf -a?\n",
32a121cb 1938 i);
e4225669 1939 return ret;
11c39b5e 1940 }
32e93fb7
DB
1941 }
1942
afc1a200 1943 if (bpf_has_map_data(ctx)) {
e4225669
DB
1944 ret = bpf_fetch_maps_end(ctx);
1945 if (ret < 0) {
1946 fprintf(stderr, "Error fixing up map structure, incompatible struct bpf_elf_map used?\n");
1947 return ret;
1948 }
1949
32e93fb7
DB
1950 ret = bpf_maps_attach_all(ctx);
1951 if (ret < 0) {
1952 fprintf(stderr, "Error loading maps into kernel!\n");
1953 return ret;
11c39b5e
DB
1954 }
1955 }
1956
1957 return ret;
1958}
1959
e4225669
DB
1960static int bpf_fetch_prog(struct bpf_elf_ctx *ctx, const char *section,
1961 bool *sseen)
11c39b5e 1962{
32e93fb7
DB
1963 struct bpf_elf_sec_data data;
1964 struct bpf_elf_prog prog;
1965 int ret, i, fd = -1;
11c39b5e 1966
32e93fb7
DB
1967 for (i = 1; i < ctx->elf_hdr.e_shnum; i++) {
1968 if (ctx->sec_done[i])
11c39b5e
DB
1969 continue;
1970
32e93fb7 1971 ret = bpf_fill_section_data(ctx, i, &data);
cce3d466
DB
1972 if (ret < 0 ||
1973 !(data.sec_hdr.sh_type == SHT_PROGBITS &&
1974 data.sec_hdr.sh_flags & SHF_EXECINSTR &&
1975 !strcmp(data.sec_name, section)))
11c39b5e
DB
1976 continue;
1977
e4225669
DB
1978 *sseen = true;
1979
32e93fb7
DB
1980 memset(&prog, 0, sizeof(prog));
1981 prog.type = ctx->type;
1982 prog.insns = data.sec_data->d_buf;
1983 prog.size = data.sec_data->d_size;
1984 prog.license = ctx->license;
11c39b5e 1985
f31645d1 1986 fd = bpf_prog_attach(section, &prog, ctx);
32e93fb7 1987 if (fd < 0)
e4225669 1988 return fd;
11c39b5e 1989
32e93fb7 1990 ctx->sec_done[i] = true;
11c39b5e
DB
1991 break;
1992 }
1993
32e93fb7 1994 return fd;
11c39b5e
DB
1995}
1996
ecb05c0f
DB
1997struct bpf_tail_call_props {
1998 unsigned int total;
1999 unsigned int jited;
2000};
2001
32e93fb7
DB
2002static int bpf_apply_relo_data(struct bpf_elf_ctx *ctx,
2003 struct bpf_elf_sec_data *data_relo,
ecb05c0f
DB
2004 struct bpf_elf_sec_data *data_insn,
2005 struct bpf_tail_call_props *props)
11c39b5e 2006{
32e93fb7
DB
2007 Elf_Data *idata = data_insn->sec_data;
2008 GElf_Shdr *rhdr = &data_relo->sec_hdr;
2009 int relo_ent, relo_num = rhdr->sh_size / rhdr->sh_entsize;
2010 struct bpf_insn *insns = idata->d_buf;
2011 unsigned int num_insns = idata->d_size / sizeof(*insns);
11c39b5e 2012
32e93fb7
DB
2013 for (relo_ent = 0; relo_ent < relo_num; relo_ent++) {
2014 unsigned int ioff, rmap;
2015 GElf_Rel relo;
2016 GElf_Sym sym;
2017
2018 if (gelf_getrel(data_relo->sec_data, relo_ent, &relo) != &relo)
2019 return -EIO;
2020
2021 ioff = relo.r_offset / sizeof(struct bpf_insn);
2022 if (ioff >= num_insns ||
a576c6b9 2023 insns[ioff].code != (BPF_LD | BPF_IMM | BPF_DW)) {
32a121cb 2024 fprintf(stderr, "ELF contains relo data for non ld64 instruction at offset %u! Compiler bug?!\n",
a576c6b9
DB
2025 ioff);
2026 if (ioff < num_insns &&
2027 insns[ioff].code == (BPF_JMP | BPF_CALL))
32a121cb 2028 fprintf(stderr, " - Try to annotate functions with always_inline attribute!\n");
32e93fb7 2029 return -EINVAL;
a576c6b9 2030 }
32e93fb7
DB
2031
2032 if (gelf_getsym(ctx->sym_tab, GELF_R_SYM(relo.r_info), &sym) != &sym)
2033 return -EIO;
2486337a 2034 if (sym.st_shndx != ctx->sec_maps) {
32a121cb 2035 fprintf(stderr, "ELF contains non-map related relo data in entry %u pointing to section %u! Compiler bug?!\n",
2486337a
DB
2036 relo_ent, sym.st_shndx);
2037 return -EIO;
2038 }
32e93fb7 2039
e4225669 2040 rmap = sym.st_value / ctx->map_len;
32e93fb7
DB
2041 if (rmap >= ARRAY_SIZE(ctx->map_fds))
2042 return -EINVAL;
2043 if (!ctx->map_fds[rmap])
2044 return -EINVAL;
ecb05c0f
DB
2045 if (ctx->maps[rmap].type == BPF_MAP_TYPE_PROG_ARRAY) {
2046 props->total++;
2047 if (ctx->maps_ext[rmap].owner.jited ||
2048 (ctx->maps_ext[rmap].owner.type == 0 &&
2049 ctx->cfg.jit_enabled))
2050 props->jited++;
2051 }
32e93fb7
DB
2052
2053 if (ctx->verbose)
32a121cb 2054 fprintf(stderr, "Map \'%s\' (%d) injected into prog section \'%s\' at offset %u!\n",
32e93fb7
DB
2055 bpf_str_tab_name(ctx, &sym), ctx->map_fds[rmap],
2056 data_insn->sec_name, ioff);
11c39b5e 2057
32e93fb7
DB
2058 insns[ioff].src_reg = BPF_PSEUDO_MAP_FD;
2059 insns[ioff].imm = ctx->map_fds[rmap];
2060 }
2061
2062 return 0;
2063}
2064
afc1a200 2065static int bpf_fetch_prog_relo(struct bpf_elf_ctx *ctx, const char *section,
e4225669 2066 bool *lderr, bool *sseen)
32e93fb7
DB
2067{
2068 struct bpf_elf_sec_data data_relo, data_insn;
2069 struct bpf_elf_prog prog;
2070 int ret, idx, i, fd = -1;
2071
2072 for (i = 1; i < ctx->elf_hdr.e_shnum; i++) {
ecb05c0f
DB
2073 struct bpf_tail_call_props props = {};
2074
32e93fb7
DB
2075 ret = bpf_fill_section_data(ctx, i, &data_relo);
2076 if (ret < 0 || data_relo.sec_hdr.sh_type != SHT_REL)
11c39b5e
DB
2077 continue;
2078
32e93fb7 2079 idx = data_relo.sec_hdr.sh_info;
e4225669 2080
32e93fb7 2081 ret = bpf_fill_section_data(ctx, idx, &data_insn);
cce3d466
DB
2082 if (ret < 0 ||
2083 !(data_insn.sec_hdr.sh_type == SHT_PROGBITS &&
2084 data_insn.sec_hdr.sh_flags & SHF_EXECINSTR &&
2085 !strcmp(data_insn.sec_name, section)))
11c39b5e 2086 continue;
32e93fb7 2087
e4225669
DB
2088 *sseen = true;
2089
ecb05c0f 2090 ret = bpf_apply_relo_data(ctx, &data_relo, &data_insn, &props);
c9c3720d
DB
2091 if (ret < 0) {
2092 *lderr = true;
e4225669 2093 return ret;
c9c3720d 2094 }
11c39b5e 2095
32e93fb7
DB
2096 memset(&prog, 0, sizeof(prog));
2097 prog.type = ctx->type;
2098 prog.insns = data_insn.sec_data->d_buf;
2099 prog.size = data_insn.sec_data->d_size;
2100 prog.license = ctx->license;
2101
f31645d1 2102 fd = bpf_prog_attach(section, &prog, ctx);
afc1a200
DB
2103 if (fd < 0) {
2104 *lderr = true;
ecb05c0f
DB
2105 if (props.total) {
2106 if (ctx->cfg.jit_enabled &&
2107 props.total != props.jited)
2108 fprintf(stderr, "JIT enabled, but only %u/%u tail call maps in the program have JITed owner!\n",
2109 props.jited, props.total);
2110 if (!ctx->cfg.jit_enabled &&
2111 props.jited)
2112 fprintf(stderr, "JIT disabled, but %u/%u tail call maps in the program have JITed owner!\n",
2113 props.jited, props.total);
2114 }
e4225669 2115 return fd;
afc1a200 2116 }
11c39b5e 2117
32e93fb7
DB
2118 ctx->sec_done[i] = true;
2119 ctx->sec_done[idx] = true;
11c39b5e
DB
2120 break;
2121 }
2122
32e93fb7 2123 return fd;
11c39b5e
DB
2124}
2125
32e93fb7 2126static int bpf_fetch_prog_sec(struct bpf_elf_ctx *ctx, const char *section)
473d7840 2127{
e4225669 2128 bool lderr = false, sseen = false;
473d7840
DB
2129 int ret = -1;
2130
afc1a200 2131 if (bpf_has_map_data(ctx))
e4225669 2132 ret = bpf_fetch_prog_relo(ctx, section, &lderr, &sseen);
afc1a200 2133 if (ret < 0 && !lderr)
e4225669
DB
2134 ret = bpf_fetch_prog(ctx, section, &sseen);
2135 if (ret < 0 && !sseen)
2136 fprintf(stderr, "Program section \'%s\' not found in ELF file!\n",
2137 section);
473d7840
DB
2138 return ret;
2139}
2140
910b543d
DB
2141static int bpf_find_map_by_id(struct bpf_elf_ctx *ctx, uint32_t id)
2142{
2143 int i;
2144
2145 for (i = 0; i < ARRAY_SIZE(ctx->map_fds); i++)
2146 if (ctx->map_fds[i] && ctx->maps[i].id == id &&
2147 ctx->maps[i].type == BPF_MAP_TYPE_PROG_ARRAY)
2148 return i;
2149 return -1;
2150}
2151
ecb05c0f
DB
2152struct bpf_jited_aux {
2153 int prog_fd;
2154 int map_fd;
2155 struct bpf_prog_data prog;
2156 struct bpf_map_ext map;
2157};
2158
2159static int bpf_derive_prog_from_fdinfo(int fd, struct bpf_prog_data *prog)
2160{
2161 char file[PATH_MAX], buff[4096];
2162 unsigned int val;
2163 FILE *fp;
2164
2165 snprintf(file, sizeof(file), "/proc/%d/fdinfo/%d", getpid(), fd);
2166 memset(prog, 0, sizeof(*prog));
2167
2168 fp = fopen(file, "r");
2169 if (!fp) {
2170 fprintf(stderr, "No procfs support?!\n");
2171 return -EIO;
2172 }
2173
2174 while (fgets(buff, sizeof(buff), fp)) {
2175 if (sscanf(buff, "prog_type:\t%u", &val) == 1)
2176 prog->type = val;
2177 else if (sscanf(buff, "prog_jited:\t%u", &val) == 1)
2178 prog->jited = val;
2179 }
2180
2181 fclose(fp);
2182 return 0;
2183}
2184
2185static int bpf_tail_call_get_aux(struct bpf_jited_aux *aux)
2186{
2187 struct bpf_elf_map tmp;
2188 int ret;
2189
2190 ret = bpf_derive_elf_map_from_fdinfo(aux->map_fd, &tmp, &aux->map);
2191 if (!ret)
2192 ret = bpf_derive_prog_from_fdinfo(aux->prog_fd, &aux->prog);
2193
2194 return ret;
2195}
2196
32e93fb7 2197static int bpf_fill_prog_arrays(struct bpf_elf_ctx *ctx)
473d7840 2198{
32e93fb7
DB
2199 struct bpf_elf_sec_data data;
2200 uint32_t map_id, key_id;
910b543d 2201 int fd, i, ret, idx;
473d7840 2202
32e93fb7
DB
2203 for (i = 1; i < ctx->elf_hdr.e_shnum; i++) {
2204 if (ctx->sec_done[i])
473d7840
DB
2205 continue;
2206
32e93fb7 2207 ret = bpf_fill_section_data(ctx, i, &data);
473d7840
DB
2208 if (ret < 0)
2209 continue;
2210
910b543d
DB
2211 ret = sscanf(data.sec_name, "%i/%i", &map_id, &key_id);
2212 if (ret != 2)
32e93fb7 2213 continue;
910b543d
DB
2214
2215 idx = bpf_find_map_by_id(ctx, map_id);
2216 if (idx < 0)
473d7840
DB
2217 continue;
2218
32e93fb7
DB
2219 fd = bpf_fetch_prog_sec(ctx, data.sec_name);
2220 if (fd < 0)
473d7840
DB
2221 return -EIO;
2222
910b543d
DB
2223 ret = bpf_map_update(ctx->map_fds[idx], &key_id,
2224 &fd, BPF_ANY);
afc1a200 2225 if (ret < 0) {
ecb05c0f
DB
2226 struct bpf_jited_aux aux = {};
2227
2228 ret = -errno;
2229 if (errno == E2BIG) {
afc1a200
DB
2230 fprintf(stderr, "Tail call key %u for map %u out of bounds?\n",
2231 key_id, map_id);
ecb05c0f
DB
2232 return ret;
2233 }
2234
2235 aux.map_fd = ctx->map_fds[idx];
2236 aux.prog_fd = fd;
2237
2238 if (bpf_tail_call_get_aux(&aux))
2239 return ret;
2240 if (!aux.map.owner.type)
2241 return ret;
2242
2243 if (aux.prog.type != aux.map.owner.type)
2244 fprintf(stderr, "Tail call map owned by prog type %u, but prog type is %u!\n",
2245 aux.map.owner.type, aux.prog.type);
2246 if (aux.prog.jited != aux.map.owner.jited)
2247 fprintf(stderr, "Tail call map %s jited, but prog %s!\n",
2248 aux.map.owner.jited ? "is" : "not",
2249 aux.prog.jited ? "is" : "not");
2250 return ret;
afc1a200 2251 }
473d7840 2252
32e93fb7 2253 ctx->sec_done[i] = true;
473d7840
DB
2254 }
2255
2256 return 0;
2257}
2258
32e93fb7 2259static void bpf_save_finfo(struct bpf_elf_ctx *ctx)
11c39b5e 2260{
32e93fb7
DB
2261 struct stat st;
2262 int ret;
11c39b5e 2263
32e93fb7 2264 memset(&ctx->stat, 0, sizeof(ctx->stat));
11c39b5e 2265
32e93fb7
DB
2266 ret = fstat(ctx->obj_fd, &st);
2267 if (ret < 0) {
2268 fprintf(stderr, "Stat of elf file failed: %s\n",
2269 strerror(errno));
2270 return;
2271 }
11c39b5e 2272
32e93fb7
DB
2273 ctx->stat.st_dev = st.st_dev;
2274 ctx->stat.st_ino = st.st_ino;
2275}
2276
f6793eec
DB
2277static int bpf_read_pin_mapping(FILE *fp, uint32_t *id, char *path)
2278{
2279 char buff[PATH_MAX];
2280
2281 while (fgets(buff, sizeof(buff), fp)) {
2282 char *ptr = buff;
2283
2284 while (*ptr == ' ' || *ptr == '\t')
2285 ptr++;
2286
2287 if (*ptr == '#' || *ptr == '\n' || *ptr == 0)
2288 continue;
2289
2290 if (sscanf(ptr, "%i %s\n", id, path) != 2 &&
2291 sscanf(ptr, "%i %s #", id, path) != 2) {
2292 strcpy(path, ptr);
2293 return -1;
2294 }
2295
2296 return 1;
2297 }
2298
2299 return 0;
2300}
2301
2302static bool bpf_pinning_reserved(uint32_t pinning)
2303{
2304 switch (pinning) {
2305 case PIN_NONE:
2306 case PIN_OBJECT_NS:
2307 case PIN_GLOBAL_NS:
2308 return true;
2309 default:
2310 return false;
2311 }
2312}
2313
2314static void bpf_hash_init(struct bpf_elf_ctx *ctx, const char *db_file)
2315{
2316 struct bpf_hash_entry *entry;
d17b136f 2317 char subpath[PATH_MAX] = {};
f6793eec
DB
2318 uint32_t pinning;
2319 FILE *fp;
2320 int ret;
2321
2322 fp = fopen(db_file, "r");
2323 if (!fp)
2324 return;
2325
f6793eec
DB
2326 while ((ret = bpf_read_pin_mapping(fp, &pinning, subpath))) {
2327 if (ret == -1) {
2328 fprintf(stderr, "Database %s is corrupted at: %s\n",
2329 db_file, subpath);
2330 fclose(fp);
2331 return;
2332 }
2333
2334 if (bpf_pinning_reserved(pinning)) {
32a121cb
SH
2335 fprintf(stderr, "Database %s, id %u is reserved - ignoring!\n",
2336 db_file, pinning);
f6793eec
DB
2337 continue;
2338 }
2339
2340 entry = malloc(sizeof(*entry));
2341 if (!entry) {
2342 fprintf(stderr, "No memory left for db entry!\n");
2343 continue;
2344 }
2345
2346 entry->pinning = pinning;
2347 entry->subpath = strdup(subpath);
2348 if (!entry->subpath) {
2349 fprintf(stderr, "No memory left for db entry!\n");
2350 free(entry);
2351 continue;
2352 }
2353
2354 entry->next = ctx->ht[pinning & (ARRAY_SIZE(ctx->ht) - 1)];
2355 ctx->ht[pinning & (ARRAY_SIZE(ctx->ht) - 1)] = entry;
2356 }
2357
2358 fclose(fp);
2359}
2360
2361static void bpf_hash_destroy(struct bpf_elf_ctx *ctx)
2362{
2363 struct bpf_hash_entry *entry;
2364 int i;
2365
2366 for (i = 0; i < ARRAY_SIZE(ctx->ht); i++) {
2367 while ((entry = ctx->ht[i]) != NULL) {
2368 ctx->ht[i] = entry->next;
2369 free((char *)entry->subpath);
2370 free(entry);
2371 }
2372 }
2373}
2374
8187b012
DB
2375static int bpf_elf_check_ehdr(const struct bpf_elf_ctx *ctx)
2376{
2377 if (ctx->elf_hdr.e_type != ET_REL ||
e77fa41d
DB
2378 (ctx->elf_hdr.e_machine != EM_NONE &&
2379 ctx->elf_hdr.e_machine != EM_BPF) ||
8187b012
DB
2380 ctx->elf_hdr.e_version != EV_CURRENT) {
2381 fprintf(stderr, "ELF format error, ELF file not for eBPF?\n");
2382 return -EINVAL;
2383 }
2384
2385 switch (ctx->elf_hdr.e_ident[EI_DATA]) {
2386 default:
2387 fprintf(stderr, "ELF format error, wrong endianness info?\n");
2388 return -EINVAL;
2389 case ELFDATA2LSB:
2390 if (htons(1) == 1) {
2391 fprintf(stderr,
2392 "We are big endian, eBPF object is little endian!\n");
2393 return -EIO;
2394 }
2395 break;
2396 case ELFDATA2MSB:
2397 if (htons(1) != 1) {
2398 fprintf(stderr,
2399 "We are little endian, eBPF object is big endian!\n");
2400 return -EIO;
2401 }
2402 break;
2403 }
2404
2405 return 0;
2406}
2407
ecb05c0f
DB
2408static void bpf_get_cfg(struct bpf_elf_ctx *ctx)
2409{
2410 static const char *path_jit = "/proc/sys/net/core/bpf_jit_enable";
2411 int fd;
2412
2413 fd = open(path_jit, O_RDONLY);
2414 if (fd > 0) {
2415 char tmp[16] = {};
2416
2417 if (read(fd, tmp, sizeof(tmp)) > 0)
2418 ctx->cfg.jit_enabled = atoi(tmp);
2419 close(fd);
2420 }
2421}
2422
32e93fb7
DB
2423static int bpf_elf_ctx_init(struct bpf_elf_ctx *ctx, const char *pathname,
2424 enum bpf_prog_type type, bool verbose)
2425{
2426 int ret = -EINVAL;
2427
2428 if (elf_version(EV_CURRENT) == EV_NONE ||
2429 bpf_init_env(pathname))
2430 return ret;
2431
2432 memset(ctx, 0, sizeof(*ctx));
ecb05c0f 2433 bpf_get_cfg(ctx);
32e93fb7
DB
2434 ctx->verbose = verbose;
2435 ctx->type = type;
2436
2437 ctx->obj_fd = open(pathname, O_RDONLY);
2438 if (ctx->obj_fd < 0)
2439 return ctx->obj_fd;
2440
2441 ctx->elf_fd = elf_begin(ctx->obj_fd, ELF_C_READ, NULL);
2442 if (!ctx->elf_fd) {
11c39b5e 2443 ret = -EINVAL;
32e93fb7 2444 goto out_fd;
11c39b5e
DB
2445 }
2446
8187b012
DB
2447 if (elf_kind(ctx->elf_fd) != ELF_K_ELF) {
2448 ret = -EINVAL;
2449 goto out_fd;
2450 }
2451
32e93fb7
DB
2452 if (gelf_getehdr(ctx->elf_fd, &ctx->elf_hdr) !=
2453 &ctx->elf_hdr) {
11c39b5e
DB
2454 ret = -EIO;
2455 goto out_elf;
2456 }
2457
8187b012
DB
2458 ret = bpf_elf_check_ehdr(ctx);
2459 if (ret < 0)
2460 goto out_elf;
2461
32e93fb7
DB
2462 ctx->sec_done = calloc(ctx->elf_hdr.e_shnum,
2463 sizeof(*(ctx->sec_done)));
2464 if (!ctx->sec_done) {
11c39b5e
DB
2465 ret = -ENOMEM;
2466 goto out_elf;
2467 }
2468
f31645d1
DB
2469 if (ctx->verbose && bpf_log_realloc(ctx)) {
2470 ret = -ENOMEM;
2471 goto out_free;
2472 }
2473
32e93fb7 2474 bpf_save_finfo(ctx);
f6793eec
DB
2475 bpf_hash_init(ctx, CONFDIR "/bpf_pinning");
2476
32e93fb7 2477 return 0;
f31645d1
DB
2478out_free:
2479 free(ctx->sec_done);
32e93fb7
DB
2480out_elf:
2481 elf_end(ctx->elf_fd);
2482out_fd:
2483 close(ctx->obj_fd);
2484 return ret;
2485}
d937a74b 2486
32e93fb7
DB
2487static int bpf_maps_count(struct bpf_elf_ctx *ctx)
2488{
2489 int i, count = 0;
11c39b5e 2490
32e93fb7
DB
2491 for (i = 0; i < ARRAY_SIZE(ctx->map_fds); i++) {
2492 if (!ctx->map_fds[i])
2493 break;
2494 count++;
2495 }
473d7840 2496
32e93fb7
DB
2497 return count;
2498}
6256f8c9 2499
32e93fb7
DB
2500static void bpf_maps_teardown(struct bpf_elf_ctx *ctx)
2501{
2502 int i;
2503
2504 for (i = 0; i < ARRAY_SIZE(ctx->map_fds); i++) {
2505 if (ctx->map_fds[i])
2506 close(ctx->map_fds[i]);
473d7840 2507 }
32e93fb7
DB
2508}
2509
2510static void bpf_elf_ctx_destroy(struct bpf_elf_ctx *ctx, bool failure)
2511{
2512 if (failure)
2513 bpf_maps_teardown(ctx);
473d7840 2514
f6793eec 2515 bpf_hash_destroy(ctx);
f31645d1 2516
32e93fb7 2517 free(ctx->sec_done);
f31645d1
DB
2518 free(ctx->log);
2519
32e93fb7
DB
2520 elf_end(ctx->elf_fd);
2521 close(ctx->obj_fd);
2522}
6256f8c9 2523
32e93fb7 2524static struct bpf_elf_ctx __ctx;
6256f8c9 2525
32e93fb7
DB
2526static int bpf_obj_open(const char *pathname, enum bpf_prog_type type,
2527 const char *section, bool verbose)
2528{
2529 struct bpf_elf_ctx *ctx = &__ctx;
2530 int fd = 0, ret;
6256f8c9 2531
32e93fb7
DB
2532 ret = bpf_elf_ctx_init(ctx, pathname, type, verbose);
2533 if (ret < 0) {
2534 fprintf(stderr, "Cannot initialize ELF context!\n");
2535 return ret;
2536 }
6256f8c9 2537
32e93fb7
DB
2538 ret = bpf_fetch_ancillary(ctx);
2539 if (ret < 0) {
2540 fprintf(stderr, "Error fetching ELF ancillary data!\n");
2541 goto out;
2542 }
2543
2544 fd = bpf_fetch_prog_sec(ctx, section);
2545 if (fd < 0) {
2546 fprintf(stderr, "Error fetching program/map!\n");
2547 ret = fd;
2548 goto out;
2549 }
2550
2551 ret = bpf_fill_prog_arrays(ctx);
2552 if (ret < 0)
2553 fprintf(stderr, "Error filling program arrays!\n");
11c39b5e 2554out:
32e93fb7
DB
2555 bpf_elf_ctx_destroy(ctx, ret < 0);
2556 if (ret < 0) {
2557 if (fd)
2558 close(fd);
2559 return ret;
2560 }
2561
2562 return fd;
6256f8c9 2563}
11c39b5e 2564
6256f8c9 2565static int
4bd62446
DB
2566bpf_map_set_send(int fd, struct sockaddr_un *addr, unsigned int addr_len,
2567 const struct bpf_map_data *aux, unsigned int entries)
6256f8c9 2568{
d17b136f
PS
2569 struct bpf_map_set_msg msg = {
2570 .aux.uds_ver = BPF_SCM_AUX_VER,
2571 .aux.num_ent = entries,
2572 };
6256f8c9
DB
2573 int *cmsg_buf, min_fd;
2574 char *amsg_buf;
2575 int i;
2576
6256f8c9
DB
2577 strncpy(msg.aux.obj_name, aux->obj, sizeof(msg.aux.obj_name));
2578 memcpy(&msg.aux.obj_st, aux->st, sizeof(msg.aux.obj_st));
2579
2580 cmsg_buf = bpf_map_set_init(&msg, addr, addr_len);
2581 amsg_buf = (char *)msg.aux.ent;
2582
4bd62446 2583 for (i = 0; i < entries; i += min_fd) {
6256f8c9
DB
2584 int ret;
2585
4bd62446 2586 min_fd = min(BPF_SCM_MAX_FDS * 1U, entries - i);
6256f8c9
DB
2587 bpf_map_set_init_single(&msg, min_fd);
2588
2589 memcpy(cmsg_buf, &aux->fds[i], sizeof(aux->fds[0]) * min_fd);
2590 memcpy(amsg_buf, &aux->ent[i], sizeof(aux->ent[0]) * min_fd);
2591
2592 ret = sendmsg(fd, &msg.hdr, 0);
2593 if (ret <= 0)
2594 return ret ? : -1;
2595 }
2596
2597 return 0;
11c39b5e
DB
2598}
2599
4bd62446
DB
2600static int
2601bpf_map_set_recv(int fd, int *fds, struct bpf_map_aux *aux,
2602 unsigned int entries)
2603{
2604 struct bpf_map_set_msg msg;
2605 int *cmsg_buf, min_fd;
2606 char *amsg_buf, *mmsg_buf;
2607 unsigned int needed = 1;
2608 int i;
2609
2610 cmsg_buf = bpf_map_set_init(&msg, NULL, 0);
2611 amsg_buf = (char *)msg.aux.ent;
2612 mmsg_buf = (char *)&msg.aux;
2613
2614 for (i = 0; i < min(entries, needed); i += min_fd) {
2615 struct cmsghdr *cmsg;
2616 int ret;
2617
2618 min_fd = min(entries, entries - i);
2619 bpf_map_set_init_single(&msg, min_fd);
2620
2621 ret = recvmsg(fd, &msg.hdr, 0);
2622 if (ret <= 0)
2623 return ret ? : -1;
2624
2625 cmsg = CMSG_FIRSTHDR(&msg.hdr);
2626 if (!cmsg || cmsg->cmsg_type != SCM_RIGHTS)
2627 return -EINVAL;
2628 if (msg.hdr.msg_flags & MSG_CTRUNC)
2629 return -EIO;
2630 if (msg.aux.uds_ver != BPF_SCM_AUX_VER)
2631 return -ENOSYS;
2632
2633 min_fd = (cmsg->cmsg_len - sizeof(*cmsg)) / sizeof(fd);
2634 if (min_fd > entries || min_fd <= 0)
2635 return -EINVAL;
2636
2637 memcpy(&fds[i], cmsg_buf, sizeof(fds[0]) * min_fd);
2638 memcpy(&aux->ent[i], amsg_buf, sizeof(aux->ent[0]) * min_fd);
2639 memcpy(aux, mmsg_buf, offsetof(struct bpf_map_aux, ent));
2640
2641 needed = aux->num_ent;
2642 }
2643
2644 return 0;
2645}
2646
2647int bpf_send_map_fds(const char *path, const char *obj)
6256f8c9 2648{
32e93fb7 2649 struct bpf_elf_ctx *ctx = &__ctx;
d17b136f
PS
2650 struct sockaddr_un addr = { .sun_family = AF_UNIX };
2651 struct bpf_map_data bpf_aux = {
2652 .fds = ctx->map_fds,
2653 .ent = ctx->maps,
2654 .st = &ctx->stat,
2655 .obj = obj,
2656 };
6256f8c9
DB
2657 int fd, ret;
2658
2659 fd = socket(AF_UNIX, SOCK_DGRAM, 0);
2660 if (fd < 0) {
2661 fprintf(stderr, "Cannot open socket: %s\n",
2662 strerror(errno));
2663 return -1;
2664 }
2665
6256f8c9
DB
2666 strncpy(addr.sun_path, path, sizeof(addr.sun_path));
2667
2668 ret = connect(fd, (struct sockaddr *)&addr, sizeof(addr));
2669 if (ret < 0) {
2670 fprintf(stderr, "Cannot connect to %s: %s\n",
2671 path, strerror(errno));
2672 return -1;
2673 }
2674
4bd62446 2675 ret = bpf_map_set_send(fd, &addr, sizeof(addr), &bpf_aux,
32e93fb7 2676 bpf_maps_count(ctx));
6256f8c9 2677 if (ret < 0)
4bd62446
DB
2678 fprintf(stderr, "Cannot send fds to %s: %s\n",
2679 path, strerror(errno));
2680
32e93fb7 2681 bpf_maps_teardown(ctx);
4bd62446
DB
2682 close(fd);
2683 return ret;
2684}
2685
2686int bpf_recv_map_fds(const char *path, int *fds, struct bpf_map_aux *aux,
2687 unsigned int entries)
2688{
d17b136f 2689 struct sockaddr_un addr = { .sun_family = AF_UNIX };
4bd62446
DB
2690 int fd, ret;
2691
2692 fd = socket(AF_UNIX, SOCK_DGRAM, 0);
2693 if (fd < 0) {
2694 fprintf(stderr, "Cannot open socket: %s\n",
2695 strerror(errno));
2696 return -1;
2697 }
2698
4bd62446
DB
2699 strncpy(addr.sun_path, path, sizeof(addr.sun_path));
2700
2701 ret = bind(fd, (struct sockaddr *)&addr, sizeof(addr));
2702 if (ret < 0) {
2703 fprintf(stderr, "Cannot bind to socket: %s\n",
2704 strerror(errno));
2705 return -1;
2706 }
2707
2708 ret = bpf_map_set_recv(fd, fds, aux, entries);
2709 if (ret < 0)
2710 fprintf(stderr, "Cannot recv fds from %s: %s\n",
6256f8c9
DB
2711 path, strerror(errno));
2712
4bd62446 2713 unlink(addr.sun_path);
6256f8c9
DB
2714 close(fd);
2715 return ret;
2716}
11c39b5e 2717#endif /* HAVE_ELF */