forked from Minki/linux
174 lines
3.8 KiB
C
174 lines
3.8 KiB
C
|
/*
|
||
|
* Copyright (c) 2017 Facebook
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or
|
||
|
* modify it under the terms of version 2 of the GNU General Public
|
||
|
* License as published by the Free Software Foundation.
|
||
|
*/
|
||
|
#define KBUILD_MODNAME "foo"
|
||
|
#include <linux/ptrace.h>
|
||
|
#include <linux/version.h>
|
||
|
#include <uapi/linux/bpf.h>
|
||
|
#include <uapi/linux/in6.h>
|
||
|
#include "bpf_helpers.h"
|
||
|
|
||
|
#define MAX_NR_PORTS 65536
|
||
|
|
||
|
/* map #0 */
|
||
|
struct bpf_map_def SEC("maps") port_a = {
|
||
|
.type = BPF_MAP_TYPE_ARRAY,
|
||
|
.key_size = sizeof(u32),
|
||
|
.value_size = sizeof(int),
|
||
|
.max_entries = MAX_NR_PORTS,
|
||
|
};
|
||
|
|
||
|
/* map #1 */
|
||
|
struct bpf_map_def SEC("maps") port_h = {
|
||
|
.type = BPF_MAP_TYPE_HASH,
|
||
|
.key_size = sizeof(u32),
|
||
|
.value_size = sizeof(int),
|
||
|
.max_entries = 1,
|
||
|
};
|
||
|
|
||
|
/* map #2 */
|
||
|
struct bpf_map_def SEC("maps") reg_result_h = {
|
||
|
.type = BPF_MAP_TYPE_HASH,
|
||
|
.key_size = sizeof(u32),
|
||
|
.value_size = sizeof(int),
|
||
|
.max_entries = 1,
|
||
|
};
|
||
|
|
||
|
/* map #3 */
|
||
|
struct bpf_map_def SEC("maps") inline_result_h = {
|
||
|
.type = BPF_MAP_TYPE_HASH,
|
||
|
.key_size = sizeof(u32),
|
||
|
.value_size = sizeof(int),
|
||
|
.max_entries = 1,
|
||
|
};
|
||
|
|
||
|
/* map #4 */ /* Test case #0 */
|
||
|
struct bpf_map_def SEC("maps") a_of_port_a = {
|
||
|
.type = BPF_MAP_TYPE_ARRAY_OF_MAPS,
|
||
|
.key_size = sizeof(u32),
|
||
|
.inner_map_idx = 0, /* map_fd[0] is port_a */
|
||
|
.max_entries = MAX_NR_PORTS,
|
||
|
};
|
||
|
|
||
|
/* map #5 */ /* Test case #1 */
|
||
|
struct bpf_map_def SEC("maps") h_of_port_a = {
|
||
|
.type = BPF_MAP_TYPE_HASH_OF_MAPS,
|
||
|
.key_size = sizeof(u32),
|
||
|
.inner_map_idx = 0, /* map_fd[0] is port_a */
|
||
|
.max_entries = 1,
|
||
|
};
|
||
|
|
||
|
/* map #6 */ /* Test case #2 */
|
||
|
struct bpf_map_def SEC("maps") h_of_port_h = {
|
||
|
.type = BPF_MAP_TYPE_HASH_OF_MAPS,
|
||
|
.key_size = sizeof(u32),
|
||
|
.inner_map_idx = 1, /* map_fd[1] is port_h */
|
||
|
.max_entries = 1,
|
||
|
};
|
||
|
|
||
|
static __always_inline int do_reg_lookup(void *inner_map, u32 port)
|
||
|
{
|
||
|
int *result;
|
||
|
|
||
|
result = bpf_map_lookup_elem(inner_map, &port);
|
||
|
return result ? *result : -ENOENT;
|
||
|
}
|
||
|
|
||
|
static __always_inline int do_inline_array_lookup(void *inner_map, u32 port)
|
||
|
{
|
||
|
int *result;
|
||
|
|
||
|
if (inner_map != &port_a)
|
||
|
return -EINVAL;
|
||
|
|
||
|
result = bpf_map_lookup_elem(&port_a, &port);
|
||
|
return result ? *result : -ENOENT;
|
||
|
}
|
||
|
|
||
|
static __always_inline int do_inline_hash_lookup(void *inner_map, u32 port)
|
||
|
{
|
||
|
int *result;
|
||
|
|
||
|
if (inner_map != &port_h)
|
||
|
return -EINVAL;
|
||
|
|
||
|
result = bpf_map_lookup_elem(&port_h, &port);
|
||
|
return result ? *result : -ENOENT;
|
||
|
}
|
||
|
|
||
|
SEC("kprobe/sys_connect")
|
||
|
int trace_sys_connect(struct pt_regs *ctx)
|
||
|
{
|
||
|
struct sockaddr_in6 *in6;
|
||
|
u16 test_case, port, dst6[8];
|
||
|
int addrlen, ret, inline_ret, ret_key = 0;
|
||
|
u32 port_key;
|
||
|
void *outer_map, *inner_map;
|
||
|
bool inline_hash = false;
|
||
|
|
||
|
in6 = (struct sockaddr_in6 *)PT_REGS_PARM2(ctx);
|
||
|
addrlen = (int)PT_REGS_PARM3(ctx);
|
||
|
|
||
|
if (addrlen != sizeof(*in6))
|
||
|
return 0;
|
||
|
|
||
|
ret = bpf_probe_read(dst6, sizeof(dst6), &in6->sin6_addr);
|
||
|
if (ret) {
|
||
|
inline_ret = ret;
|
||
|
goto done;
|
||
|
}
|
||
|
|
||
|
if (dst6[0] != 0xdead || dst6[1] != 0xbeef)
|
||
|
return 0;
|
||
|
|
||
|
test_case = dst6[7];
|
||
|
|
||
|
ret = bpf_probe_read(&port, sizeof(port), &in6->sin6_port);
|
||
|
if (ret) {
|
||
|
inline_ret = ret;
|
||
|
goto done;
|
||
|
}
|
||
|
|
||
|
port_key = port;
|
||
|
|
||
|
ret = -ENOENT;
|
||
|
if (test_case == 0) {
|
||
|
outer_map = &a_of_port_a;
|
||
|
} else if (test_case == 1) {
|
||
|
outer_map = &h_of_port_a;
|
||
|
} else if (test_case == 2) {
|
||
|
outer_map = &h_of_port_h;
|
||
|
} else {
|
||
|
ret = __LINE__;
|
||
|
inline_ret = ret;
|
||
|
goto done;
|
||
|
}
|
||
|
|
||
|
inner_map = bpf_map_lookup_elem(outer_map, &port_key);
|
||
|
if (!inner_map) {
|
||
|
ret = __LINE__;
|
||
|
inline_ret = ret;
|
||
|
goto done;
|
||
|
}
|
||
|
|
||
|
ret = do_reg_lookup(inner_map, port_key);
|
||
|
|
||
|
if (test_case == 0 || test_case == 1)
|
||
|
inline_ret = do_inline_array_lookup(inner_map, port_key);
|
||
|
else
|
||
|
inline_ret = do_inline_hash_lookup(inner_map, port_key);
|
||
|
|
||
|
done:
|
||
|
bpf_map_update_elem(®_result_h, &ret_key, &ret, BPF_ANY);
|
||
|
bpf_map_update_elem(&inline_result_h, &ret_key, &inline_ret, BPF_ANY);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
char _license[] SEC("license") = "GPL";
|
||
|
u32 _version SEC("version") = LINUX_VERSION_CODE;
|