162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
262306a36Sopenharmony_ci
362306a36Sopenharmony_ci/*
462306a36Sopenharmony_ci * ibumad BPF sample user side
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * This program is free software; you can redistribute it and/or
762306a36Sopenharmony_ci * modify it under the terms of version 2 of the GNU General Public
862306a36Sopenharmony_ci * License as published by the Free Software Foundation.
962306a36Sopenharmony_ci *
1062306a36Sopenharmony_ci * Copyright(c) 2018 Ira Weiny, Intel Corporation
1162306a36Sopenharmony_ci */
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include <linux/bpf.h>
1462306a36Sopenharmony_ci#include <signal.h>
1562306a36Sopenharmony_ci#include <stdio.h>
1662306a36Sopenharmony_ci#include <stdlib.h>
1762306a36Sopenharmony_ci#include <string.h>
1862306a36Sopenharmony_ci#include <unistd.h>
1962306a36Sopenharmony_ci#include <sys/types.h>
2062306a36Sopenharmony_ci#include <limits.h>
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#include <getopt.h>
2362306a36Sopenharmony_ci#include <net/if.h>
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#include <bpf/bpf.h>
2662306a36Sopenharmony_ci#include "bpf_util.h"
2762306a36Sopenharmony_ci#include <bpf/libbpf.h>
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_cistatic struct bpf_link *tp_links[3];
3062306a36Sopenharmony_cistatic struct bpf_object *obj;
3162306a36Sopenharmony_cistatic int map_fd[2];
3262306a36Sopenharmony_cistatic int tp_cnt;
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cistatic void dump_counts(int fd)
3562306a36Sopenharmony_ci{
3662306a36Sopenharmony_ci	__u32 key;
3762306a36Sopenharmony_ci	__u64 value;
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci	for (key = 0; key < 256; key++) {
4062306a36Sopenharmony_ci		if (bpf_map_lookup_elem(fd, &key, &value)) {
4162306a36Sopenharmony_ci			printf("failed to read key %u\n", key);
4262306a36Sopenharmony_ci			continue;
4362306a36Sopenharmony_ci		}
4462306a36Sopenharmony_ci		if (value)
4562306a36Sopenharmony_ci			printf("0x%02x : %llu\n", key, value);
4662306a36Sopenharmony_ci	}
4762306a36Sopenharmony_ci}
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_cistatic void dump_all_counts(void)
5062306a36Sopenharmony_ci{
5162306a36Sopenharmony_ci	printf("Read 'Class : count'\n");
5262306a36Sopenharmony_ci	dump_counts(map_fd[0]);
5362306a36Sopenharmony_ci	printf("Write 'Class : count'\n");
5462306a36Sopenharmony_ci	dump_counts(map_fd[1]);
5562306a36Sopenharmony_ci}
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_cistatic void dump_exit(int sig)
5862306a36Sopenharmony_ci{
5962306a36Sopenharmony_ci	dump_all_counts();
6062306a36Sopenharmony_ci	/* Detach tracepoints */
6162306a36Sopenharmony_ci	while (tp_cnt)
6262306a36Sopenharmony_ci		bpf_link__destroy(tp_links[--tp_cnt]);
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	bpf_object__close(obj);
6562306a36Sopenharmony_ci	exit(0);
6662306a36Sopenharmony_ci}
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_cistatic const struct option long_options[] = {
6962306a36Sopenharmony_ci	{"help",      no_argument,       NULL, 'h'},
7062306a36Sopenharmony_ci	{"delay",     required_argument, NULL, 'd'},
7162306a36Sopenharmony_ci};
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic void usage(char *cmd)
7462306a36Sopenharmony_ci{
7562306a36Sopenharmony_ci	printf("eBPF test program to count packets from various IP addresses\n"
7662306a36Sopenharmony_ci		"Usage: %s <options>\n"
7762306a36Sopenharmony_ci		"       --help,   -h  this menu\n"
7862306a36Sopenharmony_ci		"       --delay,  -d  <delay>  wait <delay> sec between prints [1 - 1000000]\n"
7962306a36Sopenharmony_ci		, cmd
8062306a36Sopenharmony_ci		);
8162306a36Sopenharmony_ci}
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ciint main(int argc, char **argv)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	struct bpf_program *prog;
8662306a36Sopenharmony_ci	unsigned long delay = 5;
8762306a36Sopenharmony_ci	char filename[256];
8862306a36Sopenharmony_ci	int longindex = 0;
8962306a36Sopenharmony_ci	int opt, err = -1;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	while ((opt = getopt_long(argc, argv, "hd:rSw",
9262306a36Sopenharmony_ci				  long_options, &longindex)) != -1) {
9362306a36Sopenharmony_ci		switch (opt) {
9462306a36Sopenharmony_ci		case 'd':
9562306a36Sopenharmony_ci			delay = strtoul(optarg, NULL, 0);
9662306a36Sopenharmony_ci			if (delay == ULONG_MAX || delay < 0 ||
9762306a36Sopenharmony_ci			    delay > 1000000) {
9862306a36Sopenharmony_ci				fprintf(stderr, "ERROR: invalid delay : %s\n",
9962306a36Sopenharmony_ci					optarg);
10062306a36Sopenharmony_ci				usage(argv[0]);
10162306a36Sopenharmony_ci				return 1;
10262306a36Sopenharmony_ci			}
10362306a36Sopenharmony_ci			break;
10462306a36Sopenharmony_ci		default:
10562306a36Sopenharmony_ci		case 'h':
10662306a36Sopenharmony_ci			usage(argv[0]);
10762306a36Sopenharmony_ci			return 1;
10862306a36Sopenharmony_ci		}
10962306a36Sopenharmony_ci	}
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci	/* Do one final dump when exiting */
11262306a36Sopenharmony_ci	signal(SIGINT, dump_exit);
11362306a36Sopenharmony_ci	signal(SIGTERM, dump_exit);
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	snprintf(filename, sizeof(filename), "%s_kern.o", argv[0]);
11662306a36Sopenharmony_ci	obj = bpf_object__open_file(filename, NULL);
11762306a36Sopenharmony_ci	if (libbpf_get_error(obj)) {
11862306a36Sopenharmony_ci		fprintf(stderr, "ERROR: opening BPF object file failed\n");
11962306a36Sopenharmony_ci		return err;
12062306a36Sopenharmony_ci	}
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	/* load BPF program */
12362306a36Sopenharmony_ci	if (bpf_object__load(obj)) {
12462306a36Sopenharmony_ci		fprintf(stderr, "ERROR: loading BPF object file failed\n");
12562306a36Sopenharmony_ci		goto cleanup;
12662306a36Sopenharmony_ci	}
12762306a36Sopenharmony_ci
12862306a36Sopenharmony_ci	map_fd[0] = bpf_object__find_map_fd_by_name(obj, "read_count");
12962306a36Sopenharmony_ci	map_fd[1] = bpf_object__find_map_fd_by_name(obj, "write_count");
13062306a36Sopenharmony_ci	if (map_fd[0] < 0 || map_fd[1] < 0) {
13162306a36Sopenharmony_ci		fprintf(stderr, "ERROR: finding a map in obj file failed\n");
13262306a36Sopenharmony_ci		goto cleanup;
13362306a36Sopenharmony_ci	}
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	bpf_object__for_each_program(prog, obj) {
13662306a36Sopenharmony_ci		tp_links[tp_cnt] = bpf_program__attach(prog);
13762306a36Sopenharmony_ci		if (libbpf_get_error(tp_links[tp_cnt])) {
13862306a36Sopenharmony_ci			fprintf(stderr, "ERROR: bpf_program__attach failed\n");
13962306a36Sopenharmony_ci			tp_links[tp_cnt] = NULL;
14062306a36Sopenharmony_ci			goto cleanup;
14162306a36Sopenharmony_ci		}
14262306a36Sopenharmony_ci		tp_cnt++;
14362306a36Sopenharmony_ci	}
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	while (1) {
14662306a36Sopenharmony_ci		sleep(delay);
14762306a36Sopenharmony_ci		dump_all_counts();
14862306a36Sopenharmony_ci	}
14962306a36Sopenharmony_ci	err = 0;
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_cicleanup:
15262306a36Sopenharmony_ci	/* Detach tracepoints */
15362306a36Sopenharmony_ci	while (tp_cnt)
15462306a36Sopenharmony_ci		bpf_link__destroy(tp_links[--tp_cnt]);
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci	bpf_object__close(obj);
15762306a36Sopenharmony_ci	return err;
15862306a36Sopenharmony_ci}
159