[mirror_ubuntu-jammy-kernel.git] / kernel / trace / trace_power.c

/*
 * ring buffer based C-state tracer
 *
 * Arjan van de Ven <arjan@linux.intel.com>
 * Copyright (C) 2008 Intel Corporation
 *
 * Much is borrowed from trace_boot.c which is
 * Copyright (C) 2008 Frederic Weisbecker <fweisbec@gmail.com>
 *
 */

#include <linux/init.h>
#include <linux/debugfs.h>
#include <trace/power.h>
#include <linux/kallsyms.h>
#include <linux/module.h>

#include "trace.h"
#include "trace_output.h"

static struct trace_array *power_trace;
static int __read_mostly trace_power_enabled;

static void probe_power_start(struct power_trace *it, unsigned int type,
				unsigned int level)
{
	if (!trace_power_enabled)
		return;

	memset(it, 0, sizeof(struct power_trace));
	it->state = level;
	it->type = type;
	it->stamp = ktime_get();
}


static void probe_power_end(struct power_trace *it)
{
	struct ring_buffer_event *event;
	struct trace_power *entry;
	struct trace_array_cpu *data;
	struct trace_array *tr = power_trace;

	if (!trace_power_enabled)
		return;

	preempt_disable();
	it->end = ktime_get();
	data = tr->data[smp_processor_id()];

	event = trace_buffer_lock_reserve(tr, TRACE_POWER,
					  sizeof(*entry), 0, 0);
	if (!event)
		goto out;
	entry	= ring_buffer_event_data(event);
	entry->state_data = *it;
	trace_buffer_unlock_commit(tr, event, 0, 0);
 out:
	preempt_enable();
}

static void probe_power_mark(struct power_trace *it, unsigned int type,
				unsigned int level)
{
	struct ring_buffer_event *event;
	struct trace_power *entry;
	struct trace_array_cpu *data;
	struct trace_array *tr = power_trace;

	if (!trace_power_enabled)
		return;

	memset(it, 0, sizeof(struct power_trace));
	it->state = level;
	it->type = type;
	it->stamp = ktime_get();
	preempt_disable();
	it->end = it->stamp;
	data = tr->data[smp_processor_id()];

	event = trace_buffer_lock_reserve(tr, TRACE_POWER,
					  sizeof(*entry), 0, 0);
	if (!event)
		goto out;
	entry	= ring_buffer_event_data(event);
	entry->state_data = *it;
	trace_buffer_unlock_commit(tr, event, 0, 0);
 out:
	preempt_enable();
}

static int tracing_power_register(void)
{
	int ret;

	ret = register_trace_power_start(probe_power_start);
	if (ret) {
		pr_info("power trace: Couldn't activate tracepoint"
			" probe to trace_power_start\n");
		return ret;
	}
	ret = register_trace_power_end(probe_power_end);
	if (ret) {
		pr_info("power trace: Couldn't activate tracepoint"
			" probe to trace_power_end\n");
		goto fail_start;
	}
	ret = register_trace_power_mark(probe_power_mark);
	if (ret) {
		pr_info("power trace: Couldn't activate tracepoint"
			" probe to trace_power_mark\n");
		goto fail_end;
	}
	return ret;
fail_end:
	unregister_trace_power_end(probe_power_end);
fail_start:
	unregister_trace_power_start(probe_power_start);
	return ret;
}

static void start_power_trace(struct trace_array *tr)
{
	trace_power_enabled = 1;
	tracing_power_register();
}

static void stop_power_trace(struct trace_array *tr)
{
	trace_power_enabled = 0;
	unregister_trace_power_start(probe_power_start);
	unregister_trace_power_end(probe_power_end);
	unregister_trace_power_mark(probe_power_mark);
}


static int power_trace_init(struct trace_array *tr)
{
	int cpu;
	power_trace = tr;

	trace_power_enabled = 1;
	tracing_power_register();

	for_each_cpu(cpu, cpu_possible_mask)
		tracing_reset(tr, cpu);
	return 0;
}

static enum print_line_t power_print_line(struct trace_iterator *iter)
{
	int ret = 0;
	struct trace_entry *entry = iter->ent;
	struct trace_power *field ;
	struct power_trace *it;
	struct trace_seq *s = &iter->seq;
	struct timespec stamp;
	struct timespec duration;

