162306a36Sopenharmony_ci// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) 262306a36Sopenharmony_ci/* Copyright (C) 2020 Facebook */ 362306a36Sopenharmony_ci#include <errno.h> 462306a36Sopenharmony_ci#include <linux/err.h> 562306a36Sopenharmony_ci#include <stdbool.h> 662306a36Sopenharmony_ci#include <stdio.h> 762306a36Sopenharmony_ci#include <stdlib.h> 862306a36Sopenharmony_ci#include <string.h> 962306a36Sopenharmony_ci#include <unistd.h> 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci#include <bpf/bpf.h> 1262306a36Sopenharmony_ci#include <bpf/hashmap.h> 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include "main.h" 1562306a36Sopenharmony_ci#include "skeleton/pid_iter.h" 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#ifdef BPFTOOL_WITHOUT_SKELETONS 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ciint build_obj_refs_table(struct hashmap **map, enum bpf_obj_type type) 2062306a36Sopenharmony_ci{ 2162306a36Sopenharmony_ci return -ENOTSUP; 2262306a36Sopenharmony_ci} 2362306a36Sopenharmony_civoid delete_obj_refs_table(struct hashmap *map) {} 2462306a36Sopenharmony_civoid emit_obj_refs_plain(struct hashmap *map, __u32 id, const char *prefix) {} 2562306a36Sopenharmony_civoid emit_obj_refs_json(struct hashmap *map, __u32 id, json_writer_t *json_writer) {} 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci#else /* BPFTOOL_WITHOUT_SKELETONS */ 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci#include "pid_iter.skel.h" 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_cistatic void add_ref(struct hashmap *map, struct pid_iter_entry *e) 3262306a36Sopenharmony_ci{ 3362306a36Sopenharmony_ci struct hashmap_entry *entry; 3462306a36Sopenharmony_ci struct obj_refs *refs; 3562306a36Sopenharmony_ci struct obj_ref *ref; 3662306a36Sopenharmony_ci int err, i; 3762306a36Sopenharmony_ci void *tmp; 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci hashmap__for_each_key_entry(map, entry, e->id) { 4062306a36Sopenharmony_ci refs = entry->pvalue; 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci for (i = 0; i < refs->ref_cnt; i++) { 4362306a36Sopenharmony_ci if (refs->refs[i].pid == e->pid) 4462306a36Sopenharmony_ci return; 4562306a36Sopenharmony_ci } 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci tmp = realloc(refs->refs, (refs->ref_cnt + 1) * sizeof(*ref)); 4862306a36Sopenharmony_ci if (!tmp) { 4962306a36Sopenharmony_ci p_err("failed to re-alloc memory for ID %u, PID %d, COMM %s...", 5062306a36Sopenharmony_ci e->id, e->pid, e->comm); 5162306a36Sopenharmony_ci return; 5262306a36Sopenharmony_ci } 5362306a36Sopenharmony_ci refs->refs = tmp; 5462306a36Sopenharmony_ci ref = &refs->refs[refs->ref_cnt]; 5562306a36Sopenharmony_ci ref->pid = e->pid; 5662306a36Sopenharmony_ci memcpy(ref->comm, e->comm, sizeof(ref->comm)); 5762306a36Sopenharmony_ci refs->ref_cnt++; 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci return; 6062306a36Sopenharmony_ci } 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci /* new ref */ 6362306a36Sopenharmony_ci refs = calloc(1, sizeof(*refs)); 6462306a36Sopenharmony_ci if (!refs) { 6562306a36Sopenharmony_ci p_err("failed to alloc memory for ID %u, PID %d, COMM %s...", 6662306a36Sopenharmony_ci e->id, e->pid, e->comm); 6762306a36Sopenharmony_ci return; 6862306a36Sopenharmony_ci } 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci refs->refs = malloc(sizeof(*refs->refs)); 7162306a36Sopenharmony_ci if (!refs->refs) { 7262306a36Sopenharmony_ci free(refs); 7362306a36Sopenharmony_ci p_err("failed to alloc memory for ID %u, PID %d, COMM %s...", 7462306a36Sopenharmony_ci e->id, e->pid, e->comm); 7562306a36Sopenharmony_ci return; 7662306a36Sopenharmony_ci } 7762306a36Sopenharmony_ci ref = &refs->refs[0]; 7862306a36Sopenharmony_ci ref->pid = e->pid; 7962306a36Sopenharmony_ci memcpy(ref->comm, e->comm, sizeof(ref->comm)); 8062306a36Sopenharmony_ci refs->ref_cnt = 1; 8162306a36Sopenharmony_ci refs->has_bpf_cookie = e->has_bpf_cookie; 8262306a36Sopenharmony_ci refs->bpf_cookie = e->bpf_cookie; 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ci err = hashmap__append(map, e->id, refs); 8562306a36Sopenharmony_ci if (err) 8662306a36Sopenharmony_ci p_err("failed to append entry to hashmap for ID %u: %s", 8762306a36Sopenharmony_ci e->id, strerror(errno)); 8862306a36Sopenharmony_ci} 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistatic int __printf(2, 0) 9162306a36Sopenharmony_cilibbpf_print_none(__maybe_unused enum libbpf_print_level level, 9262306a36Sopenharmony_ci __maybe_unused const char *format, 9362306a36Sopenharmony_ci __maybe_unused va_list args) 9462306a36Sopenharmony_ci{ 9562306a36Sopenharmony_ci return 0; 9662306a36Sopenharmony_ci} 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ciint build_obj_refs_table(struct hashmap **map, enum bpf_obj_type type) 9962306a36Sopenharmony_ci{ 10062306a36Sopenharmony_ci struct pid_iter_entry *e; 10162306a36Sopenharmony_ci char buf[4096 / sizeof(*e) * sizeof(*e)]; 10262306a36Sopenharmony_ci struct pid_iter_bpf *skel; 10362306a36Sopenharmony_ci int err, ret, fd = -1, i; 10462306a36Sopenharmony_ci libbpf_print_fn_t default_print; 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci *map = hashmap__new(hash_fn_for_key_as_id, equal_fn_for_key_as_id, NULL); 10762306a36Sopenharmony_ci if (IS_ERR(*map)) { 10862306a36Sopenharmony_ci p_err("failed to create hashmap for PID references"); 10962306a36Sopenharmony_ci return -1; 11062306a36Sopenharmony_ci } 11162306a36Sopenharmony_ci set_max_rlimit(); 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci skel = pid_iter_bpf__open(); 11462306a36Sopenharmony_ci if (!skel) { 11562306a36Sopenharmony_ci p_err("failed to open PID iterator skeleton"); 11662306a36Sopenharmony_ci return -1; 11762306a36Sopenharmony_ci } 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci skel->rodata->obj_type = type; 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci /* we don't want output polluted with libbpf errors if bpf_iter is not 12262306a36Sopenharmony_ci * supported 12362306a36Sopenharmony_ci */ 12462306a36Sopenharmony_ci default_print = libbpf_set_print(libbpf_print_none); 12562306a36Sopenharmony_ci err = pid_iter_bpf__load(skel); 12662306a36Sopenharmony_ci libbpf_set_print(default_print); 12762306a36Sopenharmony_ci if (err) { 12862306a36Sopenharmony_ci /* too bad, kernel doesn't support BPF iterators yet */ 12962306a36Sopenharmony_ci err = 0; 13062306a36Sopenharmony_ci goto out; 13162306a36Sopenharmony_ci } 13262306a36Sopenharmony_ci err = pid_iter_bpf__attach(skel); 13362306a36Sopenharmony_ci if (err) { 13462306a36Sopenharmony_ci /* if we loaded above successfully, attach has to succeed */ 13562306a36Sopenharmony_ci p_err("failed to attach PID iterator: %d", err); 13662306a36Sopenharmony_ci goto out; 13762306a36Sopenharmony_ci } 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci fd = bpf_iter_create(bpf_link__fd(skel->links.iter)); 14062306a36Sopenharmony_ci if (fd < 0) { 14162306a36Sopenharmony_ci err = -errno; 14262306a36Sopenharmony_ci p_err("failed to create PID iterator session: %d", err); 14362306a36Sopenharmony_ci goto out; 14462306a36Sopenharmony_ci } 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_ci while (true) { 14762306a36Sopenharmony_ci ret = read(fd, buf, sizeof(buf)); 14862306a36Sopenharmony_ci if (ret < 0) { 14962306a36Sopenharmony_ci if (errno == EAGAIN) 15062306a36Sopenharmony_ci continue; 15162306a36Sopenharmony_ci err = -errno; 15262306a36Sopenharmony_ci p_err("failed to read PID iterator output: %d", err); 15362306a36Sopenharmony_ci goto out; 15462306a36Sopenharmony_ci } 15562306a36Sopenharmony_ci if (ret == 0) 15662306a36Sopenharmony_ci break; 15762306a36Sopenharmony_ci if (ret % sizeof(*e)) { 15862306a36Sopenharmony_ci err = -EINVAL; 15962306a36Sopenharmony_ci p_err("invalid PID iterator output format"); 16062306a36Sopenharmony_ci goto out; 16162306a36Sopenharmony_ci } 16262306a36Sopenharmony_ci ret /= sizeof(*e); 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci e = (void *)buf; 16562306a36Sopenharmony_ci for (i = 0; i < ret; i++, e++) { 16662306a36Sopenharmony_ci add_ref(*map, e); 16762306a36Sopenharmony_ci } 16862306a36Sopenharmony_ci } 16962306a36Sopenharmony_ci err = 0; 17062306a36Sopenharmony_ciout: 17162306a36Sopenharmony_ci if (fd >= 0) 17262306a36Sopenharmony_ci close(fd); 17362306a36Sopenharmony_ci pid_iter_bpf__destroy(skel); 17462306a36Sopenharmony_ci return err; 17562306a36Sopenharmony_ci} 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_civoid delete_obj_refs_table(struct hashmap *map) 17862306a36Sopenharmony_ci{ 17962306a36Sopenharmony_ci struct hashmap_entry *entry; 18062306a36Sopenharmony_ci size_t bkt; 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci if (!map) 18362306a36Sopenharmony_ci return; 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci hashmap__for_each_entry(map, entry, bkt) { 18662306a36Sopenharmony_ci struct obj_refs *refs = entry->pvalue; 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci free(refs->refs); 18962306a36Sopenharmony_ci free(refs); 19062306a36Sopenharmony_ci } 19162306a36Sopenharmony_ci 19262306a36Sopenharmony_ci hashmap__free(map); 19362306a36Sopenharmony_ci} 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_civoid emit_obj_refs_json(struct hashmap *map, __u32 id, 19662306a36Sopenharmony_ci json_writer_t *json_writer) 19762306a36Sopenharmony_ci{ 19862306a36Sopenharmony_ci struct hashmap_entry *entry; 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci if (hashmap__empty(map)) 20162306a36Sopenharmony_ci return; 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci hashmap__for_each_key_entry(map, entry, id) { 20462306a36Sopenharmony_ci struct obj_refs *refs = entry->pvalue; 20562306a36Sopenharmony_ci int i; 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_ci if (refs->ref_cnt == 0) 20862306a36Sopenharmony_ci break; 20962306a36Sopenharmony_ci 21062306a36Sopenharmony_ci if (refs->has_bpf_cookie) 21162306a36Sopenharmony_ci jsonw_lluint_field(json_writer, "bpf_cookie", refs->bpf_cookie); 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci jsonw_name(json_writer, "pids"); 21462306a36Sopenharmony_ci jsonw_start_array(json_writer); 21562306a36Sopenharmony_ci for (i = 0; i < refs->ref_cnt; i++) { 21662306a36Sopenharmony_ci struct obj_ref *ref = &refs->refs[i]; 21762306a36Sopenharmony_ci 21862306a36Sopenharmony_ci jsonw_start_object(json_writer); 21962306a36Sopenharmony_ci jsonw_int_field(json_writer, "pid", ref->pid); 22062306a36Sopenharmony_ci jsonw_string_field(json_writer, "comm", ref->comm); 22162306a36Sopenharmony_ci jsonw_end_object(json_writer); 22262306a36Sopenharmony_ci } 22362306a36Sopenharmony_ci jsonw_end_array(json_writer); 22462306a36Sopenharmony_ci break; 22562306a36Sopenharmony_ci } 22662306a36Sopenharmony_ci} 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_civoid emit_obj_refs_plain(struct hashmap *map, __u32 id, const char *prefix) 22962306a36Sopenharmony_ci{ 23062306a36Sopenharmony_ci struct hashmap_entry *entry; 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci if (hashmap__empty(map)) 23362306a36Sopenharmony_ci return; 23462306a36Sopenharmony_ci 23562306a36Sopenharmony_ci hashmap__for_each_key_entry(map, entry, id) { 23662306a36Sopenharmony_ci struct obj_refs *refs = entry->pvalue; 23762306a36Sopenharmony_ci int i; 23862306a36Sopenharmony_ci 23962306a36Sopenharmony_ci if (refs->ref_cnt == 0) 24062306a36Sopenharmony_ci break; 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci if (refs->has_bpf_cookie) 24362306a36Sopenharmony_ci printf("\n\tbpf_cookie %llu", (unsigned long long) refs->bpf_cookie); 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci printf("%s", prefix); 24662306a36Sopenharmony_ci for (i = 0; i < refs->ref_cnt; i++) { 24762306a36Sopenharmony_ci struct obj_ref *ref = &refs->refs[i]; 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci printf("%s%s(%d)", i == 0 ? "" : ", ", ref->comm, ref->pid); 25062306a36Sopenharmony_ci } 25162306a36Sopenharmony_ci break; 25262306a36Sopenharmony_ci } 25362306a36Sopenharmony_ci} 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_ci 25662306a36Sopenharmony_ci#endif 257