100899e7eSAlexei Starovoitov // SPDX-License-Identifier: GPL-2.0
200899e7eSAlexei Starovoitov /* Copyright (c) 2021 Facebook */
300899e7eSAlexei Starovoitov #include <linux/stddef.h>
400899e7eSAlexei Starovoitov #include <linux/bpf.h>
500899e7eSAlexei Starovoitov #include <bpf/bpf_helpers.h>
600899e7eSAlexei Starovoitov #include <bpf/bpf_tracing.h>
700899e7eSAlexei Starovoitov #include <../../../tools/include/linux/filter.h>
8*2341d6bbSAlexei Starovoitov #include <linux/btf.h>
900899e7eSAlexei Starovoitov 
1000899e7eSAlexei Starovoitov char _license[] SEC("license") = "GPL";
1100899e7eSAlexei Starovoitov 
1200899e7eSAlexei Starovoitov struct args {
1300899e7eSAlexei Starovoitov 	__u64 log_buf;
1400899e7eSAlexei Starovoitov 	__u32 log_size;
1500899e7eSAlexei Starovoitov 	int max_entries;
1600899e7eSAlexei Starovoitov 	int map_fd;
1700899e7eSAlexei Starovoitov 	int prog_fd;
18*2341d6bbSAlexei Starovoitov 	int btf_fd;
1900899e7eSAlexei Starovoitov };
2000899e7eSAlexei Starovoitov 
21*2341d6bbSAlexei Starovoitov #define BTF_INFO_ENC(kind, kind_flag, vlen) \
22*2341d6bbSAlexei Starovoitov 	((!!(kind_flag) << 31) | ((kind) << 24) | ((vlen) & BTF_MAX_VLEN))
23*2341d6bbSAlexei Starovoitov #define BTF_TYPE_ENC(name, info, size_or_type) (name), (info), (size_or_type)
24*2341d6bbSAlexei Starovoitov #define BTF_INT_ENC(encoding, bits_offset, nr_bits) \
25*2341d6bbSAlexei Starovoitov 	((encoding) << 24 | (bits_offset) << 16 | (nr_bits))
26*2341d6bbSAlexei Starovoitov #define BTF_TYPE_INT_ENC(name, encoding, bits_offset, bits, sz) \
27*2341d6bbSAlexei Starovoitov 	BTF_TYPE_ENC(name, BTF_INFO_ENC(BTF_KIND_INT, 0, 0), sz), \
28*2341d6bbSAlexei Starovoitov 	BTF_INT_ENC(encoding, bits_offset, bits)
29*2341d6bbSAlexei Starovoitov 
btf_load(void)30*2341d6bbSAlexei Starovoitov static int btf_load(void)
31*2341d6bbSAlexei Starovoitov {
32*2341d6bbSAlexei Starovoitov 	struct btf_blob {
33*2341d6bbSAlexei Starovoitov 		struct btf_header btf_hdr;
34*2341d6bbSAlexei Starovoitov 		__u32 types[8];
35*2341d6bbSAlexei Starovoitov 		__u32 str;
36*2341d6bbSAlexei Starovoitov 	} raw_btf = {
37*2341d6bbSAlexei Starovoitov 		.btf_hdr = {
38*2341d6bbSAlexei Starovoitov 			.magic = BTF_MAGIC,
39*2341d6bbSAlexei Starovoitov 			.version = BTF_VERSION,
40*2341d6bbSAlexei Starovoitov 			.hdr_len = sizeof(struct btf_header),
41*2341d6bbSAlexei Starovoitov 			.type_len = sizeof(__u32) * 8,
42*2341d6bbSAlexei Starovoitov 			.str_off = sizeof(__u32) * 8,
43*2341d6bbSAlexei Starovoitov 			.str_len = sizeof(__u32),
44*2341d6bbSAlexei Starovoitov 		},
45*2341d6bbSAlexei Starovoitov 		.types = {
46*2341d6bbSAlexei Starovoitov 			/* long */
47*2341d6bbSAlexei Starovoitov 			BTF_TYPE_INT_ENC(0, BTF_INT_SIGNED, 0, 64, 8),  /* [1] */
48*2341d6bbSAlexei Starovoitov 			/* unsigned long */
49*2341d6bbSAlexei Starovoitov 			BTF_TYPE_INT_ENC(0, 0, 0, 64, 8),  /* [2] */
50*2341d6bbSAlexei Starovoitov 		},
51*2341d6bbSAlexei Starovoitov 	};
52*2341d6bbSAlexei Starovoitov 	static union bpf_attr btf_load_attr = {
53*2341d6bbSAlexei Starovoitov 		.btf_size = sizeof(raw_btf),
54*2341d6bbSAlexei Starovoitov 	};
55*2341d6bbSAlexei Starovoitov 
56*2341d6bbSAlexei Starovoitov 	btf_load_attr.btf = (long)&raw_btf;
57*2341d6bbSAlexei Starovoitov 	return bpf_sys_bpf(BPF_BTF_LOAD, &btf_load_attr, sizeof(btf_load_attr));
58*2341d6bbSAlexei Starovoitov }
59*2341d6bbSAlexei Starovoitov 
6000899e7eSAlexei Starovoitov SEC("syscall")
bpf_prog(struct args * ctx)6100899e7eSAlexei Starovoitov int bpf_prog(struct args *ctx)
6200899e7eSAlexei Starovoitov {
6300899e7eSAlexei Starovoitov 	static char license[] = "GPL";
6400899e7eSAlexei Starovoitov 	static struct bpf_insn insns[] = {
6500899e7eSAlexei Starovoitov 		BPF_ST_MEM(BPF_DW, BPF_REG_10, -8, 0),
6600899e7eSAlexei Starovoitov 		BPF_MOV64_REG(BPF_REG_2, BPF_REG_10),
6700899e7eSAlexei Starovoitov 		BPF_ALU64_IMM(BPF_ADD, BPF_REG_2, -8),
6800899e7eSAlexei Starovoitov 		BPF_LD_MAP_FD(BPF_REG_1, 0),
6900899e7eSAlexei Starovoitov 		BPF_RAW_INSN(BPF_JMP | BPF_CALL, 0, 0, 0, BPF_FUNC_map_lookup_elem),
7000899e7eSAlexei Starovoitov 		BPF_MOV64_IMM(BPF_REG_0, 0),
7100899e7eSAlexei Starovoitov 		BPF_EXIT_INSN(),
7200899e7eSAlexei Starovoitov 	};
7300899e7eSAlexei Starovoitov 	static union bpf_attr map_create_attr = {
7400899e7eSAlexei Starovoitov 		.map_type = BPF_MAP_TYPE_HASH,
7500899e7eSAlexei Starovoitov 		.key_size = 8,
7600899e7eSAlexei Starovoitov 		.value_size = 8,
77*2341d6bbSAlexei Starovoitov 		.btf_key_type_id = 1,
78*2341d6bbSAlexei Starovoitov 		.btf_value_type_id = 2,
7900899e7eSAlexei Starovoitov 	};
8000899e7eSAlexei Starovoitov 	static union bpf_attr map_update_attr = { .map_fd = 1, };
8100899e7eSAlexei Starovoitov 	static __u64 key = 12;
8200899e7eSAlexei Starovoitov 	static __u64 value = 34;
8300899e7eSAlexei Starovoitov 	static union bpf_attr prog_load_attr = {
8400899e7eSAlexei Starovoitov 		.prog_type = BPF_PROG_TYPE_XDP,
8500899e7eSAlexei Starovoitov 		.insn_cnt = sizeof(insns) / sizeof(insns[0]),
8600899e7eSAlexei Starovoitov 	};
8700899e7eSAlexei Starovoitov 	int ret;
8800899e7eSAlexei Starovoitov 
89*2341d6bbSAlexei Starovoitov 	ret = btf_load();
90*2341d6bbSAlexei Starovoitov 	if (ret <= 0)
91*2341d6bbSAlexei Starovoitov 		return ret;
92*2341d6bbSAlexei Starovoitov 
93*2341d6bbSAlexei Starovoitov 	ctx->btf_fd = ret;
9400899e7eSAlexei Starovoitov 	map_create_attr.max_entries = ctx->max_entries;
95*2341d6bbSAlexei Starovoitov 	map_create_attr.btf_fd = ret;
96*2341d6bbSAlexei Starovoitov 
9700899e7eSAlexei Starovoitov 	prog_load_attr.license = (long) license;
9800899e7eSAlexei Starovoitov 	prog_load_attr.insns = (long) insns;
9900899e7eSAlexei Starovoitov 	prog_load_attr.log_buf = ctx->log_buf;
10000899e7eSAlexei Starovoitov 	prog_load_attr.log_size = ctx->log_size;
10100899e7eSAlexei Starovoitov 	prog_load_attr.log_level = 1;
10200899e7eSAlexei Starovoitov 
10300899e7eSAlexei Starovoitov 	ret = bpf_sys_bpf(BPF_MAP_CREATE, &map_create_attr, sizeof(map_create_attr));
10400899e7eSAlexei Starovoitov 	if (ret <= 0)
10500899e7eSAlexei Starovoitov 		return ret;
10600899e7eSAlexei Starovoitov 	ctx->map_fd = ret;
10700899e7eSAlexei Starovoitov 	insns[3].imm = ret;
10800899e7eSAlexei Starovoitov 
10900899e7eSAlexei Starovoitov 	map_update_attr.map_fd = ret;
11000899e7eSAlexei Starovoitov 	map_update_attr.key = (long) &key;
11100899e7eSAlexei Starovoitov 	map_update_attr.value = (long) &value;
11200899e7eSAlexei Starovoitov 	ret = bpf_sys_bpf(BPF_MAP_UPDATE_ELEM, &map_update_attr, sizeof(map_update_attr));
11300899e7eSAlexei Starovoitov 	if (ret < 0)
11400899e7eSAlexei Starovoitov 		return ret;
11500899e7eSAlexei Starovoitov 
11600899e7eSAlexei Starovoitov 	ret = bpf_sys_bpf(BPF_PROG_LOAD, &prog_load_attr, sizeof(prog_load_attr));
11700899e7eSAlexei Starovoitov 	if (ret <= 0)
11800899e7eSAlexei Starovoitov 		return ret;
11900899e7eSAlexei Starovoitov 	ctx->prog_fd = ret;
12000899e7eSAlexei Starovoitov 	return 1;
12100899e7eSAlexei Starovoitov }
122