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