mirror of https://gitee.com/openkylin/linux.git
187 lines
3.8 KiB
C
187 lines
3.8 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
#define _GNU_SOURCE
|
|
#include <pthread.h>
|
|
#include <inttypes.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <asm/types.h>
|
|
#include <sys/syscall.h>
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
#include <linux/bpf.h>
|
|
#include <sys/socket.h>
|
|
#include <bpf/bpf.h>
|
|
#include <bpf/libbpf.h>
|
|
#include <sys/ioctl.h>
|
|
#include <linux/rtnetlink.h>
|
|
#include <signal.h>
|
|
#include <linux/perf_event.h>
|
|
|
|
#include "bpf_rlimit.h"
|
|
#include "bpf_util.h"
|
|
#include "cgroup_helpers.h"
|
|
|
|
#include "test_tcpnotify.h"
|
|
#include "trace_helpers.h"
|
|
|
|
#define SOCKET_BUFFER_SIZE (getpagesize() < 8192L ? getpagesize() : 8192L)
|
|
|
|
pthread_t tid;
|
|
int rx_callbacks;
|
|
|
|
static int dummyfn(void *data, int size)
|
|
{
|
|
struct tcp_notifier *t = data;
|
|
|
|
if (t->type != 0xde || t->subtype != 0xad ||
|
|
t->source != 0xbe || t->hash != 0xef)
|
|
return 1;
|
|
rx_callbacks++;
|
|
return 0;
|
|
}
|
|
|
|
void tcp_notifier_poller(int fd)
|
|
{
|
|
while (1)
|
|
perf_event_poller(fd, dummyfn);
|
|
}
|
|
|
|
static void *poller_thread(void *arg)
|
|
{
|
|
int fd = *(int *)arg;
|
|
|
|
tcp_notifier_poller(fd);
|
|
return arg;
|
|
}
|
|
|
|
int verify_result(const struct tcpnotify_globals *result)
|
|
{
|
|
return (result->ncalls > 0 && result->ncalls == rx_callbacks ? 0 : 1);
|
|
}
|
|
|
|
static int bpf_find_map(const char *test, struct bpf_object *obj,
|
|
const char *name)
|
|
{
|
|
struct bpf_map *map;
|
|
|
|
map = bpf_object__find_map_by_name(obj, name);
|
|
if (!map) {
|
|
printf("%s:FAIL:map '%s' not found\n", test, name);
|
|
return -1;
|
|
}
|
|
return bpf_map__fd(map);
|
|
}
|
|
|
|
static int setup_bpf_perf_event(int mapfd)
|
|
{
|
|
struct perf_event_attr attr = {
|
|
.sample_type = PERF_SAMPLE_RAW,
|
|
.type = PERF_TYPE_SOFTWARE,
|
|
.config = PERF_COUNT_SW_BPF_OUTPUT,
|
|
};
|
|
int key = 0;
|
|
int pmu_fd;
|
|
|
|
pmu_fd = syscall(__NR_perf_event_open, &attr, -1, 0, -1, 0);
|
|
if (pmu_fd < 0)
|
|
return pmu_fd;
|
|
bpf_map_update_elem(mapfd, &key, &pmu_fd, BPF_ANY);
|
|
|
|
ioctl(pmu_fd, PERF_EVENT_IOC_ENABLE, 0);
|
|
return pmu_fd;
|
|
}
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
const char *file = "test_tcpnotify_kern.o";
|
|
int prog_fd, map_fd, perf_event_fd;
|
|
struct tcpnotify_globals g = {0};
|
|
const char *cg_path = "/foo";
|
|
int error = EXIT_FAILURE;
|
|
struct bpf_object *obj;
|
|
int cg_fd = -1;
|
|
__u32 key = 0;
|
|
int rv;
|
|
char test_script[80];
|
|
int pmu_fd;
|
|
cpu_set_t cpuset;
|
|
|
|
CPU_ZERO(&cpuset);
|
|
CPU_SET(0, &cpuset);
|
|
pthread_setaffinity_np(pthread_self(), sizeof(cpu_set_t), &cpuset);
|
|
|
|
if (setup_cgroup_environment())
|
|
goto err;
|
|
|
|
cg_fd = create_and_get_cgroup(cg_path);
|
|
if (cg_fd < 0)
|
|
goto err;
|
|
|
|
if (join_cgroup(cg_path))
|
|
goto err;
|
|
|
|
if (bpf_prog_load(file, BPF_PROG_TYPE_SOCK_OPS, &obj, &prog_fd)) {
|
|
printf("FAILED: load_bpf_file failed for: %s\n", file);
|
|
goto err;
|
|
}
|
|
|
|
rv = bpf_prog_attach(prog_fd, cg_fd, BPF_CGROUP_SOCK_OPS, 0);
|
|
if (rv) {
|
|
printf("FAILED: bpf_prog_attach: %d (%s)\n",
|
|
error, strerror(errno));
|
|
goto err;
|
|
}
|
|
|
|
perf_event_fd = bpf_find_map(__func__, obj, "perf_event_map");
|
|
if (perf_event_fd < 0)
|
|
goto err;
|
|
|
|
map_fd = bpf_find_map(__func__, obj, "global_map");
|
|
if (map_fd < 0)
|
|
goto err;
|
|
|
|
pmu_fd = setup_bpf_perf_event(perf_event_fd);
|
|
if (pmu_fd < 0 || perf_event_mmap(pmu_fd) < 0)
|
|
goto err;
|
|
|
|
pthread_create(&tid, NULL, poller_thread, (void *)&pmu_fd);
|
|
|
|
sprintf(test_script,
|
|
"iptables -A INPUT -p tcp --dport %d -j DROP",
|
|
TESTPORT);
|
|
system(test_script);
|
|
|
|
sprintf(test_script,
|
|
"nc 127.0.0.1 %d < /etc/passwd > /dev/null 2>&1 ",
|
|
TESTPORT);
|
|
system(test_script);
|
|
|
|
sprintf(test_script,
|
|
"iptables -D INPUT -p tcp --dport %d -j DROP",
|
|
TESTPORT);
|
|
system(test_script);
|
|
|
|
rv = bpf_map_lookup_elem(map_fd, &key, &g);
|
|
if (rv != 0) {
|
|
printf("FAILED: bpf_map_lookup_elem returns %d\n", rv);
|
|
goto err;
|
|
}
|
|
|
|
sleep(10);
|
|
|
|
if (verify_result(&g)) {
|
|
printf("FAILED: Wrong stats Expected %d calls, got %d\n",
|
|
g.ncalls, rx_callbacks);
|
|
goto err;
|
|
}
|
|
|
|
printf("PASSED!\n");
|
|
error = 0;
|
|
err:
|
|
bpf_prog_detach(cg_fd, BPF_CGROUP_SOCK_OPS);
|
|
close(cg_fd);
|
|
cleanup_cgroup_environment();
|
|
return error;
|
|
}
|