18c2ecf20Sopenharmony_ci/* Copyright (c) 2013-2015 PLUMgrid, http://plumgrid.com
28c2ecf20Sopenharmony_ci *
38c2ecf20Sopenharmony_ci * This program is free software; you can redistribute it and/or
48c2ecf20Sopenharmony_ci * modify it under the terms of version 2 of the GNU General Public
58c2ecf20Sopenharmony_ci * License as published by the Free Software Foundation.
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci#include <linux/skbuff.h>
88c2ecf20Sopenharmony_ci#include <linux/netdevice.h>
98c2ecf20Sopenharmony_ci#include <linux/version.h>
108c2ecf20Sopenharmony_ci#include <uapi/linux/bpf.h>
118c2ecf20Sopenharmony_ci#include <bpf/bpf_helpers.h>
128c2ecf20Sopenharmony_ci#include <bpf/bpf_tracing.h>
138c2ecf20Sopenharmony_ci#include "trace_common.h"
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_cistruct {
168c2ecf20Sopenharmony_ci	__uint(type, BPF_MAP_TYPE_HASH);
178c2ecf20Sopenharmony_ci	__type(key, long);
188c2ecf20Sopenharmony_ci	__type(value, long);
198c2ecf20Sopenharmony_ci	__uint(max_entries, 1024);
208c2ecf20Sopenharmony_ci} my_map SEC(".maps");
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_ci/* kprobe is NOT a stable ABI. If kernel internals change this bpf+kprobe
238c2ecf20Sopenharmony_ci * example will no longer be meaningful
248c2ecf20Sopenharmony_ci */
258c2ecf20Sopenharmony_ciSEC("kprobe/kfree_skb")
268c2ecf20Sopenharmony_ciint bpf_prog2(struct pt_regs *ctx)
278c2ecf20Sopenharmony_ci{
288c2ecf20Sopenharmony_ci	long loc = 0;
298c2ecf20Sopenharmony_ci	long init_val = 1;
308c2ecf20Sopenharmony_ci	long *value;
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	/* read ip of kfree_skb caller.
338c2ecf20Sopenharmony_ci	 * non-portable version of __builtin_return_address(0)
348c2ecf20Sopenharmony_ci	 */
358c2ecf20Sopenharmony_ci	BPF_KPROBE_READ_RET_IP(loc, ctx);
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_ci	value = bpf_map_lookup_elem(&my_map, &loc);
388c2ecf20Sopenharmony_ci	if (value)
398c2ecf20Sopenharmony_ci		*value += 1;
408c2ecf20Sopenharmony_ci	else
418c2ecf20Sopenharmony_ci		bpf_map_update_elem(&my_map, &loc, &init_val, BPF_ANY);
428c2ecf20Sopenharmony_ci	return 0;
438c2ecf20Sopenharmony_ci}
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_cistatic unsigned int log2(unsigned int v)
468c2ecf20Sopenharmony_ci{
478c2ecf20Sopenharmony_ci	unsigned int r;
488c2ecf20Sopenharmony_ci	unsigned int shift;
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_ci	r = (v > 0xFFFF) << 4; v >>= r;
518c2ecf20Sopenharmony_ci	shift = (v > 0xFF) << 3; v >>= shift; r |= shift;
528c2ecf20Sopenharmony_ci	shift = (v > 0xF) << 2; v >>= shift; r |= shift;
538c2ecf20Sopenharmony_ci	shift = (v > 0x3) << 1; v >>= shift; r |= shift;
548c2ecf20Sopenharmony_ci	r |= (v >> 1);
558c2ecf20Sopenharmony_ci	return r;
568c2ecf20Sopenharmony_ci}
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_cistatic unsigned int log2l(unsigned long v)
598c2ecf20Sopenharmony_ci{
608c2ecf20Sopenharmony_ci	unsigned int hi = v >> 32;
618c2ecf20Sopenharmony_ci	if (hi)
628c2ecf20Sopenharmony_ci		return log2(hi) + 32;
638c2ecf20Sopenharmony_ci	else
648c2ecf20Sopenharmony_ci		return log2(v);
658c2ecf20Sopenharmony_ci}
668c2ecf20Sopenharmony_ci
678c2ecf20Sopenharmony_cistruct hist_key {
688c2ecf20Sopenharmony_ci	char comm[16];
698c2ecf20Sopenharmony_ci	u64 pid_tgid;
708c2ecf20Sopenharmony_ci	u64 uid_gid;
718c2ecf20Sopenharmony_ci	u64 index;
728c2ecf20Sopenharmony_ci};
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_cistruct {
758c2ecf20Sopenharmony_ci	__uint(type, BPF_MAP_TYPE_PERCPU_HASH);
768c2ecf20Sopenharmony_ci	__uint(key_size, sizeof(struct hist_key));
778c2ecf20Sopenharmony_ci	__uint(value_size, sizeof(long));
788c2ecf20Sopenharmony_ci	__uint(max_entries, 1024);
798c2ecf20Sopenharmony_ci} my_hist_map SEC(".maps");
808c2ecf20Sopenharmony_ci
818c2ecf20Sopenharmony_ciSEC("kprobe/" SYSCALL(sys_write))
828c2ecf20Sopenharmony_ciint bpf_prog3(struct pt_regs *ctx)
838c2ecf20Sopenharmony_ci{
848c2ecf20Sopenharmony_ci	long write_size = PT_REGS_PARM3(ctx);
858c2ecf20Sopenharmony_ci	long init_val = 1;
868c2ecf20Sopenharmony_ci	long *value;
878c2ecf20Sopenharmony_ci	struct hist_key key;
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci	key.index = log2l(write_size);
908c2ecf20Sopenharmony_ci	key.pid_tgid = bpf_get_current_pid_tgid();
918c2ecf20Sopenharmony_ci	key.uid_gid = bpf_get_current_uid_gid();
928c2ecf20Sopenharmony_ci	bpf_get_current_comm(&key.comm, sizeof(key.comm));
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci	value = bpf_map_lookup_elem(&my_hist_map, &key);
958c2ecf20Sopenharmony_ci	if (value)
968c2ecf20Sopenharmony_ci		__sync_fetch_and_add(value, 1);
978c2ecf20Sopenharmony_ci	else
988c2ecf20Sopenharmony_ci		bpf_map_update_elem(&my_hist_map, &key, &init_val, BPF_ANY);
998c2ecf20Sopenharmony_ci	return 0;
1008c2ecf20Sopenharmony_ci}
1018c2ecf20Sopenharmony_cichar _license[] SEC("license") = "GPL";
1028c2ecf20Sopenharmony_ciu32 _version SEC("version") = LINUX_VERSION_CODE;
103