	trace_assign_type(field, entry);
	it = &field->state_data;
	stamp = ktime_to_timespec(it->stamp);
	duration = ktime_to_timespec(ktime_sub(it->end, it->stamp));

	if (entry->type == TRACE_POWER) {
		if (it->type == POWER_CSTATE)
			ret = trace_seq_printf(s, "[%5ld.%09ld] CSTATE: Going to C%i on cpu %i for %ld.%09ld\n",
					  stamp.tv_sec,
					  stamp.tv_nsec,
					  it->state, iter->cpu,
					  duration.tv_sec,
					  duration.tv_nsec);
		if (it->type == POWER_PSTATE)
			ret = trace_seq_printf(s, "[%5ld.%09ld] PSTATE: Going to P%i on cpu %i\n",
					  stamp.tv_sec,
					  stamp.tv_nsec,
					  it->state, iter->cpu);
		if (!ret)
			return TRACE_TYPE_PARTIAL_LINE;
		return TRACE_TYPE_HANDLED;
	}
	return TRACE_TYPE_UNHANDLED;
}

static struct tracer power_tracer __read_mostly =
{
	.name		= "power",
	.init		= power_trace_init,
	.start		= start_power_trace,
	.stop		= stop_power_trace,
	.reset		= stop_power_trace,
	.print_line	= power_print_line,
};

static int init_power_trace(void)
{
	return register_tracer(&power_tracer);
}
device_initcall(init_power_trace);
Commit	Line	Data
f3f47a67 AV	1	/*
	2	* ring buffer based C-state tracer
	3	*
	4	* Arjan van de Ven <arjan@linux.intel.com>
	5	* Copyright (C) 2008 Intel Corporation
	6	*
	7	* Much is borrowed from trace_boot.c which is
	8	* Copyright (C) 2008 Frederic Weisbecker <fweisbec@gmail.com>
	9	*
	10	*/
	11
	12	#include <linux/init.h>
	13	#include <linux/debugfs.h>
12922110	14	#include <trace/power.h>
f3f47a67 AV	15	#include <linux/kallsyms.h>
	16	#include <linux/module.h>
	17
	18	#include "trace.h"
f0868d1e	19	#include "trace_output.h"
f3f47a67 AV	20
	21	static struct trace_array *power_trace;
	22	static int __read_mostly trace_power_enabled;
	23
