1*58d84beeSYonghong Song // SPDX-License-Identifier: GPL-2.0
2*58d84beeSYonghong Song /* Copyright (c) 2022 Meta Platforms, Inc. and affiliates. */
3*58d84beeSYonghong Song #include "vmlinux.h"
4*58d84beeSYonghong Song #include <bpf/bpf_helpers.h>
5*58d84beeSYonghong Song #include <bpf/bpf_tracing.h>
6*58d84beeSYonghong Song #include <bpf/bpf_core_read.h>
7*58d84beeSYonghong Song 
8*58d84beeSYonghong Song struct {
9*58d84beeSYonghong Song 	__uint(type, BPF_MAP_TYPE_TASK_STORAGE);
10*58d84beeSYonghong Song 	__uint(map_flags, BPF_F_NO_PREALLOC);
11*58d84beeSYonghong Song 	__type(key, int);
12*58d84beeSYonghong Song 	__type(value, long);
13*58d84beeSYonghong Song } enter_id SEC(".maps");
14*58d84beeSYonghong Song 
15*58d84beeSYonghong Song #define	IFNAMSIZ 16
16*58d84beeSYonghong Song 
17*58d84beeSYonghong Song int ifindex, ingress_ifindex;
18*58d84beeSYonghong Song char name[IFNAMSIZ];
19*58d84beeSYonghong Song unsigned int inum;
20*58d84beeSYonghong Song unsigned int meta_len, frag0_len, kskb_len, kskb2_len;
21*58d84beeSYonghong Song 
22*58d84beeSYonghong Song void *bpf_cast_to_kern_ctx(void *) __ksym;
23*58d84beeSYonghong Song void *bpf_rdonly_cast(void *, __u32) __ksym;
24*58d84beeSYonghong Song 
25*58d84beeSYonghong Song SEC("?xdp")
md_xdp(struct xdp_md * ctx)26*58d84beeSYonghong Song int md_xdp(struct xdp_md *ctx)
27*58d84beeSYonghong Song {
28*58d84beeSYonghong Song 	struct xdp_buff *kctx = bpf_cast_to_kern_ctx(ctx);
29*58d84beeSYonghong Song 	struct net_device *dev;
30*58d84beeSYonghong Song 
31*58d84beeSYonghong Song 	dev = kctx->rxq->dev;
32*58d84beeSYonghong Song 	ifindex = dev->ifindex;
33*58d84beeSYonghong Song 	inum = dev->nd_net.net->ns.inum;
34*58d84beeSYonghong Song 	__builtin_memcpy(name, dev->name, IFNAMSIZ);
35*58d84beeSYonghong Song 	ingress_ifindex = ctx->ingress_ifindex;
36*58d84beeSYonghong Song 	return XDP_PASS;
37*58d84beeSYonghong Song }
38*58d84beeSYonghong Song 
39*58d84beeSYonghong Song SEC("?tc")
md_skb(struct __sk_buff * skb)40*58d84beeSYonghong Song int md_skb(struct __sk_buff *skb)
41*58d84beeSYonghong Song {
42*58d84beeSYonghong Song 	struct sk_buff *kskb = bpf_cast_to_kern_ctx(skb);
43*58d84beeSYonghong Song 	struct skb_shared_info *shared_info;
44*58d84beeSYonghong Song 	struct sk_buff *kskb2;
45*58d84beeSYonghong Song 
46*58d84beeSYonghong Song 	kskb_len = kskb->len;
47*58d84beeSYonghong Song 
48*58d84beeSYonghong Song 	/* Simulate the following kernel macro:
49*58d84beeSYonghong Song 	 *   #define skb_shinfo(SKB) ((struct skb_shared_info *)(skb_end_pointer(SKB)))
50*58d84beeSYonghong Song 	 */
51*58d84beeSYonghong Song 	shared_info = bpf_rdonly_cast(kskb->head + kskb->end,
52*58d84beeSYonghong Song 		bpf_core_type_id_kernel(struct skb_shared_info));
53*58d84beeSYonghong Song 	meta_len = shared_info->meta_len;
54*58d84beeSYonghong Song 	frag0_len = shared_info->frag_list->len;
55*58d84beeSYonghong Song 
56*58d84beeSYonghong Song 	/* kskb2 should be equal to kskb */
57*58d84beeSYonghong Song 	kskb2 = bpf_rdonly_cast(kskb, bpf_core_type_id_kernel(struct sk_buff));
58*58d84beeSYonghong Song 	kskb2_len = kskb2->len;
59*58d84beeSYonghong Song 	return 0;
60*58d84beeSYonghong Song }
61*58d84beeSYonghong Song 
62*58d84beeSYonghong Song SEC("?tp_btf/sys_enter")
BPF_PROG(untrusted_ptr,struct pt_regs * regs,long id)63*58d84beeSYonghong Song int BPF_PROG(untrusted_ptr, struct pt_regs *regs, long id)
64*58d84beeSYonghong Song {
65*58d84beeSYonghong Song 	struct task_struct *task, *task_dup;
66*58d84beeSYonghong Song 
67*58d84beeSYonghong Song 	task = bpf_get_current_task_btf();
68*58d84beeSYonghong Song 	task_dup = bpf_rdonly_cast(task, bpf_core_type_id_kernel(struct task_struct));
69*58d84beeSYonghong Song 	(void)bpf_task_storage_get(&enter_id, task_dup, 0, 0);
70*58d84beeSYonghong Song 	return 0;
71*58d84beeSYonghong Song }
72*58d84beeSYonghong Song 
73*58d84beeSYonghong Song SEC("?tracepoint/syscalls/sys_enter_nanosleep")
kctx_u64(void * ctx)74*58d84beeSYonghong Song int kctx_u64(void *ctx)
75*58d84beeSYonghong Song {
76*58d84beeSYonghong Song 	u64 *kctx = bpf_rdonly_cast(ctx, bpf_core_type_id_kernel(u64));
77*58d84beeSYonghong Song 
78*58d84beeSYonghong Song 	(void)kctx;
79*58d84beeSYonghong Song 	return 0;
80*58d84beeSYonghong Song }
81*58d84beeSYonghong Song 
82*58d84beeSYonghong Song char _license[] SEC("license") = "GPL";
83