162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci#define _GNU_SOURCE 362306a36Sopenharmony_ci 462306a36Sopenharmony_ci#include <arpa/inet.h> 562306a36Sopenharmony_ci#include <bpf/bpf.h> 662306a36Sopenharmony_ci#include <bpf/libbpf.h> 762306a36Sopenharmony_ci#include <errno.h> 862306a36Sopenharmony_ci#include <fcntl.h> 962306a36Sopenharmony_ci#include <getopt.h> 1062306a36Sopenharmony_ci#include <linux/ethtool.h> 1162306a36Sopenharmony_ci#include <linux/hashtable.h> 1262306a36Sopenharmony_ci#include <linux/if_link.h> 1362306a36Sopenharmony_ci#include <linux/jhash.h> 1462306a36Sopenharmony_ci#include <linux/limits.h> 1562306a36Sopenharmony_ci#include <linux/list.h> 1662306a36Sopenharmony_ci#include <linux/sockios.h> 1762306a36Sopenharmony_ci#include <locale.h> 1862306a36Sopenharmony_ci#include <math.h> 1962306a36Sopenharmony_ci#include <net/if.h> 2062306a36Sopenharmony_ci#include <poll.h> 2162306a36Sopenharmony_ci#include <signal.h> 2262306a36Sopenharmony_ci#include <stdbool.h> 2362306a36Sopenharmony_ci#include <stdio.h> 2462306a36Sopenharmony_ci#include <stdlib.h> 2562306a36Sopenharmony_ci#include <string.h> 2662306a36Sopenharmony_ci#include <sys/ioctl.h> 2762306a36Sopenharmony_ci#include <sys/mman.h> 2862306a36Sopenharmony_ci#include <sys/signalfd.h> 2962306a36Sopenharmony_ci#include <sys/sysinfo.h> 3062306a36Sopenharmony_ci#include <sys/timerfd.h> 3162306a36Sopenharmony_ci#include <sys/utsname.h> 3262306a36Sopenharmony_ci#include <time.h> 3362306a36Sopenharmony_ci#include <unistd.h> 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci#include "bpf_util.h" 3662306a36Sopenharmony_ci#include "xdp_sample_user.h" 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci#define __sample_print(fmt, cond, ...) \ 3962306a36Sopenharmony_ci ({ \ 4062306a36Sopenharmony_ci if (cond) \ 4162306a36Sopenharmony_ci printf(fmt, ##__VA_ARGS__); \ 4262306a36Sopenharmony_ci }) 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci#define print_always(fmt, ...) __sample_print(fmt, 1, ##__VA_ARGS__) 4562306a36Sopenharmony_ci#define print_default(fmt, ...) \ 4662306a36Sopenharmony_ci __sample_print(fmt, sample_log_level & LL_DEFAULT, ##__VA_ARGS__) 4762306a36Sopenharmony_ci#define __print_err(err, fmt, ...) \ 4862306a36Sopenharmony_ci ({ \ 4962306a36Sopenharmony_ci __sample_print(fmt, err > 0 || sample_log_level & LL_DEFAULT, \ 5062306a36Sopenharmony_ci ##__VA_ARGS__); \ 5162306a36Sopenharmony_ci sample_err_exp = sample_err_exp ? true : err > 0; \ 5262306a36Sopenharmony_ci }) 5362306a36Sopenharmony_ci#define print_err(err, fmt, ...) __print_err(err, fmt, ##__VA_ARGS__) 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_ci#define __COLUMN(x) "%'10" x " %-13s" 5662306a36Sopenharmony_ci#define FMT_COLUMNf __COLUMN(".0f") 5762306a36Sopenharmony_ci#define FMT_COLUMNd __COLUMN("d") 5862306a36Sopenharmony_ci#define FMT_COLUMNl __COLUMN("llu") 5962306a36Sopenharmony_ci#define RX(rx) rx, "rx/s" 6062306a36Sopenharmony_ci#define PPS(pps) pps, "pkt/s" 6162306a36Sopenharmony_ci#define DROP(drop) drop, "drop/s" 6262306a36Sopenharmony_ci#define ERR(err) err, "error/s" 6362306a36Sopenharmony_ci#define HITS(hits) hits, "hit/s" 6462306a36Sopenharmony_ci#define XMIT(xmit) xmit, "xmit/s" 6562306a36Sopenharmony_ci#define PASS(pass) pass, "pass/s" 6662306a36Sopenharmony_ci#define REDIR(redir) redir, "redir/s" 6762306a36Sopenharmony_ci#define NANOSEC_PER_SEC 1000000000 /* 10^9 */ 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci#define XDP_UNKNOWN (XDP_REDIRECT + 1) 7062306a36Sopenharmony_ci#define XDP_ACTION_MAX (XDP_UNKNOWN + 1) 7162306a36Sopenharmony_ci#define XDP_REDIRECT_ERR_MAX 7 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_cienum map_type { 7462306a36Sopenharmony_ci MAP_RX, 7562306a36Sopenharmony_ci MAP_REDIRECT_ERR, 7662306a36Sopenharmony_ci MAP_CPUMAP_ENQUEUE, 7762306a36Sopenharmony_ci MAP_CPUMAP_KTHREAD, 7862306a36Sopenharmony_ci MAP_EXCEPTION, 7962306a36Sopenharmony_ci MAP_DEVMAP_XMIT, 8062306a36Sopenharmony_ci MAP_DEVMAP_XMIT_MULTI, 8162306a36Sopenharmony_ci NUM_MAP, 8262306a36Sopenharmony_ci}; 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_cienum log_level { 8562306a36Sopenharmony_ci LL_DEFAULT = 1U << 0, 8662306a36Sopenharmony_ci LL_SIMPLE = 1U << 1, 8762306a36Sopenharmony_ci LL_DEBUG = 1U << 2, 8862306a36Sopenharmony_ci}; 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistruct record { 9162306a36Sopenharmony_ci __u64 timestamp; 9262306a36Sopenharmony_ci struct datarec total; 9362306a36Sopenharmony_ci struct datarec *cpu; 9462306a36Sopenharmony_ci}; 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_cistruct map_entry { 9762306a36Sopenharmony_ci struct hlist_node node; 9862306a36Sopenharmony_ci __u64 pair; 9962306a36Sopenharmony_ci struct record val; 10062306a36Sopenharmony_ci}; 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cistruct stats_record { 10362306a36Sopenharmony_ci struct record rx_cnt; 10462306a36Sopenharmony_ci struct record redir_err[XDP_REDIRECT_ERR_MAX]; 10562306a36Sopenharmony_ci struct record kthread; 10662306a36Sopenharmony_ci struct record exception[XDP_ACTION_MAX]; 10762306a36Sopenharmony_ci struct record devmap_xmit; 10862306a36Sopenharmony_ci DECLARE_HASHTABLE(xmit_map, 5); 10962306a36Sopenharmony_ci struct record enq[]; 11062306a36Sopenharmony_ci}; 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_cistruct sample_output { 11362306a36Sopenharmony_ci struct { 11462306a36Sopenharmony_ci __u64 rx; 11562306a36Sopenharmony_ci __u64 redir; 11662306a36Sopenharmony_ci __u64 drop; 11762306a36Sopenharmony_ci __u64 drop_xmit; 11862306a36Sopenharmony_ci __u64 err; 11962306a36Sopenharmony_ci __u64 xmit; 12062306a36Sopenharmony_ci } totals; 12162306a36Sopenharmony_ci struct { 12262306a36Sopenharmony_ci union { 12362306a36Sopenharmony_ci __u64 pps; 12462306a36Sopenharmony_ci __u64 num; 12562306a36Sopenharmony_ci }; 12662306a36Sopenharmony_ci __u64 drop; 12762306a36Sopenharmony_ci __u64 err; 12862306a36Sopenharmony_ci } rx_cnt; 12962306a36Sopenharmony_ci struct { 13062306a36Sopenharmony_ci __u64 suc; 13162306a36Sopenharmony_ci __u64 err; 13262306a36Sopenharmony_ci } redir_cnt; 13362306a36Sopenharmony_ci struct { 13462306a36Sopenharmony_ci __u64 hits; 13562306a36Sopenharmony_ci } except_cnt; 13662306a36Sopenharmony_ci struct { 13762306a36Sopenharmony_ci __u64 pps; 13862306a36Sopenharmony_ci __u64 drop; 13962306a36Sopenharmony_ci __u64 err; 14062306a36Sopenharmony_ci double bavg; 14162306a36Sopenharmony_ci } xmit_cnt; 14262306a36Sopenharmony_ci}; 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_cistruct xdp_desc { 14562306a36Sopenharmony_ci int ifindex; 14662306a36Sopenharmony_ci __u32 prog_id; 14762306a36Sopenharmony_ci int flags; 14862306a36Sopenharmony_ci} sample_xdp_progs[32]; 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_cistruct datarec *sample_mmap[NUM_MAP]; 15162306a36Sopenharmony_cistruct bpf_map *sample_map[NUM_MAP]; 15262306a36Sopenharmony_cisize_t sample_map_count[NUM_MAP]; 15362306a36Sopenharmony_cienum log_level sample_log_level; 15462306a36Sopenharmony_cistruct sample_output sample_out; 15562306a36Sopenharmony_ciunsigned long sample_interval; 15662306a36Sopenharmony_cibool sample_err_exp; 15762306a36Sopenharmony_ciint sample_xdp_cnt; 15862306a36Sopenharmony_ciint sample_n_cpus; 15962306a36Sopenharmony_ciint sample_sig_fd; 16062306a36Sopenharmony_ciint sample_mask; 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_cistatic const char *xdp_redirect_err_names[XDP_REDIRECT_ERR_MAX] = { 16362306a36Sopenharmony_ci /* Key=1 keeps unknown errors */ 16462306a36Sopenharmony_ci "Success", 16562306a36Sopenharmony_ci "Unknown", 16662306a36Sopenharmony_ci "EINVAL", 16762306a36Sopenharmony_ci "ENETDOWN", 16862306a36Sopenharmony_ci "EMSGSIZE", 16962306a36Sopenharmony_ci "EOPNOTSUPP", 17062306a36Sopenharmony_ci "ENOSPC", 17162306a36Sopenharmony_ci}; 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci/* Keyed from Unknown */ 17462306a36Sopenharmony_cistatic const char *xdp_redirect_err_help[XDP_REDIRECT_ERR_MAX - 1] = { 17562306a36Sopenharmony_ci "Unknown error", 17662306a36Sopenharmony_ci "Invalid redirection", 17762306a36Sopenharmony_ci "Device being redirected to is down", 17862306a36Sopenharmony_ci "Packet length too large for device", 17962306a36Sopenharmony_ci "Operation not supported", 18062306a36Sopenharmony_ci "No space in ptr_ring of cpumap kthread", 18162306a36Sopenharmony_ci}; 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_cistatic const char *xdp_action_names[XDP_ACTION_MAX] = { 18462306a36Sopenharmony_ci [XDP_ABORTED] = "XDP_ABORTED", 18562306a36Sopenharmony_ci [XDP_DROP] = "XDP_DROP", 18662306a36Sopenharmony_ci [XDP_PASS] = "XDP_PASS", 18762306a36Sopenharmony_ci [XDP_TX] = "XDP_TX", 18862306a36Sopenharmony_ci [XDP_REDIRECT] = "XDP_REDIRECT", 18962306a36Sopenharmony_ci [XDP_UNKNOWN] = "XDP_UNKNOWN", 19062306a36Sopenharmony_ci}; 19162306a36Sopenharmony_ci 19262306a36Sopenharmony_cistatic __u64 gettime(void) 19362306a36Sopenharmony_ci{ 19462306a36Sopenharmony_ci struct timespec t; 19562306a36Sopenharmony_ci int res; 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci res = clock_gettime(CLOCK_MONOTONIC, &t); 19862306a36Sopenharmony_ci if (res < 0) { 19962306a36Sopenharmony_ci fprintf(stderr, "Error with gettimeofday! (%i)\n", res); 20062306a36Sopenharmony_ci return UINT64_MAX; 20162306a36Sopenharmony_ci } 20262306a36Sopenharmony_ci return (__u64)t.tv_sec * NANOSEC_PER_SEC + t.tv_nsec; 20362306a36Sopenharmony_ci} 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_cistatic const char *action2str(int action) 20662306a36Sopenharmony_ci{ 20762306a36Sopenharmony_ci if (action < XDP_ACTION_MAX) 20862306a36Sopenharmony_ci return xdp_action_names[action]; 20962306a36Sopenharmony_ci return NULL; 21062306a36Sopenharmony_ci} 21162306a36Sopenharmony_ci 21262306a36Sopenharmony_cistatic void sample_print_help(int mask) 21362306a36Sopenharmony_ci{ 21462306a36Sopenharmony_ci printf("Output format description\n\n" 21562306a36Sopenharmony_ci "By default, redirect success statistics are disabled, use -s to enable.\n" 21662306a36Sopenharmony_ci "The terse output mode is default, verbose mode can be activated using -v\n" 21762306a36Sopenharmony_ci "Use SIGQUIT (Ctrl + \\) to switch the mode dynamically at runtime\n\n" 21862306a36Sopenharmony_ci "Terse mode displays at most the following fields:\n" 21962306a36Sopenharmony_ci " rx/s Number of packets received per second\n" 22062306a36Sopenharmony_ci " redir/s Number of packets successfully redirected per second\n" 22162306a36Sopenharmony_ci " err,drop/s Aggregated count of errors per second (including dropped packets)\n" 22262306a36Sopenharmony_ci " xmit/s Number of packets transmitted on the output device per second\n\n" 22362306a36Sopenharmony_ci "Output description for verbose mode:\n" 22462306a36Sopenharmony_ci " FIELD DESCRIPTION\n"); 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci if (mask & SAMPLE_RX_CNT) { 22762306a36Sopenharmony_ci printf(" receive\t\tDisplays the number of packets received & errors encountered\n" 22862306a36Sopenharmony_ci " \t\t\tWhenever an error or packet drop occurs, details of per CPU error\n" 22962306a36Sopenharmony_ci " \t\t\tand drop statistics will be expanded inline in terse mode.\n" 23062306a36Sopenharmony_ci " \t\t\t\tpkt/s - Packets received per second\n" 23162306a36Sopenharmony_ci " \t\t\t\tdrop/s - Packets dropped per second\n" 23262306a36Sopenharmony_ci " \t\t\t\terror/s - Errors encountered per second\n\n"); 23362306a36Sopenharmony_ci } 23462306a36Sopenharmony_ci if (mask & (SAMPLE_REDIRECT_CNT | SAMPLE_REDIRECT_ERR_CNT)) { 23562306a36Sopenharmony_ci printf(" redirect\t\tDisplays the number of packets successfully redirected\n" 23662306a36Sopenharmony_ci " \t\t\tErrors encountered are expanded under redirect_err field\n" 23762306a36Sopenharmony_ci " \t\t\tNote that passing -s to enable it has a per packet overhead\n" 23862306a36Sopenharmony_ci " \t\t\t\tredir/s - Packets redirected successfully per second\n\n" 23962306a36Sopenharmony_ci " redirect_err\t\tDisplays the number of packets that failed redirection\n" 24062306a36Sopenharmony_ci " \t\t\tThe errno is expanded under this field with per CPU count\n" 24162306a36Sopenharmony_ci " \t\t\tThe recognized errors are:\n"); 24262306a36Sopenharmony_ci 24362306a36Sopenharmony_ci for (int i = 2; i < XDP_REDIRECT_ERR_MAX; i++) 24462306a36Sopenharmony_ci printf("\t\t\t %s: %s\n", xdp_redirect_err_names[i], 24562306a36Sopenharmony_ci xdp_redirect_err_help[i - 1]); 24662306a36Sopenharmony_ci 24762306a36Sopenharmony_ci printf(" \n\t\t\t\terror/s - Packets that failed redirection per second\n\n"); 24862306a36Sopenharmony_ci } 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci if (mask & SAMPLE_CPUMAP_ENQUEUE_CNT) { 25162306a36Sopenharmony_ci printf(" enqueue to cpu N\tDisplays the number of packets enqueued to bulk queue of CPU N\n" 25262306a36Sopenharmony_ci " \t\t\tExpands to cpu:FROM->N to display enqueue stats for each CPU enqueuing to CPU N\n" 25362306a36Sopenharmony_ci " \t\t\tReceived packets can be associated with the CPU redirect program is enqueuing \n" 25462306a36Sopenharmony_ci " \t\t\tpackets to.\n" 25562306a36Sopenharmony_ci " \t\t\t\tpkt/s - Packets enqueued per second from other CPU to CPU N\n" 25662306a36Sopenharmony_ci " \t\t\t\tdrop/s - Packets dropped when trying to enqueue to CPU N\n" 25762306a36Sopenharmony_ci " \t\t\t\tbulk-avg - Average number of packets processed for each event\n\n"); 25862306a36Sopenharmony_ci } 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci if (mask & SAMPLE_CPUMAP_KTHREAD_CNT) { 26162306a36Sopenharmony_ci printf(" kthread\t\tDisplays the number of packets processed in CPUMAP kthread for each CPU\n" 26262306a36Sopenharmony_ci " \t\t\tPackets consumed from ptr_ring in kthread, and its xdp_stats (after calling \n" 26362306a36Sopenharmony_ci " \t\t\tCPUMAP bpf prog) are expanded below this. xdp_stats are expanded as a total and\n" 26462306a36Sopenharmony_ci " \t\t\tthen per-CPU to associate it to each CPU's pinned CPUMAP kthread.\n" 26562306a36Sopenharmony_ci " \t\t\t\tpkt/s - Packets consumed per second from ptr_ring\n" 26662306a36Sopenharmony_ci " \t\t\t\tdrop/s - Packets dropped per second in kthread\n" 26762306a36Sopenharmony_ci " \t\t\t\tsched - Number of times kthread called schedule()\n\n" 26862306a36Sopenharmony_ci " \t\t\txdp_stats (also expands to per-CPU counts)\n" 26962306a36Sopenharmony_ci " \t\t\t\tpass/s - XDP_PASS count for CPUMAP program execution\n" 27062306a36Sopenharmony_ci " \t\t\t\tdrop/s - XDP_DROP count for CPUMAP program execution\n" 27162306a36Sopenharmony_ci " \t\t\t\tredir/s - XDP_REDIRECT count for CPUMAP program execution\n\n"); 27262306a36Sopenharmony_ci } 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci if (mask & SAMPLE_EXCEPTION_CNT) { 27562306a36Sopenharmony_ci printf(" xdp_exception\t\tDisplays xdp_exception tracepoint events\n" 27662306a36Sopenharmony_ci " \t\t\tThis can occur due to internal driver errors, unrecognized\n" 27762306a36Sopenharmony_ci " \t\t\tXDP actions and due to explicit user trigger by use of XDP_ABORTED\n" 27862306a36Sopenharmony_ci " \t\t\tEach action is expanded below this field with its count\n" 27962306a36Sopenharmony_ci " \t\t\t\thit/s - Number of times the tracepoint was hit per second\n\n"); 28062306a36Sopenharmony_ci } 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci if (mask & SAMPLE_DEVMAP_XMIT_CNT) { 28362306a36Sopenharmony_ci printf(" devmap_xmit\t\tDisplays devmap_xmit tracepoint events\n" 28462306a36Sopenharmony_ci " \t\t\tThis tracepoint is invoked for successful transmissions on output\n" 28562306a36Sopenharmony_ci " \t\t\tdevice but these statistics are not available for generic XDP mode,\n" 28662306a36Sopenharmony_ci " \t\t\thence they will be omitted from the output when using SKB mode\n" 28762306a36Sopenharmony_ci " \t\t\t\txmit/s - Number of packets that were transmitted per second\n" 28862306a36Sopenharmony_ci " \t\t\t\tdrop/s - Number of packets that failed transmissions per second\n" 28962306a36Sopenharmony_ci " \t\t\t\tdrv_err/s - Number of internal driver errors per second\n" 29062306a36Sopenharmony_ci " \t\t\t\tbulk-avg - Average number of packets processed for each event\n\n"); 29162306a36Sopenharmony_ci } 29262306a36Sopenharmony_ci} 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_civoid sample_usage(char *argv[], const struct option *long_options, 29562306a36Sopenharmony_ci const char *doc, int mask, bool error) 29662306a36Sopenharmony_ci{ 29762306a36Sopenharmony_ci int i; 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci if (!error) 30062306a36Sopenharmony_ci sample_print_help(mask); 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_ci printf("\n%s\nOption for %s:\n", doc, argv[0]); 30362306a36Sopenharmony_ci for (i = 0; long_options[i].name != 0; i++) { 30462306a36Sopenharmony_ci printf(" --%-15s", long_options[i].name); 30562306a36Sopenharmony_ci if (long_options[i].flag != NULL) 30662306a36Sopenharmony_ci printf(" flag (internal value: %d)", 30762306a36Sopenharmony_ci *long_options[i].flag); 30862306a36Sopenharmony_ci else 30962306a36Sopenharmony_ci printf("\t short-option: -%c", long_options[i].val); 31062306a36Sopenharmony_ci printf("\n"); 31162306a36Sopenharmony_ci } 31262306a36Sopenharmony_ci printf("\n"); 31362306a36Sopenharmony_ci} 31462306a36Sopenharmony_ci 31562306a36Sopenharmony_cistatic struct datarec *alloc_record_per_cpu(void) 31662306a36Sopenharmony_ci{ 31762306a36Sopenharmony_ci unsigned int nr_cpus = libbpf_num_possible_cpus(); 31862306a36Sopenharmony_ci struct datarec *array; 31962306a36Sopenharmony_ci 32062306a36Sopenharmony_ci array = calloc(nr_cpus, sizeof(*array)); 32162306a36Sopenharmony_ci if (!array) { 32262306a36Sopenharmony_ci fprintf(stderr, "Failed to allocate memory (nr_cpus: %u)\n", 32362306a36Sopenharmony_ci nr_cpus); 32462306a36Sopenharmony_ci return NULL; 32562306a36Sopenharmony_ci } 32662306a36Sopenharmony_ci return array; 32762306a36Sopenharmony_ci} 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_cistatic int map_entry_init(struct map_entry *e, __u64 pair) 33062306a36Sopenharmony_ci{ 33162306a36Sopenharmony_ci e->pair = pair; 33262306a36Sopenharmony_ci INIT_HLIST_NODE(&e->node); 33362306a36Sopenharmony_ci e->val.timestamp = gettime(); 33462306a36Sopenharmony_ci e->val.cpu = alloc_record_per_cpu(); 33562306a36Sopenharmony_ci if (!e->val.cpu) 33662306a36Sopenharmony_ci return -ENOMEM; 33762306a36Sopenharmony_ci return 0; 33862306a36Sopenharmony_ci} 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_cistatic void map_collect_percpu(struct datarec *values, struct record *rec) 34162306a36Sopenharmony_ci{ 34262306a36Sopenharmony_ci /* For percpu maps, userspace gets a value per possible CPU */ 34362306a36Sopenharmony_ci unsigned int nr_cpus = libbpf_num_possible_cpus(); 34462306a36Sopenharmony_ci __u64 sum_xdp_redirect = 0; 34562306a36Sopenharmony_ci __u64 sum_processed = 0; 34662306a36Sopenharmony_ci __u64 sum_xdp_pass = 0; 34762306a36Sopenharmony_ci __u64 sum_xdp_drop = 0; 34862306a36Sopenharmony_ci __u64 sum_dropped = 0; 34962306a36Sopenharmony_ci __u64 sum_issue = 0; 35062306a36Sopenharmony_ci int i; 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci /* Get time as close as possible to reading map contents */ 35362306a36Sopenharmony_ci rec->timestamp = gettime(); 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci /* Record and sum values from each CPU */ 35662306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 35762306a36Sopenharmony_ci rec->cpu[i].processed = READ_ONCE(values[i].processed); 35862306a36Sopenharmony_ci rec->cpu[i].dropped = READ_ONCE(values[i].dropped); 35962306a36Sopenharmony_ci rec->cpu[i].issue = READ_ONCE(values[i].issue); 36062306a36Sopenharmony_ci rec->cpu[i].xdp_pass = READ_ONCE(values[i].xdp_pass); 36162306a36Sopenharmony_ci rec->cpu[i].xdp_drop = READ_ONCE(values[i].xdp_drop); 36262306a36Sopenharmony_ci rec->cpu[i].xdp_redirect = READ_ONCE(values[i].xdp_redirect); 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_ci sum_processed += rec->cpu[i].processed; 36562306a36Sopenharmony_ci sum_dropped += rec->cpu[i].dropped; 36662306a36Sopenharmony_ci sum_issue += rec->cpu[i].issue; 36762306a36Sopenharmony_ci sum_xdp_pass += rec->cpu[i].xdp_pass; 36862306a36Sopenharmony_ci sum_xdp_drop += rec->cpu[i].xdp_drop; 36962306a36Sopenharmony_ci sum_xdp_redirect += rec->cpu[i].xdp_redirect; 37062306a36Sopenharmony_ci } 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci rec->total.processed = sum_processed; 37362306a36Sopenharmony_ci rec->total.dropped = sum_dropped; 37462306a36Sopenharmony_ci rec->total.issue = sum_issue; 37562306a36Sopenharmony_ci rec->total.xdp_pass = sum_xdp_pass; 37662306a36Sopenharmony_ci rec->total.xdp_drop = sum_xdp_drop; 37762306a36Sopenharmony_ci rec->total.xdp_redirect = sum_xdp_redirect; 37862306a36Sopenharmony_ci} 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_cistatic int map_collect_percpu_devmap(int map_fd, struct stats_record *rec) 38162306a36Sopenharmony_ci{ 38262306a36Sopenharmony_ci unsigned int nr_cpus = bpf_num_possible_cpus(); 38362306a36Sopenharmony_ci __u32 batch, count = 32; 38462306a36Sopenharmony_ci struct datarec *values; 38562306a36Sopenharmony_ci bool init = false; 38662306a36Sopenharmony_ci __u64 *keys; 38762306a36Sopenharmony_ci int i, ret; 38862306a36Sopenharmony_ci 38962306a36Sopenharmony_ci keys = calloc(count, sizeof(__u64)); 39062306a36Sopenharmony_ci if (!keys) 39162306a36Sopenharmony_ci return -ENOMEM; 39262306a36Sopenharmony_ci values = calloc(count * nr_cpus, sizeof(struct datarec)); 39362306a36Sopenharmony_ci if (!values) { 39462306a36Sopenharmony_ci free(keys); 39562306a36Sopenharmony_ci return -ENOMEM; 39662306a36Sopenharmony_ci } 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci for (;;) { 39962306a36Sopenharmony_ci bool exit = false; 40062306a36Sopenharmony_ci 40162306a36Sopenharmony_ci ret = bpf_map_lookup_batch(map_fd, init ? &batch : NULL, &batch, 40262306a36Sopenharmony_ci keys, values, &count, NULL); 40362306a36Sopenharmony_ci if (ret < 0 && errno != ENOENT) 40462306a36Sopenharmony_ci break; 40562306a36Sopenharmony_ci if (errno == ENOENT) 40662306a36Sopenharmony_ci exit = true; 40762306a36Sopenharmony_ci 40862306a36Sopenharmony_ci init = true; 40962306a36Sopenharmony_ci for (i = 0; i < count; i++) { 41062306a36Sopenharmony_ci struct map_entry *e, *x = NULL; 41162306a36Sopenharmony_ci __u64 pair = keys[i]; 41262306a36Sopenharmony_ci struct datarec *arr; 41362306a36Sopenharmony_ci 41462306a36Sopenharmony_ci arr = &values[i * nr_cpus]; 41562306a36Sopenharmony_ci hash_for_each_possible(rec->xmit_map, e, node, pair) { 41662306a36Sopenharmony_ci if (e->pair == pair) { 41762306a36Sopenharmony_ci x = e; 41862306a36Sopenharmony_ci break; 41962306a36Sopenharmony_ci } 42062306a36Sopenharmony_ci } 42162306a36Sopenharmony_ci if (!x) { 42262306a36Sopenharmony_ci x = calloc(1, sizeof(*x)); 42362306a36Sopenharmony_ci if (!x) 42462306a36Sopenharmony_ci goto cleanup; 42562306a36Sopenharmony_ci if (map_entry_init(x, pair) < 0) { 42662306a36Sopenharmony_ci free(x); 42762306a36Sopenharmony_ci goto cleanup; 42862306a36Sopenharmony_ci } 42962306a36Sopenharmony_ci hash_add(rec->xmit_map, &x->node, pair); 43062306a36Sopenharmony_ci } 43162306a36Sopenharmony_ci map_collect_percpu(arr, &x->val); 43262306a36Sopenharmony_ci } 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_ci if (exit) 43562306a36Sopenharmony_ci break; 43662306a36Sopenharmony_ci count = 32; 43762306a36Sopenharmony_ci } 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci free(values); 44062306a36Sopenharmony_ci free(keys); 44162306a36Sopenharmony_ci return 0; 44262306a36Sopenharmony_cicleanup: 44362306a36Sopenharmony_ci free(values); 44462306a36Sopenharmony_ci free(keys); 44562306a36Sopenharmony_ci return -ENOMEM; 44662306a36Sopenharmony_ci} 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_cistatic struct stats_record *alloc_stats_record(void) 44962306a36Sopenharmony_ci{ 45062306a36Sopenharmony_ci struct stats_record *rec; 45162306a36Sopenharmony_ci int i; 45262306a36Sopenharmony_ci 45362306a36Sopenharmony_ci rec = calloc(1, sizeof(*rec) + sample_n_cpus * sizeof(struct record)); 45462306a36Sopenharmony_ci if (!rec) { 45562306a36Sopenharmony_ci fprintf(stderr, "Failed to allocate memory\n"); 45662306a36Sopenharmony_ci return NULL; 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci 45962306a36Sopenharmony_ci if (sample_mask & SAMPLE_RX_CNT) { 46062306a36Sopenharmony_ci rec->rx_cnt.cpu = alloc_record_per_cpu(); 46162306a36Sopenharmony_ci if (!rec->rx_cnt.cpu) { 46262306a36Sopenharmony_ci fprintf(stderr, 46362306a36Sopenharmony_ci "Failed to allocate rx_cnt per-CPU array\n"); 46462306a36Sopenharmony_ci goto end_rec; 46562306a36Sopenharmony_ci } 46662306a36Sopenharmony_ci } 46762306a36Sopenharmony_ci if (sample_mask & (SAMPLE_REDIRECT_CNT | SAMPLE_REDIRECT_ERR_CNT)) { 46862306a36Sopenharmony_ci for (i = 0; i < XDP_REDIRECT_ERR_MAX; i++) { 46962306a36Sopenharmony_ci rec->redir_err[i].cpu = alloc_record_per_cpu(); 47062306a36Sopenharmony_ci if (!rec->redir_err[i].cpu) { 47162306a36Sopenharmony_ci fprintf(stderr, 47262306a36Sopenharmony_ci "Failed to allocate redir_err per-CPU array for " 47362306a36Sopenharmony_ci "\"%s\" case\n", 47462306a36Sopenharmony_ci xdp_redirect_err_names[i]); 47562306a36Sopenharmony_ci while (i--) 47662306a36Sopenharmony_ci free(rec->redir_err[i].cpu); 47762306a36Sopenharmony_ci goto end_rx_cnt; 47862306a36Sopenharmony_ci } 47962306a36Sopenharmony_ci } 48062306a36Sopenharmony_ci } 48162306a36Sopenharmony_ci if (sample_mask & SAMPLE_CPUMAP_KTHREAD_CNT) { 48262306a36Sopenharmony_ci rec->kthread.cpu = alloc_record_per_cpu(); 48362306a36Sopenharmony_ci if (!rec->kthread.cpu) { 48462306a36Sopenharmony_ci fprintf(stderr, 48562306a36Sopenharmony_ci "Failed to allocate kthread per-CPU array\n"); 48662306a36Sopenharmony_ci goto end_redir; 48762306a36Sopenharmony_ci } 48862306a36Sopenharmony_ci } 48962306a36Sopenharmony_ci if (sample_mask & SAMPLE_EXCEPTION_CNT) { 49062306a36Sopenharmony_ci for (i = 0; i < XDP_ACTION_MAX; i++) { 49162306a36Sopenharmony_ci rec->exception[i].cpu = alloc_record_per_cpu(); 49262306a36Sopenharmony_ci if (!rec->exception[i].cpu) { 49362306a36Sopenharmony_ci fprintf(stderr, 49462306a36Sopenharmony_ci "Failed to allocate exception per-CPU array for " 49562306a36Sopenharmony_ci "\"%s\" case\n", 49662306a36Sopenharmony_ci action2str(i)); 49762306a36Sopenharmony_ci while (i--) 49862306a36Sopenharmony_ci free(rec->exception[i].cpu); 49962306a36Sopenharmony_ci goto end_kthread; 50062306a36Sopenharmony_ci } 50162306a36Sopenharmony_ci } 50262306a36Sopenharmony_ci } 50362306a36Sopenharmony_ci if (sample_mask & SAMPLE_DEVMAP_XMIT_CNT) { 50462306a36Sopenharmony_ci rec->devmap_xmit.cpu = alloc_record_per_cpu(); 50562306a36Sopenharmony_ci if (!rec->devmap_xmit.cpu) { 50662306a36Sopenharmony_ci fprintf(stderr, 50762306a36Sopenharmony_ci "Failed to allocate devmap_xmit per-CPU array\n"); 50862306a36Sopenharmony_ci goto end_exception; 50962306a36Sopenharmony_ci } 51062306a36Sopenharmony_ci } 51162306a36Sopenharmony_ci if (sample_mask & SAMPLE_DEVMAP_XMIT_CNT_MULTI) 51262306a36Sopenharmony_ci hash_init(rec->xmit_map); 51362306a36Sopenharmony_ci if (sample_mask & SAMPLE_CPUMAP_ENQUEUE_CNT) { 51462306a36Sopenharmony_ci for (i = 0; i < sample_n_cpus; i++) { 51562306a36Sopenharmony_ci rec->enq[i].cpu = alloc_record_per_cpu(); 51662306a36Sopenharmony_ci if (!rec->enq[i].cpu) { 51762306a36Sopenharmony_ci fprintf(stderr, 51862306a36Sopenharmony_ci "Failed to allocate enqueue per-CPU array for " 51962306a36Sopenharmony_ci "CPU %d\n", 52062306a36Sopenharmony_ci i); 52162306a36Sopenharmony_ci while (i--) 52262306a36Sopenharmony_ci free(rec->enq[i].cpu); 52362306a36Sopenharmony_ci goto end_devmap_xmit; 52462306a36Sopenharmony_ci } 52562306a36Sopenharmony_ci } 52662306a36Sopenharmony_ci } 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci return rec; 52962306a36Sopenharmony_ci 53062306a36Sopenharmony_ciend_devmap_xmit: 53162306a36Sopenharmony_ci free(rec->devmap_xmit.cpu); 53262306a36Sopenharmony_ciend_exception: 53362306a36Sopenharmony_ci for (i = 0; i < XDP_ACTION_MAX; i++) 53462306a36Sopenharmony_ci free(rec->exception[i].cpu); 53562306a36Sopenharmony_ciend_kthread: 53662306a36Sopenharmony_ci free(rec->kthread.cpu); 53762306a36Sopenharmony_ciend_redir: 53862306a36Sopenharmony_ci for (i = 0; i < XDP_REDIRECT_ERR_MAX; i++) 53962306a36Sopenharmony_ci free(rec->redir_err[i].cpu); 54062306a36Sopenharmony_ciend_rx_cnt: 54162306a36Sopenharmony_ci free(rec->rx_cnt.cpu); 54262306a36Sopenharmony_ciend_rec: 54362306a36Sopenharmony_ci free(rec); 54462306a36Sopenharmony_ci return NULL; 54562306a36Sopenharmony_ci} 54662306a36Sopenharmony_ci 54762306a36Sopenharmony_cistatic void free_stats_record(struct stats_record *r) 54862306a36Sopenharmony_ci{ 54962306a36Sopenharmony_ci struct hlist_node *tmp; 55062306a36Sopenharmony_ci struct map_entry *e; 55162306a36Sopenharmony_ci int i; 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_ci for (i = 0; i < sample_n_cpus; i++) 55462306a36Sopenharmony_ci free(r->enq[i].cpu); 55562306a36Sopenharmony_ci hash_for_each_safe(r->xmit_map, i, tmp, e, node) { 55662306a36Sopenharmony_ci hash_del(&e->node); 55762306a36Sopenharmony_ci free(e->val.cpu); 55862306a36Sopenharmony_ci free(e); 55962306a36Sopenharmony_ci } 56062306a36Sopenharmony_ci free(r->devmap_xmit.cpu); 56162306a36Sopenharmony_ci for (i = 0; i < XDP_ACTION_MAX; i++) 56262306a36Sopenharmony_ci free(r->exception[i].cpu); 56362306a36Sopenharmony_ci free(r->kthread.cpu); 56462306a36Sopenharmony_ci for (i = 0; i < XDP_REDIRECT_ERR_MAX; i++) 56562306a36Sopenharmony_ci free(r->redir_err[i].cpu); 56662306a36Sopenharmony_ci free(r->rx_cnt.cpu); 56762306a36Sopenharmony_ci free(r); 56862306a36Sopenharmony_ci} 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_cistatic double calc_period(struct record *r, struct record *p) 57162306a36Sopenharmony_ci{ 57262306a36Sopenharmony_ci double period_ = 0; 57362306a36Sopenharmony_ci __u64 period = 0; 57462306a36Sopenharmony_ci 57562306a36Sopenharmony_ci period = r->timestamp - p->timestamp; 57662306a36Sopenharmony_ci if (period > 0) 57762306a36Sopenharmony_ci period_ = ((double)period / NANOSEC_PER_SEC); 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci return period_; 58062306a36Sopenharmony_ci} 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_cistatic double sample_round(double val) 58362306a36Sopenharmony_ci{ 58462306a36Sopenharmony_ci if (val - floor(val) < 0.5) 58562306a36Sopenharmony_ci return floor(val); 58662306a36Sopenharmony_ci return ceil(val); 58762306a36Sopenharmony_ci} 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_cistatic __u64 calc_pps(struct datarec *r, struct datarec *p, double period_) 59062306a36Sopenharmony_ci{ 59162306a36Sopenharmony_ci __u64 packets = 0; 59262306a36Sopenharmony_ci __u64 pps = 0; 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_ci if (period_ > 0) { 59562306a36Sopenharmony_ci packets = r->processed - p->processed; 59662306a36Sopenharmony_ci pps = sample_round(packets / period_); 59762306a36Sopenharmony_ci } 59862306a36Sopenharmony_ci return pps; 59962306a36Sopenharmony_ci} 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_cistatic __u64 calc_drop_pps(struct datarec *r, struct datarec *p, double period_) 60262306a36Sopenharmony_ci{ 60362306a36Sopenharmony_ci __u64 packets = 0; 60462306a36Sopenharmony_ci __u64 pps = 0; 60562306a36Sopenharmony_ci 60662306a36Sopenharmony_ci if (period_ > 0) { 60762306a36Sopenharmony_ci packets = r->dropped - p->dropped; 60862306a36Sopenharmony_ci pps = sample_round(packets / period_); 60962306a36Sopenharmony_ci } 61062306a36Sopenharmony_ci return pps; 61162306a36Sopenharmony_ci} 61262306a36Sopenharmony_ci 61362306a36Sopenharmony_cistatic __u64 calc_errs_pps(struct datarec *r, struct datarec *p, double period_) 61462306a36Sopenharmony_ci{ 61562306a36Sopenharmony_ci __u64 packets = 0; 61662306a36Sopenharmony_ci __u64 pps = 0; 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci if (period_ > 0) { 61962306a36Sopenharmony_ci packets = r->issue - p->issue; 62062306a36Sopenharmony_ci pps = sample_round(packets / period_); 62162306a36Sopenharmony_ci } 62262306a36Sopenharmony_ci return pps; 62362306a36Sopenharmony_ci} 62462306a36Sopenharmony_ci 62562306a36Sopenharmony_cistatic __u64 calc_info_pps(struct datarec *r, struct datarec *p, double period_) 62662306a36Sopenharmony_ci{ 62762306a36Sopenharmony_ci __u64 packets = 0; 62862306a36Sopenharmony_ci __u64 pps = 0; 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci if (period_ > 0) { 63162306a36Sopenharmony_ci packets = r->info - p->info; 63262306a36Sopenharmony_ci pps = sample_round(packets / period_); 63362306a36Sopenharmony_ci } 63462306a36Sopenharmony_ci return pps; 63562306a36Sopenharmony_ci} 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_cistatic void calc_xdp_pps(struct datarec *r, struct datarec *p, double *xdp_pass, 63862306a36Sopenharmony_ci double *xdp_drop, double *xdp_redirect, double period_) 63962306a36Sopenharmony_ci{ 64062306a36Sopenharmony_ci *xdp_pass = 0, *xdp_drop = 0, *xdp_redirect = 0; 64162306a36Sopenharmony_ci if (period_ > 0) { 64262306a36Sopenharmony_ci *xdp_redirect = (r->xdp_redirect - p->xdp_redirect) / period_; 64362306a36Sopenharmony_ci *xdp_pass = (r->xdp_pass - p->xdp_pass) / period_; 64462306a36Sopenharmony_ci *xdp_drop = (r->xdp_drop - p->xdp_drop) / period_; 64562306a36Sopenharmony_ci } 64662306a36Sopenharmony_ci} 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_cistatic void stats_get_rx_cnt(struct stats_record *stats_rec, 64962306a36Sopenharmony_ci struct stats_record *stats_prev, 65062306a36Sopenharmony_ci unsigned int nr_cpus, struct sample_output *out) 65162306a36Sopenharmony_ci{ 65262306a36Sopenharmony_ci struct record *rec, *prev; 65362306a36Sopenharmony_ci double t, pps, drop, err; 65462306a36Sopenharmony_ci int i; 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci rec = &stats_rec->rx_cnt; 65762306a36Sopenharmony_ci prev = &stats_prev->rx_cnt; 65862306a36Sopenharmony_ci t = calc_period(rec, prev); 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 66162306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 66262306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 66362306a36Sopenharmony_ci char str[64]; 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_ci pps = calc_pps(r, p, t); 66662306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 66762306a36Sopenharmony_ci err = calc_errs_pps(r, p, t); 66862306a36Sopenharmony_ci if (!pps && !drop && !err) 66962306a36Sopenharmony_ci continue; 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 67262306a36Sopenharmony_ci print_default(" %-18s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 67362306a36Sopenharmony_ci "\n", 67462306a36Sopenharmony_ci str, PPS(pps), DROP(drop), ERR(err)); 67562306a36Sopenharmony_ci } 67662306a36Sopenharmony_ci 67762306a36Sopenharmony_ci if (out) { 67862306a36Sopenharmony_ci pps = calc_pps(&rec->total, &prev->total, t); 67962306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 68062306a36Sopenharmony_ci err = calc_errs_pps(&rec->total, &prev->total, t); 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci out->rx_cnt.pps = pps; 68362306a36Sopenharmony_ci out->rx_cnt.drop = drop; 68462306a36Sopenharmony_ci out->rx_cnt.err = err; 68562306a36Sopenharmony_ci out->totals.rx += pps; 68662306a36Sopenharmony_ci out->totals.drop += drop; 68762306a36Sopenharmony_ci out->totals.err += err; 68862306a36Sopenharmony_ci } 68962306a36Sopenharmony_ci} 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_cistatic void stats_get_cpumap_enqueue(struct stats_record *stats_rec, 69262306a36Sopenharmony_ci struct stats_record *stats_prev, 69362306a36Sopenharmony_ci unsigned int nr_cpus) 69462306a36Sopenharmony_ci{ 69562306a36Sopenharmony_ci struct record *rec, *prev; 69662306a36Sopenharmony_ci double t, pps, drop, err; 69762306a36Sopenharmony_ci int i, to_cpu; 69862306a36Sopenharmony_ci 69962306a36Sopenharmony_ci /* cpumap enqueue stats */ 70062306a36Sopenharmony_ci for (to_cpu = 0; to_cpu < sample_n_cpus; to_cpu++) { 70162306a36Sopenharmony_ci rec = &stats_rec->enq[to_cpu]; 70262306a36Sopenharmony_ci prev = &stats_prev->enq[to_cpu]; 70362306a36Sopenharmony_ci t = calc_period(rec, prev); 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci pps = calc_pps(&rec->total, &prev->total, t); 70662306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 70762306a36Sopenharmony_ci err = calc_errs_pps(&rec->total, &prev->total, t); 70862306a36Sopenharmony_ci 70962306a36Sopenharmony_ci if (pps > 0 || drop > 0) { 71062306a36Sopenharmony_ci char str[64]; 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_ci snprintf(str, sizeof(str), "enqueue to cpu %d", to_cpu); 71362306a36Sopenharmony_ci 71462306a36Sopenharmony_ci if (err > 0) 71562306a36Sopenharmony_ci err = pps / err; /* calc average bulk size */ 71662306a36Sopenharmony_ci 71762306a36Sopenharmony_ci print_err(drop, 71862306a36Sopenharmony_ci " %-20s " FMT_COLUMNf FMT_COLUMNf __COLUMN( 71962306a36Sopenharmony_ci ".2f") "\n", 72062306a36Sopenharmony_ci str, PPS(pps), DROP(drop), err, "bulk-avg"); 72162306a36Sopenharmony_ci } 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 72462306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 72562306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 72662306a36Sopenharmony_ci char str[64]; 72762306a36Sopenharmony_ci 72862306a36Sopenharmony_ci pps = calc_pps(r, p, t); 72962306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 73062306a36Sopenharmony_ci err = calc_errs_pps(r, p, t); 73162306a36Sopenharmony_ci if (!pps && !drop && !err) 73262306a36Sopenharmony_ci continue; 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d->%d", i, to_cpu); 73562306a36Sopenharmony_ci if (err > 0) 73662306a36Sopenharmony_ci err = pps / err; /* calc average bulk size */ 73762306a36Sopenharmony_ci print_default( 73862306a36Sopenharmony_ci " %-18s " FMT_COLUMNf FMT_COLUMNf __COLUMN( 73962306a36Sopenharmony_ci ".2f") "\n", 74062306a36Sopenharmony_ci str, PPS(pps), DROP(drop), err, "bulk-avg"); 74162306a36Sopenharmony_ci } 74262306a36Sopenharmony_ci } 74362306a36Sopenharmony_ci} 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_cistatic void stats_get_cpumap_remote(struct stats_record *stats_rec, 74662306a36Sopenharmony_ci struct stats_record *stats_prev, 74762306a36Sopenharmony_ci unsigned int nr_cpus) 74862306a36Sopenharmony_ci{ 74962306a36Sopenharmony_ci double xdp_pass, xdp_drop, xdp_redirect; 75062306a36Sopenharmony_ci struct record *rec, *prev; 75162306a36Sopenharmony_ci double t; 75262306a36Sopenharmony_ci int i; 75362306a36Sopenharmony_ci 75462306a36Sopenharmony_ci rec = &stats_rec->kthread; 75562306a36Sopenharmony_ci prev = &stats_prev->kthread; 75662306a36Sopenharmony_ci t = calc_period(rec, prev); 75762306a36Sopenharmony_ci 75862306a36Sopenharmony_ci calc_xdp_pps(&rec->total, &prev->total, &xdp_pass, &xdp_drop, 75962306a36Sopenharmony_ci &xdp_redirect, t); 76062306a36Sopenharmony_ci if (xdp_pass || xdp_drop || xdp_redirect) { 76162306a36Sopenharmony_ci print_err(xdp_drop, 76262306a36Sopenharmony_ci " %-18s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf "\n", 76362306a36Sopenharmony_ci "xdp_stats", PASS(xdp_pass), DROP(xdp_drop), 76462306a36Sopenharmony_ci REDIR(xdp_redirect)); 76562306a36Sopenharmony_ci } 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 76862306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 76962306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 77062306a36Sopenharmony_ci char str[64]; 77162306a36Sopenharmony_ci 77262306a36Sopenharmony_ci calc_xdp_pps(r, p, &xdp_pass, &xdp_drop, &xdp_redirect, t); 77362306a36Sopenharmony_ci if (!xdp_pass && !xdp_drop && !xdp_redirect) 77462306a36Sopenharmony_ci continue; 77562306a36Sopenharmony_ci 77662306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 77762306a36Sopenharmony_ci print_default(" %-16s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 77862306a36Sopenharmony_ci "\n", 77962306a36Sopenharmony_ci str, PASS(xdp_pass), DROP(xdp_drop), 78062306a36Sopenharmony_ci REDIR(xdp_redirect)); 78162306a36Sopenharmony_ci } 78262306a36Sopenharmony_ci} 78362306a36Sopenharmony_ci 78462306a36Sopenharmony_cistatic void stats_get_cpumap_kthread(struct stats_record *stats_rec, 78562306a36Sopenharmony_ci struct stats_record *stats_prev, 78662306a36Sopenharmony_ci unsigned int nr_cpus) 78762306a36Sopenharmony_ci{ 78862306a36Sopenharmony_ci struct record *rec, *prev; 78962306a36Sopenharmony_ci double t, pps, drop, err; 79062306a36Sopenharmony_ci int i; 79162306a36Sopenharmony_ci 79262306a36Sopenharmony_ci rec = &stats_rec->kthread; 79362306a36Sopenharmony_ci prev = &stats_prev->kthread; 79462306a36Sopenharmony_ci t = calc_period(rec, prev); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci pps = calc_pps(&rec->total, &prev->total, t); 79762306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 79862306a36Sopenharmony_ci err = calc_errs_pps(&rec->total, &prev->total, t); 79962306a36Sopenharmony_ci 80062306a36Sopenharmony_ci print_err(drop, " %-20s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf "\n", 80162306a36Sopenharmony_ci pps ? "kthread total" : "kthread", PPS(pps), DROP(drop), err, 80262306a36Sopenharmony_ci "sched"); 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 80562306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 80662306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 80762306a36Sopenharmony_ci char str[64]; 80862306a36Sopenharmony_ci 80962306a36Sopenharmony_ci pps = calc_pps(r, p, t); 81062306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 81162306a36Sopenharmony_ci err = calc_errs_pps(r, p, t); 81262306a36Sopenharmony_ci if (!pps && !drop && !err) 81362306a36Sopenharmony_ci continue; 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 81662306a36Sopenharmony_ci print_default(" %-18s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 81762306a36Sopenharmony_ci "\n", 81862306a36Sopenharmony_ci str, PPS(pps), DROP(drop), err, "sched"); 81962306a36Sopenharmony_ci } 82062306a36Sopenharmony_ci} 82162306a36Sopenharmony_ci 82262306a36Sopenharmony_cistatic void stats_get_redirect_cnt(struct stats_record *stats_rec, 82362306a36Sopenharmony_ci struct stats_record *stats_prev, 82462306a36Sopenharmony_ci unsigned int nr_cpus, 82562306a36Sopenharmony_ci struct sample_output *out) 82662306a36Sopenharmony_ci{ 82762306a36Sopenharmony_ci struct record *rec, *prev; 82862306a36Sopenharmony_ci double t, pps; 82962306a36Sopenharmony_ci int i; 83062306a36Sopenharmony_ci 83162306a36Sopenharmony_ci rec = &stats_rec->redir_err[0]; 83262306a36Sopenharmony_ci prev = &stats_prev->redir_err[0]; 83362306a36Sopenharmony_ci t = calc_period(rec, prev); 83462306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 83562306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 83662306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 83762306a36Sopenharmony_ci char str[64]; 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci pps = calc_pps(r, p, t); 84062306a36Sopenharmony_ci if (!pps) 84162306a36Sopenharmony_ci continue; 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 84462306a36Sopenharmony_ci print_default(" %-18s " FMT_COLUMNf "\n", str, REDIR(pps)); 84562306a36Sopenharmony_ci } 84662306a36Sopenharmony_ci 84762306a36Sopenharmony_ci if (out) { 84862306a36Sopenharmony_ci pps = calc_pps(&rec->total, &prev->total, t); 84962306a36Sopenharmony_ci out->redir_cnt.suc = pps; 85062306a36Sopenharmony_ci out->totals.redir += pps; 85162306a36Sopenharmony_ci } 85262306a36Sopenharmony_ci} 85362306a36Sopenharmony_ci 85462306a36Sopenharmony_cistatic void stats_get_redirect_err_cnt(struct stats_record *stats_rec, 85562306a36Sopenharmony_ci struct stats_record *stats_prev, 85662306a36Sopenharmony_ci unsigned int nr_cpus, 85762306a36Sopenharmony_ci struct sample_output *out) 85862306a36Sopenharmony_ci{ 85962306a36Sopenharmony_ci struct record *rec, *prev; 86062306a36Sopenharmony_ci double t, drop, sum = 0; 86162306a36Sopenharmony_ci int rec_i, i; 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci for (rec_i = 1; rec_i < XDP_REDIRECT_ERR_MAX; rec_i++) { 86462306a36Sopenharmony_ci char str[64]; 86562306a36Sopenharmony_ci 86662306a36Sopenharmony_ci rec = &stats_rec->redir_err[rec_i]; 86762306a36Sopenharmony_ci prev = &stats_prev->redir_err[rec_i]; 86862306a36Sopenharmony_ci t = calc_period(rec, prev); 86962306a36Sopenharmony_ci 87062306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 87162306a36Sopenharmony_ci if (drop > 0 && !out) { 87262306a36Sopenharmony_ci snprintf(str, sizeof(str), 87362306a36Sopenharmony_ci sample_log_level & LL_DEFAULT ? "%s total" : 87462306a36Sopenharmony_ci "%s", 87562306a36Sopenharmony_ci xdp_redirect_err_names[rec_i]); 87662306a36Sopenharmony_ci print_err(drop, " %-18s " FMT_COLUMNf "\n", str, 87762306a36Sopenharmony_ci ERR(drop)); 87862306a36Sopenharmony_ci } 87962306a36Sopenharmony_ci 88062306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 88162306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 88262306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 88362306a36Sopenharmony_ci double drop; 88462306a36Sopenharmony_ci 88562306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 88662306a36Sopenharmony_ci if (!drop) 88762306a36Sopenharmony_ci continue; 88862306a36Sopenharmony_ci 88962306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 89062306a36Sopenharmony_ci print_default(" %-16s" FMT_COLUMNf "\n", str, 89162306a36Sopenharmony_ci ERR(drop)); 89262306a36Sopenharmony_ci } 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_ci sum += drop; 89562306a36Sopenharmony_ci } 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_ci if (out) { 89862306a36Sopenharmony_ci out->redir_cnt.err = sum; 89962306a36Sopenharmony_ci out->totals.err += sum; 90062306a36Sopenharmony_ci } 90162306a36Sopenharmony_ci} 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_cistatic void stats_get_exception_cnt(struct stats_record *stats_rec, 90462306a36Sopenharmony_ci struct stats_record *stats_prev, 90562306a36Sopenharmony_ci unsigned int nr_cpus, 90662306a36Sopenharmony_ci struct sample_output *out) 90762306a36Sopenharmony_ci{ 90862306a36Sopenharmony_ci double t, drop, sum = 0; 90962306a36Sopenharmony_ci struct record *rec, *prev; 91062306a36Sopenharmony_ci int rec_i, i; 91162306a36Sopenharmony_ci 91262306a36Sopenharmony_ci for (rec_i = 0; rec_i < XDP_ACTION_MAX; rec_i++) { 91362306a36Sopenharmony_ci rec = &stats_rec->exception[rec_i]; 91462306a36Sopenharmony_ci prev = &stats_prev->exception[rec_i]; 91562306a36Sopenharmony_ci t = calc_period(rec, prev); 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 91862306a36Sopenharmony_ci /* Fold out errors after heading */ 91962306a36Sopenharmony_ci sum += drop; 92062306a36Sopenharmony_ci 92162306a36Sopenharmony_ci if (drop > 0 && !out) { 92262306a36Sopenharmony_ci print_always(" %-18s " FMT_COLUMNf "\n", 92362306a36Sopenharmony_ci action2str(rec_i), ERR(drop)); 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 92662306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 92762306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 92862306a36Sopenharmony_ci char str[64]; 92962306a36Sopenharmony_ci double drop; 93062306a36Sopenharmony_ci 93162306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 93262306a36Sopenharmony_ci if (!drop) 93362306a36Sopenharmony_ci continue; 93462306a36Sopenharmony_ci 93562306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 93662306a36Sopenharmony_ci print_default(" %-16s" FMT_COLUMNf "\n", 93762306a36Sopenharmony_ci str, ERR(drop)); 93862306a36Sopenharmony_ci } 93962306a36Sopenharmony_ci } 94062306a36Sopenharmony_ci } 94162306a36Sopenharmony_ci 94262306a36Sopenharmony_ci if (out) { 94362306a36Sopenharmony_ci out->except_cnt.hits = sum; 94462306a36Sopenharmony_ci out->totals.err += sum; 94562306a36Sopenharmony_ci } 94662306a36Sopenharmony_ci} 94762306a36Sopenharmony_ci 94862306a36Sopenharmony_cistatic void stats_get_devmap_xmit(struct stats_record *stats_rec, 94962306a36Sopenharmony_ci struct stats_record *stats_prev, 95062306a36Sopenharmony_ci unsigned int nr_cpus, 95162306a36Sopenharmony_ci struct sample_output *out) 95262306a36Sopenharmony_ci{ 95362306a36Sopenharmony_ci double pps, drop, info, err; 95462306a36Sopenharmony_ci struct record *rec, *prev; 95562306a36Sopenharmony_ci double t; 95662306a36Sopenharmony_ci int i; 95762306a36Sopenharmony_ci 95862306a36Sopenharmony_ci rec = &stats_rec->devmap_xmit; 95962306a36Sopenharmony_ci prev = &stats_prev->devmap_xmit; 96062306a36Sopenharmony_ci t = calc_period(rec, prev); 96162306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 96262306a36Sopenharmony_ci struct datarec *r = &rec->cpu[i]; 96362306a36Sopenharmony_ci struct datarec *p = &prev->cpu[i]; 96462306a36Sopenharmony_ci char str[64]; 96562306a36Sopenharmony_ci 96662306a36Sopenharmony_ci pps = calc_pps(r, p, t); 96762306a36Sopenharmony_ci drop = calc_drop_pps(r, p, t); 96862306a36Sopenharmony_ci err = calc_errs_pps(r, p, t); 96962306a36Sopenharmony_ci 97062306a36Sopenharmony_ci if (!pps && !drop && !err) 97162306a36Sopenharmony_ci continue; 97262306a36Sopenharmony_ci 97362306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 97462306a36Sopenharmony_ci info = calc_info_pps(r, p, t); 97562306a36Sopenharmony_ci if (info > 0) 97662306a36Sopenharmony_ci info = (pps + drop) / info; /* calc avg bulk */ 97762306a36Sopenharmony_ci print_default(" %-18s" FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 97862306a36Sopenharmony_ci __COLUMN(".2f") "\n", 97962306a36Sopenharmony_ci str, XMIT(pps), DROP(drop), err, "drv_err/s", 98062306a36Sopenharmony_ci info, "bulk-avg"); 98162306a36Sopenharmony_ci } 98262306a36Sopenharmony_ci if (out) { 98362306a36Sopenharmony_ci pps = calc_pps(&rec->total, &prev->total, t); 98462306a36Sopenharmony_ci drop = calc_drop_pps(&rec->total, &prev->total, t); 98562306a36Sopenharmony_ci info = calc_info_pps(&rec->total, &prev->total, t); 98662306a36Sopenharmony_ci if (info > 0) 98762306a36Sopenharmony_ci info = (pps + drop) / info; /* calc avg bulk */ 98862306a36Sopenharmony_ci err = calc_errs_pps(&rec->total, &prev->total, t); 98962306a36Sopenharmony_ci 99062306a36Sopenharmony_ci out->xmit_cnt.pps = pps; 99162306a36Sopenharmony_ci out->xmit_cnt.drop = drop; 99262306a36Sopenharmony_ci out->xmit_cnt.bavg = info; 99362306a36Sopenharmony_ci out->xmit_cnt.err = err; 99462306a36Sopenharmony_ci out->totals.xmit += pps; 99562306a36Sopenharmony_ci out->totals.drop_xmit += drop; 99662306a36Sopenharmony_ci out->totals.err += err; 99762306a36Sopenharmony_ci } 99862306a36Sopenharmony_ci} 99962306a36Sopenharmony_ci 100062306a36Sopenharmony_cistatic void stats_get_devmap_xmit_multi(struct stats_record *stats_rec, 100162306a36Sopenharmony_ci struct stats_record *stats_prev, 100262306a36Sopenharmony_ci unsigned int nr_cpus, 100362306a36Sopenharmony_ci struct sample_output *out, 100462306a36Sopenharmony_ci bool xmit_total) 100562306a36Sopenharmony_ci{ 100662306a36Sopenharmony_ci double pps, drop, info, err; 100762306a36Sopenharmony_ci struct map_entry *entry; 100862306a36Sopenharmony_ci struct record *r, *p; 100962306a36Sopenharmony_ci double t; 101062306a36Sopenharmony_ci int bkt; 101162306a36Sopenharmony_ci 101262306a36Sopenharmony_ci hash_for_each(stats_rec->xmit_map, bkt, entry, node) { 101362306a36Sopenharmony_ci struct map_entry *e, *x = NULL; 101462306a36Sopenharmony_ci char ifname_from[IFNAMSIZ]; 101562306a36Sopenharmony_ci char ifname_to[IFNAMSIZ]; 101662306a36Sopenharmony_ci const char *fstr, *tstr; 101762306a36Sopenharmony_ci unsigned long prev_time; 101862306a36Sopenharmony_ci struct record beg = {}; 101962306a36Sopenharmony_ci __u32 from_idx, to_idx; 102062306a36Sopenharmony_ci char str[128]; 102162306a36Sopenharmony_ci __u64 pair; 102262306a36Sopenharmony_ci int i; 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci prev_time = sample_interval * NANOSEC_PER_SEC; 102562306a36Sopenharmony_ci 102662306a36Sopenharmony_ci pair = entry->pair; 102762306a36Sopenharmony_ci from_idx = pair >> 32; 102862306a36Sopenharmony_ci to_idx = pair & 0xFFFFFFFF; 102962306a36Sopenharmony_ci 103062306a36Sopenharmony_ci r = &entry->val; 103162306a36Sopenharmony_ci beg.timestamp = r->timestamp - prev_time; 103262306a36Sopenharmony_ci 103362306a36Sopenharmony_ci /* Find matching entry from stats_prev map */ 103462306a36Sopenharmony_ci hash_for_each_possible(stats_prev->xmit_map, e, node, pair) { 103562306a36Sopenharmony_ci if (e->pair == pair) { 103662306a36Sopenharmony_ci x = e; 103762306a36Sopenharmony_ci break; 103862306a36Sopenharmony_ci } 103962306a36Sopenharmony_ci } 104062306a36Sopenharmony_ci if (x) 104162306a36Sopenharmony_ci p = &x->val; 104262306a36Sopenharmony_ci else 104362306a36Sopenharmony_ci p = &beg; 104462306a36Sopenharmony_ci t = calc_period(r, p); 104562306a36Sopenharmony_ci pps = calc_pps(&r->total, &p->total, t); 104662306a36Sopenharmony_ci drop = calc_drop_pps(&r->total, &p->total, t); 104762306a36Sopenharmony_ci info = calc_info_pps(&r->total, &p->total, t); 104862306a36Sopenharmony_ci if (info > 0) 104962306a36Sopenharmony_ci info = (pps + drop) / info; /* calc avg bulk */ 105062306a36Sopenharmony_ci err = calc_errs_pps(&r->total, &p->total, t); 105162306a36Sopenharmony_ci 105262306a36Sopenharmony_ci if (out) { 105362306a36Sopenharmony_ci /* We are responsible for filling out totals */ 105462306a36Sopenharmony_ci out->totals.xmit += pps; 105562306a36Sopenharmony_ci out->totals.drop_xmit += drop; 105662306a36Sopenharmony_ci out->totals.err += err; 105762306a36Sopenharmony_ci continue; 105862306a36Sopenharmony_ci } 105962306a36Sopenharmony_ci 106062306a36Sopenharmony_ci fstr = tstr = NULL; 106162306a36Sopenharmony_ci if (if_indextoname(from_idx, ifname_from)) 106262306a36Sopenharmony_ci fstr = ifname_from; 106362306a36Sopenharmony_ci if (if_indextoname(to_idx, ifname_to)) 106462306a36Sopenharmony_ci tstr = ifname_to; 106562306a36Sopenharmony_ci 106662306a36Sopenharmony_ci snprintf(str, sizeof(str), "xmit %s->%s", fstr ?: "?", 106762306a36Sopenharmony_ci tstr ?: "?"); 106862306a36Sopenharmony_ci /* Skip idle streams of redirection */ 106962306a36Sopenharmony_ci if (pps || drop || err) { 107062306a36Sopenharmony_ci print_err(drop, 107162306a36Sopenharmony_ci " %-20s " FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 107262306a36Sopenharmony_ci __COLUMN(".2f") "\n", str, XMIT(pps), DROP(drop), 107362306a36Sopenharmony_ci err, "drv_err/s", info, "bulk-avg"); 107462306a36Sopenharmony_ci } 107562306a36Sopenharmony_ci 107662306a36Sopenharmony_ci for (i = 0; i < nr_cpus; i++) { 107762306a36Sopenharmony_ci struct datarec *rc = &r->cpu[i]; 107862306a36Sopenharmony_ci struct datarec *pc, p_beg = {}; 107962306a36Sopenharmony_ci char str[64]; 108062306a36Sopenharmony_ci 108162306a36Sopenharmony_ci pc = p == &beg ? &p_beg : &p->cpu[i]; 108262306a36Sopenharmony_ci 108362306a36Sopenharmony_ci pps = calc_pps(rc, pc, t); 108462306a36Sopenharmony_ci drop = calc_drop_pps(rc, pc, t); 108562306a36Sopenharmony_ci err = calc_errs_pps(rc, pc, t); 108662306a36Sopenharmony_ci 108762306a36Sopenharmony_ci if (!pps && !drop && !err) 108862306a36Sopenharmony_ci continue; 108962306a36Sopenharmony_ci 109062306a36Sopenharmony_ci snprintf(str, sizeof(str), "cpu:%d", i); 109162306a36Sopenharmony_ci info = calc_info_pps(rc, pc, t); 109262306a36Sopenharmony_ci if (info > 0) 109362306a36Sopenharmony_ci info = (pps + drop) / info; /* calc avg bulk */ 109462306a36Sopenharmony_ci 109562306a36Sopenharmony_ci print_default(" %-18s" FMT_COLUMNf FMT_COLUMNf FMT_COLUMNf 109662306a36Sopenharmony_ci __COLUMN(".2f") "\n", str, XMIT(pps), 109762306a36Sopenharmony_ci DROP(drop), err, "drv_err/s", info, "bulk-avg"); 109862306a36Sopenharmony_ci } 109962306a36Sopenharmony_ci } 110062306a36Sopenharmony_ci} 110162306a36Sopenharmony_ci 110262306a36Sopenharmony_cistatic void stats_print(const char *prefix, int mask, struct stats_record *r, 110362306a36Sopenharmony_ci struct stats_record *p, struct sample_output *out) 110462306a36Sopenharmony_ci{ 110562306a36Sopenharmony_ci int nr_cpus = libbpf_num_possible_cpus(); 110662306a36Sopenharmony_ci const char *str; 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci print_always("%-23s", prefix ?: "Summary"); 110962306a36Sopenharmony_ci if (mask & SAMPLE_RX_CNT) 111062306a36Sopenharmony_ci print_always(FMT_COLUMNl, RX(out->totals.rx)); 111162306a36Sopenharmony_ci if (mask & SAMPLE_REDIRECT_CNT) 111262306a36Sopenharmony_ci print_always(FMT_COLUMNl, REDIR(out->totals.redir)); 111362306a36Sopenharmony_ci printf(FMT_COLUMNl, 111462306a36Sopenharmony_ci out->totals.err + out->totals.drop + out->totals.drop_xmit, 111562306a36Sopenharmony_ci "err,drop/s"); 111662306a36Sopenharmony_ci if (mask & SAMPLE_DEVMAP_XMIT_CNT || 111762306a36Sopenharmony_ci mask & SAMPLE_DEVMAP_XMIT_CNT_MULTI) 111862306a36Sopenharmony_ci printf(FMT_COLUMNl, XMIT(out->totals.xmit)); 111962306a36Sopenharmony_ci printf("\n"); 112062306a36Sopenharmony_ci 112162306a36Sopenharmony_ci if (mask & SAMPLE_RX_CNT) { 112262306a36Sopenharmony_ci str = (sample_log_level & LL_DEFAULT) && out->rx_cnt.pps ? 112362306a36Sopenharmony_ci "receive total" : 112462306a36Sopenharmony_ci "receive"; 112562306a36Sopenharmony_ci print_err((out->rx_cnt.err || out->rx_cnt.drop), 112662306a36Sopenharmony_ci " %-20s " FMT_COLUMNl FMT_COLUMNl FMT_COLUMNl "\n", 112762306a36Sopenharmony_ci str, PPS(out->rx_cnt.pps), DROP(out->rx_cnt.drop), 112862306a36Sopenharmony_ci ERR(out->rx_cnt.err)); 112962306a36Sopenharmony_ci 113062306a36Sopenharmony_ci stats_get_rx_cnt(r, p, nr_cpus, NULL); 113162306a36Sopenharmony_ci } 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci if (mask & SAMPLE_CPUMAP_ENQUEUE_CNT) 113462306a36Sopenharmony_ci stats_get_cpumap_enqueue(r, p, nr_cpus); 113562306a36Sopenharmony_ci 113662306a36Sopenharmony_ci if (mask & SAMPLE_CPUMAP_KTHREAD_CNT) { 113762306a36Sopenharmony_ci stats_get_cpumap_kthread(r, p, nr_cpus); 113862306a36Sopenharmony_ci stats_get_cpumap_remote(r, p, nr_cpus); 113962306a36Sopenharmony_ci } 114062306a36Sopenharmony_ci 114162306a36Sopenharmony_ci if (mask & SAMPLE_REDIRECT_CNT) { 114262306a36Sopenharmony_ci str = out->redir_cnt.suc ? "redirect total" : "redirect"; 114362306a36Sopenharmony_ci print_default(" %-20s " FMT_COLUMNl "\n", str, 114462306a36Sopenharmony_ci REDIR(out->redir_cnt.suc)); 114562306a36Sopenharmony_ci 114662306a36Sopenharmony_ci stats_get_redirect_cnt(r, p, nr_cpus, NULL); 114762306a36Sopenharmony_ci } 114862306a36Sopenharmony_ci 114962306a36Sopenharmony_ci if (mask & SAMPLE_REDIRECT_ERR_CNT) { 115062306a36Sopenharmony_ci str = (sample_log_level & LL_DEFAULT) && out->redir_cnt.err ? 115162306a36Sopenharmony_ci "redirect_err total" : 115262306a36Sopenharmony_ci "redirect_err"; 115362306a36Sopenharmony_ci print_err(out->redir_cnt.err, " %-20s " FMT_COLUMNl "\n", str, 115462306a36Sopenharmony_ci ERR(out->redir_cnt.err)); 115562306a36Sopenharmony_ci 115662306a36Sopenharmony_ci stats_get_redirect_err_cnt(r, p, nr_cpus, NULL); 115762306a36Sopenharmony_ci } 115862306a36Sopenharmony_ci 115962306a36Sopenharmony_ci if (mask & SAMPLE_EXCEPTION_CNT) { 116062306a36Sopenharmony_ci str = out->except_cnt.hits ? "xdp_exception total" : 116162306a36Sopenharmony_ci "xdp_exception"; 116262306a36Sopenharmony_ci 116362306a36Sopenharmony_ci print_err(out->except_cnt.hits, " %-20s " FMT_COLUMNl "\n", str, 116462306a36Sopenharmony_ci HITS(out->except_cnt.hits)); 116562306a36Sopenharmony_ci 116662306a36Sopenharmony_ci stats_get_exception_cnt(r, p, nr_cpus, NULL); 116762306a36Sopenharmony_ci } 116862306a36Sopenharmony_ci 116962306a36Sopenharmony_ci if (mask & SAMPLE_DEVMAP_XMIT_CNT) { 117062306a36Sopenharmony_ci str = (sample_log_level & LL_DEFAULT) && out->xmit_cnt.pps ? 117162306a36Sopenharmony_ci "devmap_xmit total" : 117262306a36Sopenharmony_ci "devmap_xmit"; 117362306a36Sopenharmony_ci 117462306a36Sopenharmony_ci print_err(out->xmit_cnt.err || out->xmit_cnt.drop, 117562306a36Sopenharmony_ci " %-20s " FMT_COLUMNl FMT_COLUMNl FMT_COLUMNl 117662306a36Sopenharmony_ci __COLUMN(".2f") "\n", 117762306a36Sopenharmony_ci str, XMIT(out->xmit_cnt.pps), 117862306a36Sopenharmony_ci DROP(out->xmit_cnt.drop), out->xmit_cnt.err, 117962306a36Sopenharmony_ci "drv_err/s", out->xmit_cnt.bavg, "bulk-avg"); 118062306a36Sopenharmony_ci 118162306a36Sopenharmony_ci stats_get_devmap_xmit(r, p, nr_cpus, NULL); 118262306a36Sopenharmony_ci } 118362306a36Sopenharmony_ci 118462306a36Sopenharmony_ci if (mask & SAMPLE_DEVMAP_XMIT_CNT_MULTI) 118562306a36Sopenharmony_ci stats_get_devmap_xmit_multi(r, p, nr_cpus, NULL, 118662306a36Sopenharmony_ci mask & SAMPLE_DEVMAP_XMIT_CNT); 118762306a36Sopenharmony_ci 118862306a36Sopenharmony_ci if (sample_log_level & LL_DEFAULT || 118962306a36Sopenharmony_ci ((sample_log_level & LL_SIMPLE) && sample_err_exp)) { 119062306a36Sopenharmony_ci sample_err_exp = false; 119162306a36Sopenharmony_ci printf("\n"); 119262306a36Sopenharmony_ci } 119362306a36Sopenharmony_ci} 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ciint sample_setup_maps(struct bpf_map **maps) 119662306a36Sopenharmony_ci{ 119762306a36Sopenharmony_ci sample_n_cpus = libbpf_num_possible_cpus(); 119862306a36Sopenharmony_ci 119962306a36Sopenharmony_ci for (int i = 0; i < MAP_DEVMAP_XMIT_MULTI; i++) { 120062306a36Sopenharmony_ci sample_map[i] = maps[i]; 120162306a36Sopenharmony_ci 120262306a36Sopenharmony_ci switch (i) { 120362306a36Sopenharmony_ci case MAP_RX: 120462306a36Sopenharmony_ci case MAP_CPUMAP_KTHREAD: 120562306a36Sopenharmony_ci case MAP_DEVMAP_XMIT: 120662306a36Sopenharmony_ci sample_map_count[i] = sample_n_cpus; 120762306a36Sopenharmony_ci break; 120862306a36Sopenharmony_ci case MAP_REDIRECT_ERR: 120962306a36Sopenharmony_ci sample_map_count[i] = 121062306a36Sopenharmony_ci XDP_REDIRECT_ERR_MAX * sample_n_cpus; 121162306a36Sopenharmony_ci break; 121262306a36Sopenharmony_ci case MAP_EXCEPTION: 121362306a36Sopenharmony_ci sample_map_count[i] = XDP_ACTION_MAX * sample_n_cpus; 121462306a36Sopenharmony_ci case MAP_CPUMAP_ENQUEUE: 121562306a36Sopenharmony_ci sample_map_count[i] = sample_n_cpus * sample_n_cpus; 121662306a36Sopenharmony_ci break; 121762306a36Sopenharmony_ci default: 121862306a36Sopenharmony_ci return -EINVAL; 121962306a36Sopenharmony_ci } 122062306a36Sopenharmony_ci if (bpf_map__set_max_entries(sample_map[i], sample_map_count[i]) < 0) 122162306a36Sopenharmony_ci return -errno; 122262306a36Sopenharmony_ci } 122362306a36Sopenharmony_ci sample_map[MAP_DEVMAP_XMIT_MULTI] = maps[MAP_DEVMAP_XMIT_MULTI]; 122462306a36Sopenharmony_ci return 0; 122562306a36Sopenharmony_ci} 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_cistatic int sample_setup_maps_mappings(void) 122862306a36Sopenharmony_ci{ 122962306a36Sopenharmony_ci for (int i = 0; i < MAP_DEVMAP_XMIT_MULTI; i++) { 123062306a36Sopenharmony_ci size_t size = sample_map_count[i] * sizeof(struct datarec); 123162306a36Sopenharmony_ci 123262306a36Sopenharmony_ci sample_mmap[i] = mmap(NULL, size, PROT_READ | PROT_WRITE, 123362306a36Sopenharmony_ci MAP_SHARED, bpf_map__fd(sample_map[i]), 0); 123462306a36Sopenharmony_ci if (sample_mmap[i] == MAP_FAILED) 123562306a36Sopenharmony_ci return -errno; 123662306a36Sopenharmony_ci } 123762306a36Sopenharmony_ci return 0; 123862306a36Sopenharmony_ci} 123962306a36Sopenharmony_ci 124062306a36Sopenharmony_ciint __sample_init(int mask) 124162306a36Sopenharmony_ci{ 124262306a36Sopenharmony_ci sigset_t st; 124362306a36Sopenharmony_ci 124462306a36Sopenharmony_ci sigemptyset(&st); 124562306a36Sopenharmony_ci sigaddset(&st, SIGQUIT); 124662306a36Sopenharmony_ci sigaddset(&st, SIGINT); 124762306a36Sopenharmony_ci sigaddset(&st, SIGTERM); 124862306a36Sopenharmony_ci 124962306a36Sopenharmony_ci if (sigprocmask(SIG_BLOCK, &st, NULL) < 0) 125062306a36Sopenharmony_ci return -errno; 125162306a36Sopenharmony_ci 125262306a36Sopenharmony_ci sample_sig_fd = signalfd(-1, &st, SFD_CLOEXEC | SFD_NONBLOCK); 125362306a36Sopenharmony_ci if (sample_sig_fd < 0) 125462306a36Sopenharmony_ci return -errno; 125562306a36Sopenharmony_ci 125662306a36Sopenharmony_ci sample_mask = mask; 125762306a36Sopenharmony_ci 125862306a36Sopenharmony_ci return sample_setup_maps_mappings(); 125962306a36Sopenharmony_ci} 126062306a36Sopenharmony_ci 126162306a36Sopenharmony_cistatic int __sample_remove_xdp(int ifindex, __u32 prog_id, int xdp_flags) 126262306a36Sopenharmony_ci{ 126362306a36Sopenharmony_ci __u32 cur_prog_id = 0; 126462306a36Sopenharmony_ci int ret; 126562306a36Sopenharmony_ci 126662306a36Sopenharmony_ci if (prog_id) { 126762306a36Sopenharmony_ci ret = bpf_xdp_query_id(ifindex, xdp_flags, &cur_prog_id); 126862306a36Sopenharmony_ci if (ret < 0) 126962306a36Sopenharmony_ci return -errno; 127062306a36Sopenharmony_ci 127162306a36Sopenharmony_ci if (prog_id != cur_prog_id) { 127262306a36Sopenharmony_ci print_always( 127362306a36Sopenharmony_ci "Program on ifindex %d does not match installed " 127462306a36Sopenharmony_ci "program, skipping unload\n", 127562306a36Sopenharmony_ci ifindex); 127662306a36Sopenharmony_ci return -ENOENT; 127762306a36Sopenharmony_ci } 127862306a36Sopenharmony_ci } 127962306a36Sopenharmony_ci 128062306a36Sopenharmony_ci return bpf_xdp_detach(ifindex, xdp_flags, NULL); 128162306a36Sopenharmony_ci} 128262306a36Sopenharmony_ci 128362306a36Sopenharmony_ciint sample_install_xdp(struct bpf_program *xdp_prog, int ifindex, bool generic, 128462306a36Sopenharmony_ci bool force) 128562306a36Sopenharmony_ci{ 128662306a36Sopenharmony_ci int ret, xdp_flags = 0; 128762306a36Sopenharmony_ci __u32 prog_id = 0; 128862306a36Sopenharmony_ci 128962306a36Sopenharmony_ci if (sample_xdp_cnt == 32) { 129062306a36Sopenharmony_ci fprintf(stderr, 129162306a36Sopenharmony_ci "Total limit for installed XDP programs in a sample reached\n"); 129262306a36Sopenharmony_ci return -ENOTSUP; 129362306a36Sopenharmony_ci } 129462306a36Sopenharmony_ci 129562306a36Sopenharmony_ci xdp_flags |= !force ? XDP_FLAGS_UPDATE_IF_NOEXIST : 0; 129662306a36Sopenharmony_ci xdp_flags |= generic ? XDP_FLAGS_SKB_MODE : XDP_FLAGS_DRV_MODE; 129762306a36Sopenharmony_ci ret = bpf_xdp_attach(ifindex, bpf_program__fd(xdp_prog), xdp_flags, NULL); 129862306a36Sopenharmony_ci if (ret < 0) { 129962306a36Sopenharmony_ci ret = -errno; 130062306a36Sopenharmony_ci fprintf(stderr, 130162306a36Sopenharmony_ci "Failed to install program \"%s\" on ifindex %d, mode = %s, " 130262306a36Sopenharmony_ci "force = %s: %s\n", 130362306a36Sopenharmony_ci bpf_program__name(xdp_prog), ifindex, 130462306a36Sopenharmony_ci generic ? "skb" : "native", force ? "true" : "false", 130562306a36Sopenharmony_ci strerror(-ret)); 130662306a36Sopenharmony_ci return ret; 130762306a36Sopenharmony_ci } 130862306a36Sopenharmony_ci 130962306a36Sopenharmony_ci ret = bpf_xdp_query_id(ifindex, xdp_flags, &prog_id); 131062306a36Sopenharmony_ci if (ret < 0) { 131162306a36Sopenharmony_ci ret = -errno; 131262306a36Sopenharmony_ci fprintf(stderr, 131362306a36Sopenharmony_ci "Failed to get XDP program id for ifindex %d, removing program: %s\n", 131462306a36Sopenharmony_ci ifindex, strerror(errno)); 131562306a36Sopenharmony_ci __sample_remove_xdp(ifindex, 0, xdp_flags); 131662306a36Sopenharmony_ci return ret; 131762306a36Sopenharmony_ci } 131862306a36Sopenharmony_ci sample_xdp_progs[sample_xdp_cnt++] = 131962306a36Sopenharmony_ci (struct xdp_desc){ ifindex, prog_id, xdp_flags }; 132062306a36Sopenharmony_ci 132162306a36Sopenharmony_ci return 0; 132262306a36Sopenharmony_ci} 132362306a36Sopenharmony_ci 132462306a36Sopenharmony_cistatic void sample_summary_print(void) 132562306a36Sopenharmony_ci{ 132662306a36Sopenharmony_ci double num = sample_out.rx_cnt.num; 132762306a36Sopenharmony_ci 132862306a36Sopenharmony_ci if (sample_out.totals.rx) { 132962306a36Sopenharmony_ci double pkts = sample_out.totals.rx; 133062306a36Sopenharmony_ci 133162306a36Sopenharmony_ci print_always(" Packets received : %'-10llu\n", 133262306a36Sopenharmony_ci sample_out.totals.rx); 133362306a36Sopenharmony_ci print_always(" Average packets/s : %'-10.0f\n", 133462306a36Sopenharmony_ci sample_round(pkts / num)); 133562306a36Sopenharmony_ci } 133662306a36Sopenharmony_ci if (sample_out.totals.redir) { 133762306a36Sopenharmony_ci double pkts = sample_out.totals.redir; 133862306a36Sopenharmony_ci 133962306a36Sopenharmony_ci print_always(" Packets redirected : %'-10llu\n", 134062306a36Sopenharmony_ci sample_out.totals.redir); 134162306a36Sopenharmony_ci print_always(" Average redir/s : %'-10.0f\n", 134262306a36Sopenharmony_ci sample_round(pkts / num)); 134362306a36Sopenharmony_ci } 134462306a36Sopenharmony_ci if (sample_out.totals.drop) 134562306a36Sopenharmony_ci print_always(" Rx dropped : %'-10llu\n", 134662306a36Sopenharmony_ci sample_out.totals.drop); 134762306a36Sopenharmony_ci if (sample_out.totals.drop_xmit) 134862306a36Sopenharmony_ci print_always(" Tx dropped : %'-10llu\n", 134962306a36Sopenharmony_ci sample_out.totals.drop_xmit); 135062306a36Sopenharmony_ci if (sample_out.totals.err) 135162306a36Sopenharmony_ci print_always(" Errors recorded : %'-10llu\n", 135262306a36Sopenharmony_ci sample_out.totals.err); 135362306a36Sopenharmony_ci if (sample_out.totals.xmit) { 135462306a36Sopenharmony_ci double pkts = sample_out.totals.xmit; 135562306a36Sopenharmony_ci 135662306a36Sopenharmony_ci print_always(" Packets transmitted : %'-10llu\n", 135762306a36Sopenharmony_ci sample_out.totals.xmit); 135862306a36Sopenharmony_ci print_always(" Average transmit/s : %'-10.0f\n", 135962306a36Sopenharmony_ci sample_round(pkts / num)); 136062306a36Sopenharmony_ci } 136162306a36Sopenharmony_ci} 136262306a36Sopenharmony_ci 136362306a36Sopenharmony_civoid sample_exit(int status) 136462306a36Sopenharmony_ci{ 136562306a36Sopenharmony_ci size_t size; 136662306a36Sopenharmony_ci 136762306a36Sopenharmony_ci for (int i = 0; i < NUM_MAP; i++) { 136862306a36Sopenharmony_ci size = sample_map_count[i] * sizeof(**sample_mmap); 136962306a36Sopenharmony_ci munmap(sample_mmap[i], size); 137062306a36Sopenharmony_ci } 137162306a36Sopenharmony_ci while (sample_xdp_cnt--) { 137262306a36Sopenharmony_ci int i = sample_xdp_cnt, ifindex, xdp_flags; 137362306a36Sopenharmony_ci __u32 prog_id; 137462306a36Sopenharmony_ci 137562306a36Sopenharmony_ci prog_id = sample_xdp_progs[i].prog_id; 137662306a36Sopenharmony_ci ifindex = sample_xdp_progs[i].ifindex; 137762306a36Sopenharmony_ci xdp_flags = sample_xdp_progs[i].flags; 137862306a36Sopenharmony_ci 137962306a36Sopenharmony_ci __sample_remove_xdp(ifindex, prog_id, xdp_flags); 138062306a36Sopenharmony_ci } 138162306a36Sopenharmony_ci sample_summary_print(); 138262306a36Sopenharmony_ci close(sample_sig_fd); 138362306a36Sopenharmony_ci exit(status); 138462306a36Sopenharmony_ci} 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_cistatic int sample_stats_collect(struct stats_record *rec) 138762306a36Sopenharmony_ci{ 138862306a36Sopenharmony_ci int i; 138962306a36Sopenharmony_ci 139062306a36Sopenharmony_ci if (sample_mask & SAMPLE_RX_CNT) 139162306a36Sopenharmony_ci map_collect_percpu(sample_mmap[MAP_RX], &rec->rx_cnt); 139262306a36Sopenharmony_ci 139362306a36Sopenharmony_ci if (sample_mask & SAMPLE_REDIRECT_CNT) 139462306a36Sopenharmony_ci map_collect_percpu(sample_mmap[MAP_REDIRECT_ERR], &rec->redir_err[0]); 139562306a36Sopenharmony_ci 139662306a36Sopenharmony_ci if (sample_mask & SAMPLE_REDIRECT_ERR_CNT) { 139762306a36Sopenharmony_ci for (i = 1; i < XDP_REDIRECT_ERR_MAX; i++) 139862306a36Sopenharmony_ci map_collect_percpu(&sample_mmap[MAP_REDIRECT_ERR][i * sample_n_cpus], 139962306a36Sopenharmony_ci &rec->redir_err[i]); 140062306a36Sopenharmony_ci } 140162306a36Sopenharmony_ci 140262306a36Sopenharmony_ci if (sample_mask & SAMPLE_CPUMAP_ENQUEUE_CNT) 140362306a36Sopenharmony_ci for (i = 0; i < sample_n_cpus; i++) 140462306a36Sopenharmony_ci map_collect_percpu(&sample_mmap[MAP_CPUMAP_ENQUEUE][i * sample_n_cpus], 140562306a36Sopenharmony_ci &rec->enq[i]); 140662306a36Sopenharmony_ci 140762306a36Sopenharmony_ci if (sample_mask & SAMPLE_CPUMAP_KTHREAD_CNT) 140862306a36Sopenharmony_ci map_collect_percpu(sample_mmap[MAP_CPUMAP_KTHREAD], 140962306a36Sopenharmony_ci &rec->kthread); 141062306a36Sopenharmony_ci 141162306a36Sopenharmony_ci if (sample_mask & SAMPLE_EXCEPTION_CNT) 141262306a36Sopenharmony_ci for (i = 0; i < XDP_ACTION_MAX; i++) 141362306a36Sopenharmony_ci map_collect_percpu(&sample_mmap[MAP_EXCEPTION][i * sample_n_cpus], 141462306a36Sopenharmony_ci &rec->exception[i]); 141562306a36Sopenharmony_ci 141662306a36Sopenharmony_ci if (sample_mask & SAMPLE_DEVMAP_XMIT_CNT) 141762306a36Sopenharmony_ci map_collect_percpu(sample_mmap[MAP_DEVMAP_XMIT], &rec->devmap_xmit); 141862306a36Sopenharmony_ci 141962306a36Sopenharmony_ci if (sample_mask & SAMPLE_DEVMAP_XMIT_CNT_MULTI) { 142062306a36Sopenharmony_ci if (map_collect_percpu_devmap(bpf_map__fd(sample_map[MAP_DEVMAP_XMIT_MULTI]), rec) < 0) 142162306a36Sopenharmony_ci return -EINVAL; 142262306a36Sopenharmony_ci } 142362306a36Sopenharmony_ci return 0; 142462306a36Sopenharmony_ci} 142562306a36Sopenharmony_ci 142662306a36Sopenharmony_cistatic void sample_summary_update(struct sample_output *out) 142762306a36Sopenharmony_ci{ 142862306a36Sopenharmony_ci sample_out.totals.rx += out->totals.rx; 142962306a36Sopenharmony_ci sample_out.totals.redir += out->totals.redir; 143062306a36Sopenharmony_ci sample_out.totals.drop += out->totals.drop; 143162306a36Sopenharmony_ci sample_out.totals.drop_xmit += out->totals.drop_xmit; 143262306a36Sopenharmony_ci sample_out.totals.err += out->totals.err; 143362306a36Sopenharmony_ci sample_out.totals.xmit += out->totals.xmit; 143462306a36Sopenharmony_ci sample_out.rx_cnt.num++; 143562306a36Sopenharmony_ci} 143662306a36Sopenharmony_ci 143762306a36Sopenharmony_cistatic void sample_stats_print(int mask, struct stats_record *cur, 143862306a36Sopenharmony_ci struct stats_record *prev, char *prog_name) 143962306a36Sopenharmony_ci{ 144062306a36Sopenharmony_ci struct sample_output out = {}; 144162306a36Sopenharmony_ci 144262306a36Sopenharmony_ci if (mask & SAMPLE_RX_CNT) 144362306a36Sopenharmony_ci stats_get_rx_cnt(cur, prev, 0, &out); 144462306a36Sopenharmony_ci if (mask & SAMPLE_REDIRECT_CNT) 144562306a36Sopenharmony_ci stats_get_redirect_cnt(cur, prev, 0, &out); 144662306a36Sopenharmony_ci if (mask & SAMPLE_REDIRECT_ERR_CNT) 144762306a36Sopenharmony_ci stats_get_redirect_err_cnt(cur, prev, 0, &out); 144862306a36Sopenharmony_ci if (mask & SAMPLE_EXCEPTION_CNT) 144962306a36Sopenharmony_ci stats_get_exception_cnt(cur, prev, 0, &out); 145062306a36Sopenharmony_ci if (mask & SAMPLE_DEVMAP_XMIT_CNT) 145162306a36Sopenharmony_ci stats_get_devmap_xmit(cur, prev, 0, &out); 145262306a36Sopenharmony_ci else if (mask & SAMPLE_DEVMAP_XMIT_CNT_MULTI) 145362306a36Sopenharmony_ci stats_get_devmap_xmit_multi(cur, prev, 0, &out, 145462306a36Sopenharmony_ci mask & SAMPLE_DEVMAP_XMIT_CNT); 145562306a36Sopenharmony_ci sample_summary_update(&out); 145662306a36Sopenharmony_ci 145762306a36Sopenharmony_ci stats_print(prog_name, mask, cur, prev, &out); 145862306a36Sopenharmony_ci} 145962306a36Sopenharmony_ci 146062306a36Sopenharmony_civoid sample_switch_mode(void) 146162306a36Sopenharmony_ci{ 146262306a36Sopenharmony_ci sample_log_level ^= LL_DEBUG - 1; 146362306a36Sopenharmony_ci} 146462306a36Sopenharmony_ci 146562306a36Sopenharmony_cistatic int sample_signal_cb(void) 146662306a36Sopenharmony_ci{ 146762306a36Sopenharmony_ci struct signalfd_siginfo si; 146862306a36Sopenharmony_ci int r; 146962306a36Sopenharmony_ci 147062306a36Sopenharmony_ci r = read(sample_sig_fd, &si, sizeof(si)); 147162306a36Sopenharmony_ci if (r < 0) 147262306a36Sopenharmony_ci return -errno; 147362306a36Sopenharmony_ci 147462306a36Sopenharmony_ci switch (si.ssi_signo) { 147562306a36Sopenharmony_ci case SIGQUIT: 147662306a36Sopenharmony_ci sample_switch_mode(); 147762306a36Sopenharmony_ci printf("\n"); 147862306a36Sopenharmony_ci break; 147962306a36Sopenharmony_ci default: 148062306a36Sopenharmony_ci printf("\n"); 148162306a36Sopenharmony_ci return 1; 148262306a36Sopenharmony_ci } 148362306a36Sopenharmony_ci 148462306a36Sopenharmony_ci return 0; 148562306a36Sopenharmony_ci} 148662306a36Sopenharmony_ci 148762306a36Sopenharmony_ci/* Pointer swap trick */ 148862306a36Sopenharmony_cistatic void swap(struct stats_record **a, struct stats_record **b) 148962306a36Sopenharmony_ci{ 149062306a36Sopenharmony_ci struct stats_record *tmp; 149162306a36Sopenharmony_ci 149262306a36Sopenharmony_ci tmp = *a; 149362306a36Sopenharmony_ci *a = *b; 149462306a36Sopenharmony_ci *b = tmp; 149562306a36Sopenharmony_ci} 149662306a36Sopenharmony_ci 149762306a36Sopenharmony_cistatic int sample_timer_cb(int timerfd, struct stats_record **rec, 149862306a36Sopenharmony_ci struct stats_record **prev) 149962306a36Sopenharmony_ci{ 150062306a36Sopenharmony_ci char line[64] = "Summary"; 150162306a36Sopenharmony_ci int ret; 150262306a36Sopenharmony_ci __u64 t; 150362306a36Sopenharmony_ci 150462306a36Sopenharmony_ci ret = read(timerfd, &t, sizeof(t)); 150562306a36Sopenharmony_ci if (ret < 0) 150662306a36Sopenharmony_ci return -errno; 150762306a36Sopenharmony_ci 150862306a36Sopenharmony_ci swap(prev, rec); 150962306a36Sopenharmony_ci ret = sample_stats_collect(*rec); 151062306a36Sopenharmony_ci if (ret < 0) 151162306a36Sopenharmony_ci return ret; 151262306a36Sopenharmony_ci 151362306a36Sopenharmony_ci if (sample_xdp_cnt == 2 && !(sample_mask & SAMPLE_SKIP_HEADING)) { 151462306a36Sopenharmony_ci char fi[IFNAMSIZ]; 151562306a36Sopenharmony_ci char to[IFNAMSIZ]; 151662306a36Sopenharmony_ci const char *f, *t; 151762306a36Sopenharmony_ci 151862306a36Sopenharmony_ci f = t = NULL; 151962306a36Sopenharmony_ci if (if_indextoname(sample_xdp_progs[0].ifindex, fi)) 152062306a36Sopenharmony_ci f = fi; 152162306a36Sopenharmony_ci if (if_indextoname(sample_xdp_progs[1].ifindex, to)) 152262306a36Sopenharmony_ci t = to; 152362306a36Sopenharmony_ci 152462306a36Sopenharmony_ci snprintf(line, sizeof(line), "%s->%s", f ?: "?", t ?: "?"); 152562306a36Sopenharmony_ci } 152662306a36Sopenharmony_ci 152762306a36Sopenharmony_ci sample_stats_print(sample_mask, *rec, *prev, line); 152862306a36Sopenharmony_ci return 0; 152962306a36Sopenharmony_ci} 153062306a36Sopenharmony_ci 153162306a36Sopenharmony_ciint sample_run(int interval, void (*post_cb)(void *), void *ctx) 153262306a36Sopenharmony_ci{ 153362306a36Sopenharmony_ci struct timespec ts = { interval, 0 }; 153462306a36Sopenharmony_ci struct itimerspec its = { ts, ts }; 153562306a36Sopenharmony_ci struct stats_record *rec, *prev; 153662306a36Sopenharmony_ci struct pollfd pfd[2] = {}; 153762306a36Sopenharmony_ci int timerfd, ret; 153862306a36Sopenharmony_ci 153962306a36Sopenharmony_ci if (!interval) { 154062306a36Sopenharmony_ci fprintf(stderr, "Incorrect interval 0\n"); 154162306a36Sopenharmony_ci return -EINVAL; 154262306a36Sopenharmony_ci } 154362306a36Sopenharmony_ci sample_interval = interval; 154462306a36Sopenharmony_ci /* Pretty print numbers */ 154562306a36Sopenharmony_ci setlocale(LC_NUMERIC, "en_US.UTF-8"); 154662306a36Sopenharmony_ci 154762306a36Sopenharmony_ci timerfd = timerfd_create(CLOCK_MONOTONIC, TFD_CLOEXEC | TFD_NONBLOCK); 154862306a36Sopenharmony_ci if (timerfd < 0) 154962306a36Sopenharmony_ci return -errno; 155062306a36Sopenharmony_ci timerfd_settime(timerfd, 0, &its, NULL); 155162306a36Sopenharmony_ci 155262306a36Sopenharmony_ci pfd[0].fd = sample_sig_fd; 155362306a36Sopenharmony_ci pfd[0].events = POLLIN; 155462306a36Sopenharmony_ci 155562306a36Sopenharmony_ci pfd[1].fd = timerfd; 155662306a36Sopenharmony_ci pfd[1].events = POLLIN; 155762306a36Sopenharmony_ci 155862306a36Sopenharmony_ci ret = -ENOMEM; 155962306a36Sopenharmony_ci rec = alloc_stats_record(); 156062306a36Sopenharmony_ci if (!rec) 156162306a36Sopenharmony_ci goto end; 156262306a36Sopenharmony_ci prev = alloc_stats_record(); 156362306a36Sopenharmony_ci if (!prev) 156462306a36Sopenharmony_ci goto end_rec; 156562306a36Sopenharmony_ci 156662306a36Sopenharmony_ci ret = sample_stats_collect(rec); 156762306a36Sopenharmony_ci if (ret < 0) 156862306a36Sopenharmony_ci goto end_rec_prev; 156962306a36Sopenharmony_ci 157062306a36Sopenharmony_ci for (;;) { 157162306a36Sopenharmony_ci ret = poll(pfd, 2, -1); 157262306a36Sopenharmony_ci if (ret < 0) { 157362306a36Sopenharmony_ci if (errno == EINTR) 157462306a36Sopenharmony_ci continue; 157562306a36Sopenharmony_ci else 157662306a36Sopenharmony_ci break; 157762306a36Sopenharmony_ci } 157862306a36Sopenharmony_ci 157962306a36Sopenharmony_ci if (pfd[0].revents & POLLIN) 158062306a36Sopenharmony_ci ret = sample_signal_cb(); 158162306a36Sopenharmony_ci else if (pfd[1].revents & POLLIN) 158262306a36Sopenharmony_ci ret = sample_timer_cb(timerfd, &rec, &prev); 158362306a36Sopenharmony_ci 158462306a36Sopenharmony_ci if (ret) 158562306a36Sopenharmony_ci break; 158662306a36Sopenharmony_ci 158762306a36Sopenharmony_ci if (post_cb) 158862306a36Sopenharmony_ci post_cb(ctx); 158962306a36Sopenharmony_ci } 159062306a36Sopenharmony_ci 159162306a36Sopenharmony_ciend_rec_prev: 159262306a36Sopenharmony_ci free_stats_record(prev); 159362306a36Sopenharmony_ciend_rec: 159462306a36Sopenharmony_ci free_stats_record(rec); 159562306a36Sopenharmony_ciend: 159662306a36Sopenharmony_ci close(timerfd); 159762306a36Sopenharmony_ci 159862306a36Sopenharmony_ci return ret; 159962306a36Sopenharmony_ci} 160062306a36Sopenharmony_ci 160162306a36Sopenharmony_ciconst char *get_driver_name(int ifindex) 160262306a36Sopenharmony_ci{ 160362306a36Sopenharmony_ci struct ethtool_drvinfo drv = {}; 160462306a36Sopenharmony_ci char ifname[IF_NAMESIZE]; 160562306a36Sopenharmony_ci static char drvname[32]; 160662306a36Sopenharmony_ci struct ifreq ifr = {}; 160762306a36Sopenharmony_ci int fd, r = 0; 160862306a36Sopenharmony_ci 160962306a36Sopenharmony_ci fd = socket(AF_INET, SOCK_DGRAM, 0); 161062306a36Sopenharmony_ci if (fd < 0) 161162306a36Sopenharmony_ci return "[error]"; 161262306a36Sopenharmony_ci 161362306a36Sopenharmony_ci if (!if_indextoname(ifindex, ifname)) 161462306a36Sopenharmony_ci goto end; 161562306a36Sopenharmony_ci 161662306a36Sopenharmony_ci drv.cmd = ETHTOOL_GDRVINFO; 161762306a36Sopenharmony_ci safe_strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); 161862306a36Sopenharmony_ci ifr.ifr_data = (void *)&drv; 161962306a36Sopenharmony_ci 162062306a36Sopenharmony_ci r = ioctl(fd, SIOCETHTOOL, &ifr); 162162306a36Sopenharmony_ci if (r) 162262306a36Sopenharmony_ci goto end; 162362306a36Sopenharmony_ci 162462306a36Sopenharmony_ci safe_strncpy(drvname, drv.driver, sizeof(drvname)); 162562306a36Sopenharmony_ci 162662306a36Sopenharmony_ci close(fd); 162762306a36Sopenharmony_ci return drvname; 162862306a36Sopenharmony_ci 162962306a36Sopenharmony_ciend: 163062306a36Sopenharmony_ci r = errno; 163162306a36Sopenharmony_ci close(fd); 163262306a36Sopenharmony_ci return r == EOPNOTSUPP ? "loopback" : "[error]"; 163362306a36Sopenharmony_ci} 163462306a36Sopenharmony_ci 163562306a36Sopenharmony_ciint get_mac_addr(int ifindex, void *mac_addr) 163662306a36Sopenharmony_ci{ 163762306a36Sopenharmony_ci char ifname[IF_NAMESIZE]; 163862306a36Sopenharmony_ci struct ifreq ifr = {}; 163962306a36Sopenharmony_ci int fd, r; 164062306a36Sopenharmony_ci 164162306a36Sopenharmony_ci fd = socket(AF_INET, SOCK_DGRAM, 0); 164262306a36Sopenharmony_ci if (fd < 0) 164362306a36Sopenharmony_ci return -errno; 164462306a36Sopenharmony_ci 164562306a36Sopenharmony_ci if (!if_indextoname(ifindex, ifname)) { 164662306a36Sopenharmony_ci r = -errno; 164762306a36Sopenharmony_ci goto end; 164862306a36Sopenharmony_ci } 164962306a36Sopenharmony_ci 165062306a36Sopenharmony_ci safe_strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name)); 165162306a36Sopenharmony_ci 165262306a36Sopenharmony_ci r = ioctl(fd, SIOCGIFHWADDR, &ifr); 165362306a36Sopenharmony_ci if (r) { 165462306a36Sopenharmony_ci r = -errno; 165562306a36Sopenharmony_ci goto end; 165662306a36Sopenharmony_ci } 165762306a36Sopenharmony_ci 165862306a36Sopenharmony_ci memcpy(mac_addr, ifr.ifr_hwaddr.sa_data, 6 * sizeof(char)); 165962306a36Sopenharmony_ci 166062306a36Sopenharmony_ciend: 166162306a36Sopenharmony_ci close(fd); 166262306a36Sopenharmony_ci return r; 166362306a36Sopenharmony_ci} 166462306a36Sopenharmony_ci 166562306a36Sopenharmony_ci__attribute__((constructor)) static void sample_ctor(void) 166662306a36Sopenharmony_ci{ 166762306a36Sopenharmony_ci if (libbpf_set_strict_mode(LIBBPF_STRICT_ALL) < 0) { 166862306a36Sopenharmony_ci fprintf(stderr, "Failed to set libbpf strict mode: %s\n", 166962306a36Sopenharmony_ci strerror(errno)); 167062306a36Sopenharmony_ci /* Just exit, nothing to cleanup right now */ 167162306a36Sopenharmony_ci exit(EXIT_FAIL_BPF); 167262306a36Sopenharmony_ci } 167362306a36Sopenharmony_ci} 1674