#include <linux/module.h>
#include <linux/simple_ring_buffer.h>
#include <linux/trace_remote.h>
#include <linux/tracefs.h>
#include <linux/types.h>
#define REMOTE_EVENT_INCLUDE_FILE kernel/trace/remote_test_events.h
#include <trace/define_remote_events.h>
static DEFINE_PER_CPU(struct simple_rb_per_cpu *, simple_rbs);
static struct trace_buffer_desc *remote_test_buffer_desc;
static DEFINE_MUTEX(simple_rbs_lock);
static int remote_test_load_simple_rb(int cpu, struct ring_buffer_desc *rb_desc)
{
struct simple_rb_per_cpu *cpu_buffer;
struct simple_buffer_page *bpages;
int ret = -ENOMEM;
cpu_buffer = kmalloc_obj(*cpu_buffer);
if (!cpu_buffer)
return ret;
bpages = kmalloc_objs(*bpages, rb_desc->nr_page_va);
if (!bpages)
goto err_free_cpu_buffer;
ret = simple_ring_buffer_init(cpu_buffer, bpages, rb_desc);
if (ret)
goto err_free_bpages;
scoped_guard(mutex, &simple_rbs_lock) {
WARN_ON(*per_cpu_ptr(&simple_rbs, cpu));
*per_cpu_ptr(&simple_rbs, cpu) = cpu_buffer;
}
return 0;
err_free_bpages:
kfree(bpages);
err_free_cpu_buffer:
kfree(cpu_buffer);
return ret;
}
static void remote_test_unload_simple_rb(int cpu)
{
struct simple_rb_per_cpu *cpu_buffer = *per_cpu_ptr(&simple_rbs, cpu);
struct simple_buffer_page *bpages;
if (!cpu_buffer)
return;
guard(mutex)(&simple_rbs_lock);
bpages = cpu_buffer->bpages;
simple_ring_buffer_unload(cpu_buffer);
kfree(bpages);
kfree(cpu_buffer);
*per_cpu_ptr(&simple_rbs, cpu) = NULL;
}
static struct trace_buffer_desc *remote_test_load(unsigned long size, void *unused)
{
struct ring_buffer_desc *rb_desc;
struct trace_buffer_desc *desc;
size_t desc_size;
int cpu, ret;
if (WARN_ON(remote_test_buffer_desc))
return ERR_PTR(-EINVAL);
desc_size = trace_buffer_desc_size(size, num_possible_cpus());
if (desc_size == SIZE_MAX) {
ret = -E2BIG;
goto err;
}
desc = kmalloc(desc_size, GFP_KERNEL);
if (!desc) {
ret = -ENOMEM;
goto err;
}
ret = trace_remote_alloc_buffer(desc, desc_size, size, cpu_possible_mask);
if (ret)
goto err_free_desc;
for_each_ring_buffer_desc(rb_desc, cpu, desc) {
ret = remote_test_load_simple_rb(rb_desc->cpu, rb_desc);
if (ret)
goto err_unload;
}
remote_test_buffer_desc = desc;
return remote_test_buffer_desc;
err_unload:
for_each_ring_buffer_desc(rb_desc, cpu, remote_test_buffer_desc)
remote_test_unload_simple_rb(rb_desc->cpu);
trace_remote_free_buffer(remote_test_buffer_desc);
err_free_desc:
kfree(desc);
err:
return ERR_PTR(ret);
}
static void remote_test_unload(struct trace_buffer_desc *desc, void *unused)
{
struct ring_buffer_desc *rb_desc;
int cpu;
if (WARN_ON(desc != remote_test_buffer_desc))
return;
for_each_ring_buffer_desc(rb_desc, cpu, desc)
remote_test_unload_simple_rb(rb_desc->cpu);
remote_test_buffer_desc = NULL;
trace_remote_free_buffer(desc);
kfree(desc);
}
static int remote_test_enable_tracing(bool enable, void *unused)
{
struct ring_buffer_desc *rb_desc;
int cpu;
if (!remote_test_buffer_desc)
return -ENODEV;
for_each_ring_buffer_desc(rb_desc, cpu, remote_test_buffer_desc)
WARN_ON(simple_ring_buffer_enable_tracing(*per_cpu_ptr(&simple_rbs, rb_desc->cpu),
enable));
return 0;
}
static int remote_test_swap_reader_page(unsigned int cpu, void *unused)
{
struct simple_rb_per_cpu *cpu_buffer;
if (cpu >= NR_CPUS)
return -EINVAL;
cpu_buffer = *per_cpu_ptr(&simple_rbs, cpu);
if (!cpu_buffer)
return -EINVAL;
return simple_ring_buffer_swap_reader_page(cpu_buffer);
}
static int remote_test_reset(unsigned int cpu, void *unused)
{
struct simple_rb_per_cpu *cpu_buffer;
if (cpu >= NR_CPUS)
return -EINVAL;
cpu_buffer = *per_cpu_ptr(&simple_rbs, cpu);
if (!cpu_buffer)
return -EINVAL;
return simple_ring_buffer_reset(cpu_buffer);
}
static int remote_test_enable_event(unsigned short id, bool enable, void *unused)
{
if (id != REMOTE_TEST_EVENT_ID)
return -EINVAL;
return 0;
}
static ssize_t
write_event_write(struct file *filp, const char __user *ubuf, size_t cnt, loff_t *pos)
{
struct remote_event_format_selftest *evt_test;
struct simple_rb_per_cpu *cpu_buffer;
unsigned long val;
int ret;
ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
if (ret)
return ret;
guard(mutex)(&simple_rbs_lock);
if (!remote_event_selftest.enabled)
return -ENODEV;
guard(preempt)();
cpu_buffer = *this_cpu_ptr(&simple_rbs);
if (!cpu_buffer)
return -ENODEV;
evt_test = simple_ring_buffer_reserve(cpu_buffer,
sizeof(struct remote_event_format_selftest),
trace_clock_global());
if (!evt_test)
return -ENODEV;
evt_test->hdr.id = REMOTE_TEST_EVENT_ID;
evt_test->id = val;
simple_ring_buffer_commit(cpu_buffer);
return cnt;
}
static const struct file_operations write_event_fops = {
.write = write_event_write,
};
static int remote_test_init_tracefs(struct dentry *d, void *unused)
{
return tracefs_create_file("write_event", 0200, d, NULL, &write_event_fops) ?
0 : -ENOMEM;
}
static struct trace_remote_callbacks trace_remote_callbacks = {
.init = remote_test_init_tracefs,
.load_trace_buffer = remote_test_load,
.unload_trace_buffer = remote_test_unload,
.enable_tracing = remote_test_enable_tracing,
.swap_reader_page = remote_test_swap_reader_page,
.reset = remote_test_reset,
.enable_event = remote_test_enable_event,
};
static int __init remote_test_init(void)
{
return trace_remote_register("test", &trace_remote_callbacks, NULL,
&remote_event_selftest, 1);
}
module_init(remote_test_init);
MODULE_DESCRIPTION("Test module for the trace remote interface");
MODULE_AUTHOR("Vincent Donnefort");
MODULE_LICENSE("GPL");