b5f9fd0f JB	24	static void probe_power_start(struct power_trace *it, unsigned int type,
	25	unsigned int level)
	26	{
	27	if (!trace_power_enabled)
	28	return;
	29
	30	memset(it, 0, sizeof(struct power_trace));
	31	it->state = level;
	32	it->type = type;
	33	it->stamp = ktime_get();
	34	}
	35
	36
	37	static void probe_power_end(struct power_trace *it)
	38	{
	39	struct ring_buffer_event *event;
	40	struct trace_power *entry;
	41	struct trace_array_cpu *data;
	42	struct trace_array *tr = power_trace;
	43
	44	if (!trace_power_enabled)
	45	return;
	46
	47	preempt_disable();
	48	it->end = ktime_get();
	49	data = tr->data[smp_processor_id()];
	50
	51	event = trace_buffer_lock_reserve(tr, TRACE_POWER,
	52	sizeof(*entry), 0, 0);
	53	if (!event)
	54	goto out;
	55	entry = ring_buffer_event_data(event);
	56	entry->state_data = *it;
	57	trace_buffer_unlock_commit(tr, event, 0, 0);
	58	out:
	59	preempt_enable();
	60	}
	61
	62	static void probe_power_mark(struct power_trace *it, unsigned int type,
	63	unsigned int level)
	64	{
	65	struct ring_buffer_event *event;
	66	struct trace_power *entry;
	67	struct trace_array_cpu *data;
	68	struct trace_array *tr = power_trace;
	69
	70	if (!trace_power_enabled)
	71	return;
	72
	73	memset(it, 0, sizeof(struct power_trace));
	74	it->state = level;
	75	it->type = type;
	76	it->stamp = ktime_get();
	77	preempt_disable();
	78	it->end = it->stamp;
	79	data = tr->data[smp_processor_id()];
	80
	81	event = trace_buffer_lock_reserve(tr, TRACE_POWER,
	82	sizeof(*entry), 0, 0);
	83	if (!event)
	84	goto out;
	85	entry = ring_buffer_event_data(event);
	86	entry->state_data = *it;
	87	trace_buffer_unlock_commit(tr, event, 0, 0);
88	out:
89	preempt_enable();
90	}
91
92	static int tracing_power_register(void)
93	{
94	int ret;
95
96	ret = register_trace_power_start(probe_power_start);
97	if (ret) {
98	pr_info("power trace: Couldn't activate tracepoint"
99	" probe to trace_power_start\n");
100	return ret;
101	}
102	ret = register_trace_power_end(probe_power_end);
103	if (ret) {
104	pr_info("power trace: Couldn't activate tracepoint"
105	" probe to trace_power_end\n");
106	goto fail_start;
107	}
108	ret = register_trace_power_mark(probe_power_mark);
109	if (ret) {
110	pr_info("power trace: Couldn't activate tracepoint"
111	" probe to trace_power_mark\n");
112	goto fail_end;
113	}
114	return ret;
115	fail_end:
116	unregister_trace_power_end(probe_power_end);
117	fail_start:
118	unregister_trace_power_start(probe_power_start);
119	return ret;
120	}
f3f47a67 AV	121
	122	static void start_power_trace(struct trace_array *tr)
	123	{
	124	trace_power_enabled = 1;
b5f9fd0f	125	tracing_power_register();
f3f47a67 AV	126	}
	127
	128	static void stop_power_trace(struct trace_array *tr)
	129	{
	130	trace_power_enabled = 0;
b5f9fd0f JB	131	unregister_trace_power_start(probe_power_start);
	132	unregister_trace_power_end(probe_power_end);
	133	unregister_trace_power_mark(probe_power_mark);
f3f47a67 AV	134	}
	135
	136
	137	static int power_trace_init(struct trace_array *tr)
	138	{
	139	int cpu;
	140	power_trace = tr;
	141
	142	trace_power_enabled = 1;
b5f9fd0f	143	tracing_power_register();
f3f47a67	144
4462344e	145	for_each_cpu(cpu, cpu_possible_mask)
f3f47a67 AV	146	tracing_reset(tr, cpu);
	147	return 0;
	148	}
	149
	150	static enum print_line_t power_print_line(struct trace_iterator *iter)
	151	{
	152	int ret = 0;
	153	struct trace_entry *entry = iter->ent;
	154	struct trace_power *field ;
	155	struct power_trace *it;
	156	struct trace_seq *s = &iter->seq;
	157	struct timespec stamp;
	158	struct timespec duration;
	159
	160	trace_assign_type(field, entry);
	161	it = &field->state_data;
	162	stamp = ktime_to_timespec(it->stamp);
	163	duration = ktime_to_timespec(ktime_sub(it->end, it->stamp));
	164
	165	if (entry->type == TRACE_POWER) {
	166	if (it->type == POWER_CSTATE)
	167	ret = trace_seq_printf(s, "[%5ld.%09ld] CSTATE: Going to C%i on cpu %i for %ld.%09ld\n",
	168	stamp.tv_sec,
	169	stamp.tv_nsec,
	170	it->state, iter->cpu,
	171	duration.tv_sec,
	172	duration.tv_nsec);
	173	if (it->type == POWER_PSTATE)
	174	ret = trace_seq_printf(s, "[%5ld.%09ld] PSTATE: Going to P%i on cpu %i\n",
	175	stamp.tv_sec,
	176	stamp.tv_nsec,
	177	it->state, iter->cpu);
	178	if (!ret)
	179	return TRACE_TYPE_PARTIAL_LINE;
	180	return TRACE_TYPE_HANDLED;
	181	}
	182	return TRACE_TYPE_UNHANDLED;
	183	}
	184
	185	static struct tracer power_tracer __read_mostly =
	186	{
	187	.name = "power",
	188	.init = power_trace_init,
	189	.start = start_power_trace,
	190	.stop = stop_power_trace,
	191	.reset = stop_power_trace,
	192	.print_line = power_print_line,
	193	};
	194
	195	static int init_power_trace(void)
	196	{
	197	return register_tracer(&power_tracer);
	198	}
	199	device_initcall(init_power_trace);