xref: /openbmc/linux/kernel/trace/trace_osnoise.c (revision a955d7eac1779b437ceb24fc352026a2cbcec140)
1bce29ac9SDaniel Bristot de Oliveira // SPDX-License-Identifier: GPL-2.0
2bce29ac9SDaniel Bristot de Oliveira /*
3bce29ac9SDaniel Bristot de Oliveira  * OS Noise Tracer: computes the OS Noise suffered by a running thread.
4*a955d7eaSDaniel Bristot de Oliveira  * Timerlat Tracer: measures the wakeup latency of a timer triggered IRQ and thread.
5bce29ac9SDaniel Bristot de Oliveira  *
6bce29ac9SDaniel Bristot de Oliveira  * Based on "hwlat_detector" tracer by:
7bce29ac9SDaniel Bristot de Oliveira  *   Copyright (C) 2008-2009 Jon Masters, Red Hat, Inc. <jcm@redhat.com>
8bce29ac9SDaniel Bristot de Oliveira  *   Copyright (C) 2013-2016 Steven Rostedt, Red Hat, Inc. <srostedt@redhat.com>
9bce29ac9SDaniel Bristot de Oliveira  *   With feedback from Clark Williams <williams@redhat.com>
10bce29ac9SDaniel Bristot de Oliveira  *
11bce29ac9SDaniel Bristot de Oliveira  * And also based on the rtsl tracer presented on:
12bce29ac9SDaniel Bristot de Oliveira  *  DE OLIVEIRA, Daniel Bristot, et al. Demystifying the real-time linux
13bce29ac9SDaniel Bristot de Oliveira  *  scheduling latency. In: 32nd Euromicro Conference on Real-Time Systems
14bce29ac9SDaniel Bristot de Oliveira  *  (ECRTS 2020). Schloss Dagstuhl-Leibniz-Zentrum fur Informatik, 2020.
15bce29ac9SDaniel Bristot de Oliveira  *
16bce29ac9SDaniel Bristot de Oliveira  * Copyright (C) 2021 Daniel Bristot de Oliveira, Red Hat, Inc. <bristot@redhat.com>
17bce29ac9SDaniel Bristot de Oliveira  */
18bce29ac9SDaniel Bristot de Oliveira 
19bce29ac9SDaniel Bristot de Oliveira #include <linux/kthread.h>
20bce29ac9SDaniel Bristot de Oliveira #include <linux/tracefs.h>
21bce29ac9SDaniel Bristot de Oliveira #include <linux/uaccess.h>
22bce29ac9SDaniel Bristot de Oliveira #include <linux/cpumask.h>
23bce29ac9SDaniel Bristot de Oliveira #include <linux/delay.h>
24bce29ac9SDaniel Bristot de Oliveira #include <linux/sched/clock.h>
25*a955d7eaSDaniel Bristot de Oliveira #include <uapi/linux/sched/types.h>
26bce29ac9SDaniel Bristot de Oliveira #include <linux/sched.h>
27bce29ac9SDaniel Bristot de Oliveira #include "trace.h"
28bce29ac9SDaniel Bristot de Oliveira 
29bce29ac9SDaniel Bristot de Oliveira #ifdef CONFIG_X86_LOCAL_APIC
30bce29ac9SDaniel Bristot de Oliveira #include <asm/trace/irq_vectors.h>
31bce29ac9SDaniel Bristot de Oliveira #undef TRACE_INCLUDE_PATH
32bce29ac9SDaniel Bristot de Oliveira #undef TRACE_INCLUDE_FILE
33bce29ac9SDaniel Bristot de Oliveira #endif /* CONFIG_X86_LOCAL_APIC */
34bce29ac9SDaniel Bristot de Oliveira 
35bce29ac9SDaniel Bristot de Oliveira #include <trace/events/irq.h>
36bce29ac9SDaniel Bristot de Oliveira #include <trace/events/sched.h>
37bce29ac9SDaniel Bristot de Oliveira 
38bce29ac9SDaniel Bristot de Oliveira #define CREATE_TRACE_POINTS
39bce29ac9SDaniel Bristot de Oliveira #include <trace/events/osnoise.h>
40bce29ac9SDaniel Bristot de Oliveira 
41bce29ac9SDaniel Bristot de Oliveira static struct trace_array	*osnoise_trace;
42bce29ac9SDaniel Bristot de Oliveira 
43bce29ac9SDaniel Bristot de Oliveira /*
44bce29ac9SDaniel Bristot de Oliveira  * Default values.
45bce29ac9SDaniel Bristot de Oliveira  */
46bce29ac9SDaniel Bristot de Oliveira #define BANNER			"osnoise: "
47bce29ac9SDaniel Bristot de Oliveira #define DEFAULT_SAMPLE_PERIOD	1000000			/* 1s */
48bce29ac9SDaniel Bristot de Oliveira #define DEFAULT_SAMPLE_RUNTIME	1000000			/* 1s */
49bce29ac9SDaniel Bristot de Oliveira 
50*a955d7eaSDaniel Bristot de Oliveira #define DEFAULT_TIMERLAT_PERIOD	1000			/* 1ms */
51*a955d7eaSDaniel Bristot de Oliveira #define DEFAULT_TIMERLAT_PRIO	95			/* FIFO 95 */
52*a955d7eaSDaniel Bristot de Oliveira 
53bce29ac9SDaniel Bristot de Oliveira /*
54bce29ac9SDaniel Bristot de Oliveira  * NMI runtime info.
55bce29ac9SDaniel Bristot de Oliveira  */
56bce29ac9SDaniel Bristot de Oliveira struct osn_nmi {
57bce29ac9SDaniel Bristot de Oliveira 	u64	count;
58bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
59bce29ac9SDaniel Bristot de Oliveira };
60bce29ac9SDaniel Bristot de Oliveira 
61bce29ac9SDaniel Bristot de Oliveira /*
62bce29ac9SDaniel Bristot de Oliveira  * IRQ runtime info.
63bce29ac9SDaniel Bristot de Oliveira  */
64bce29ac9SDaniel Bristot de Oliveira struct osn_irq {
65bce29ac9SDaniel Bristot de Oliveira 	u64	count;
66bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
67bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
68bce29ac9SDaniel Bristot de Oliveira };
69bce29ac9SDaniel Bristot de Oliveira 
70*a955d7eaSDaniel Bristot de Oliveira #define IRQ_CONTEXT	0
71*a955d7eaSDaniel Bristot de Oliveira #define THREAD_CONTEXT	1
72bce29ac9SDaniel Bristot de Oliveira /*
73bce29ac9SDaniel Bristot de Oliveira  * sofirq runtime info.
74bce29ac9SDaniel Bristot de Oliveira  */
75bce29ac9SDaniel Bristot de Oliveira struct osn_softirq {
76bce29ac9SDaniel Bristot de Oliveira 	u64	count;
77bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
78bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
79bce29ac9SDaniel Bristot de Oliveira };
80bce29ac9SDaniel Bristot de Oliveira 
81bce29ac9SDaniel Bristot de Oliveira /*
82bce29ac9SDaniel Bristot de Oliveira  * thread runtime info.
83bce29ac9SDaniel Bristot de Oliveira  */
84bce29ac9SDaniel Bristot de Oliveira struct osn_thread {
85bce29ac9SDaniel Bristot de Oliveira 	u64	count;
86bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
87bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
88bce29ac9SDaniel Bristot de Oliveira };
89bce29ac9SDaniel Bristot de Oliveira 
90bce29ac9SDaniel Bristot de Oliveira /*
91bce29ac9SDaniel Bristot de Oliveira  * Runtime information: this structure saves the runtime information used by
92bce29ac9SDaniel Bristot de Oliveira  * one sampling thread.
93bce29ac9SDaniel Bristot de Oliveira  */
94bce29ac9SDaniel Bristot de Oliveira struct osnoise_variables {
95bce29ac9SDaniel Bristot de Oliveira 	struct task_struct	*kthread;
96bce29ac9SDaniel Bristot de Oliveira 	bool			sampling;
97bce29ac9SDaniel Bristot de Oliveira 	pid_t			pid;
98bce29ac9SDaniel Bristot de Oliveira 	struct osn_nmi		nmi;
99bce29ac9SDaniel Bristot de Oliveira 	struct osn_irq		irq;
100bce29ac9SDaniel Bristot de Oliveira 	struct osn_softirq	softirq;
101bce29ac9SDaniel Bristot de Oliveira 	struct osn_thread	thread;
102bce29ac9SDaniel Bristot de Oliveira 	local_t			int_counter;
103bce29ac9SDaniel Bristot de Oliveira };
104bce29ac9SDaniel Bristot de Oliveira 
105bce29ac9SDaniel Bristot de Oliveira /*
106bce29ac9SDaniel Bristot de Oliveira  * Per-cpu runtime information.
107bce29ac9SDaniel Bristot de Oliveira  */
108bce29ac9SDaniel Bristot de Oliveira DEFINE_PER_CPU(struct osnoise_variables, per_cpu_osnoise_var);
109bce29ac9SDaniel Bristot de Oliveira 
110bce29ac9SDaniel Bristot de Oliveira /*
111bce29ac9SDaniel Bristot de Oliveira  * this_cpu_osn_var - Return the per-cpu osnoise_variables on its relative CPU
112bce29ac9SDaniel Bristot de Oliveira  */
113bce29ac9SDaniel Bristot de Oliveira static inline struct osnoise_variables *this_cpu_osn_var(void)
114bce29ac9SDaniel Bristot de Oliveira {
115bce29ac9SDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_osnoise_var);
116bce29ac9SDaniel Bristot de Oliveira }
117bce29ac9SDaniel Bristot de Oliveira 
118*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
119bce29ac9SDaniel Bristot de Oliveira /*
120*a955d7eaSDaniel Bristot de Oliveira  * Runtime information for the timer mode.
121bce29ac9SDaniel Bristot de Oliveira  */
122*a955d7eaSDaniel Bristot de Oliveira struct timerlat_variables {
123*a955d7eaSDaniel Bristot de Oliveira 	struct task_struct	*kthread;
124*a955d7eaSDaniel Bristot de Oliveira 	struct hrtimer		timer;
125*a955d7eaSDaniel Bristot de Oliveira 	u64			rel_period;
126*a955d7eaSDaniel Bristot de Oliveira 	u64			abs_period;
127*a955d7eaSDaniel Bristot de Oliveira 	bool			tracing_thread;
128*a955d7eaSDaniel Bristot de Oliveira 	u64			count;
129*a955d7eaSDaniel Bristot de Oliveira };
130*a955d7eaSDaniel Bristot de Oliveira 
131*a955d7eaSDaniel Bristot de Oliveira DEFINE_PER_CPU(struct timerlat_variables, per_cpu_timerlat_var);
132*a955d7eaSDaniel Bristot de Oliveira 
133*a955d7eaSDaniel Bristot de Oliveira /*
134*a955d7eaSDaniel Bristot de Oliveira  * this_cpu_tmr_var - Return the per-cpu timerlat_variables on its relative CPU
135*a955d7eaSDaniel Bristot de Oliveira  */
136*a955d7eaSDaniel Bristot de Oliveira static inline struct timerlat_variables *this_cpu_tmr_var(void)
137bce29ac9SDaniel Bristot de Oliveira {
138*a955d7eaSDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_timerlat_var);
139*a955d7eaSDaniel Bristot de Oliveira }
140*a955d7eaSDaniel Bristot de Oliveira 
141*a955d7eaSDaniel Bristot de Oliveira /*
142*a955d7eaSDaniel Bristot de Oliveira  * tlat_var_reset - Reset the values of the given timerlat_variables
143*a955d7eaSDaniel Bristot de Oliveira  */
144*a955d7eaSDaniel Bristot de Oliveira static inline void tlat_var_reset(void)
145*a955d7eaSDaniel Bristot de Oliveira {
146*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var;
147*a955d7eaSDaniel Bristot de Oliveira 	int cpu;
148bce29ac9SDaniel Bristot de Oliveira 	/*
149bce29ac9SDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
150bce29ac9SDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
151bce29ac9SDaniel Bristot de Oliveira 	 */
152*a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
153*a955d7eaSDaniel Bristot de Oliveira 		tlat_var = per_cpu_ptr(&per_cpu_timerlat_var, cpu);
154*a955d7eaSDaniel Bristot de Oliveira 		memset(tlat_var, 0, sizeof(*tlat_var));
155*a955d7eaSDaniel Bristot de Oliveira 	}
156*a955d7eaSDaniel Bristot de Oliveira }
157*a955d7eaSDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
158*a955d7eaSDaniel Bristot de Oliveira #define tlat_var_reset()	do {} while (0)
159*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
160*a955d7eaSDaniel Bristot de Oliveira 
161*a955d7eaSDaniel Bristot de Oliveira /*
162*a955d7eaSDaniel Bristot de Oliveira  * osn_var_reset - Reset the values of the given osnoise_variables
163*a955d7eaSDaniel Bristot de Oliveira  */
164*a955d7eaSDaniel Bristot de Oliveira static inline void osn_var_reset(void)
165*a955d7eaSDaniel Bristot de Oliveira {
166*a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var;
167*a955d7eaSDaniel Bristot de Oliveira 	int cpu;
168*a955d7eaSDaniel Bristot de Oliveira 
169*a955d7eaSDaniel Bristot de Oliveira 	/*
170*a955d7eaSDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
171*a955d7eaSDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
172*a955d7eaSDaniel Bristot de Oliveira 	 */
173*a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
174*a955d7eaSDaniel Bristot de Oliveira 		osn_var = per_cpu_ptr(&per_cpu_osnoise_var, cpu);
175bce29ac9SDaniel Bristot de Oliveira 		memset(osn_var, 0, sizeof(*osn_var));
176bce29ac9SDaniel Bristot de Oliveira 	}
177*a955d7eaSDaniel Bristot de Oliveira }
178bce29ac9SDaniel Bristot de Oliveira 
179bce29ac9SDaniel Bristot de Oliveira /*
180bce29ac9SDaniel Bristot de Oliveira  * osn_var_reset_all - Reset the value of all per-cpu osnoise_variables
181bce29ac9SDaniel Bristot de Oliveira  */
182bce29ac9SDaniel Bristot de Oliveira static inline void osn_var_reset_all(void)
183bce29ac9SDaniel Bristot de Oliveira {
184*a955d7eaSDaniel Bristot de Oliveira 	osn_var_reset();
185*a955d7eaSDaniel Bristot de Oliveira 	tlat_var_reset();
186bce29ac9SDaniel Bristot de Oliveira }
187bce29ac9SDaniel Bristot de Oliveira 
188bce29ac9SDaniel Bristot de Oliveira /*
189bce29ac9SDaniel Bristot de Oliveira  * Tells NMIs to call back to the osnoise tracer to record timestamps.
190bce29ac9SDaniel Bristot de Oliveira  */
191bce29ac9SDaniel Bristot de Oliveira bool trace_osnoise_callback_enabled;
192bce29ac9SDaniel Bristot de Oliveira 
193bce29ac9SDaniel Bristot de Oliveira /*
194bce29ac9SDaniel Bristot de Oliveira  * osnoise sample structure definition. Used to store the statistics of a
195bce29ac9SDaniel Bristot de Oliveira  * sample run.
196bce29ac9SDaniel Bristot de Oliveira  */
197bce29ac9SDaniel Bristot de Oliveira struct osnoise_sample {
198bce29ac9SDaniel Bristot de Oliveira 	u64			runtime;	/* runtime */
199bce29ac9SDaniel Bristot de Oliveira 	u64			noise;		/* noise */
200bce29ac9SDaniel Bristot de Oliveira 	u64			max_sample;	/* max single noise sample */
201bce29ac9SDaniel Bristot de Oliveira 	int			hw_count;	/* # HW (incl. hypervisor) interference */
202bce29ac9SDaniel Bristot de Oliveira 	int			nmi_count;	/* # NMIs during this sample */
203bce29ac9SDaniel Bristot de Oliveira 	int			irq_count;	/* # IRQs during this sample */
204bce29ac9SDaniel Bristot de Oliveira 	int			softirq_count;	/* # softirqs during this sample */
205bce29ac9SDaniel Bristot de Oliveira 	int			thread_count;	/* # threads during this sample */
206bce29ac9SDaniel Bristot de Oliveira };
207bce29ac9SDaniel Bristot de Oliveira 
208*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
209*a955d7eaSDaniel Bristot de Oliveira /*
210*a955d7eaSDaniel Bristot de Oliveira  * timerlat sample structure definition. Used to store the statistics of
211*a955d7eaSDaniel Bristot de Oliveira  * a sample run.
212*a955d7eaSDaniel Bristot de Oliveira  */
213*a955d7eaSDaniel Bristot de Oliveira struct timerlat_sample {
214*a955d7eaSDaniel Bristot de Oliveira 	u64			timer_latency;	/* timer_latency */
215*a955d7eaSDaniel Bristot de Oliveira 	unsigned int		seqnum;		/* unique sequence */
216*a955d7eaSDaniel Bristot de Oliveira 	int			context;	/* timer context */
217*a955d7eaSDaniel Bristot de Oliveira };
218*a955d7eaSDaniel Bristot de Oliveira #endif
219*a955d7eaSDaniel Bristot de Oliveira 
220bce29ac9SDaniel Bristot de Oliveira /*
221bce29ac9SDaniel Bristot de Oliveira  * Protect the interface.
222bce29ac9SDaniel Bristot de Oliveira  */
223bce29ac9SDaniel Bristot de Oliveira struct mutex interface_lock;
224bce29ac9SDaniel Bristot de Oliveira 
225bce29ac9SDaniel Bristot de Oliveira /*
226bce29ac9SDaniel Bristot de Oliveira  * Tracer data.
227bce29ac9SDaniel Bristot de Oliveira  */
228bce29ac9SDaniel Bristot de Oliveira static struct osnoise_data {
229bce29ac9SDaniel Bristot de Oliveira 	u64	sample_period;		/* total sampling period */
230bce29ac9SDaniel Bristot de Oliveira 	u64	sample_runtime;		/* active sampling portion of period */
231*a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing;		/* stop trace in the internal operation (loop/irq) */
232*a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing_total;	/* stop trace in the final operation (report/thread) */
233*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
234*a955d7eaSDaniel Bristot de Oliveira 	u64	timerlat_period;	/* timerlat period */
235*a955d7eaSDaniel Bristot de Oliveira 	u64	print_stack;		/* print IRQ stack if total > */
236*a955d7eaSDaniel Bristot de Oliveira 	int	timerlat_tracer;	/* timerlat tracer */
237*a955d7eaSDaniel Bristot de Oliveira #endif
238bce29ac9SDaniel Bristot de Oliveira 	bool	tainted;		/* infor users and developers about a problem */
239bce29ac9SDaniel Bristot de Oliveira } osnoise_data = {
240bce29ac9SDaniel Bristot de Oliveira 	.sample_period			= DEFAULT_SAMPLE_PERIOD,
241bce29ac9SDaniel Bristot de Oliveira 	.sample_runtime			= DEFAULT_SAMPLE_RUNTIME,
242bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing			= 0,
243bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing_total		= 0,
244*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
245*a955d7eaSDaniel Bristot de Oliveira 	.print_stack			= 0,
246*a955d7eaSDaniel Bristot de Oliveira 	.timerlat_period		= DEFAULT_TIMERLAT_PERIOD,
247*a955d7eaSDaniel Bristot de Oliveira 	.timerlat_tracer		= 0,
248*a955d7eaSDaniel Bristot de Oliveira #endif
249bce29ac9SDaniel Bristot de Oliveira };
250bce29ac9SDaniel Bristot de Oliveira 
251bce29ac9SDaniel Bristot de Oliveira /*
252bce29ac9SDaniel Bristot de Oliveira  * Boolean variable used to inform that the tracer is currently sampling.
253bce29ac9SDaniel Bristot de Oliveira  */
254bce29ac9SDaniel Bristot de Oliveira static bool osnoise_busy;
255bce29ac9SDaniel Bristot de Oliveira 
256bce29ac9SDaniel Bristot de Oliveira /*
257bce29ac9SDaniel Bristot de Oliveira  * Print the osnoise header info.
258bce29ac9SDaniel Bristot de Oliveira  */
259bce29ac9SDaniel Bristot de Oliveira static void print_osnoise_headers(struct seq_file *s)
260bce29ac9SDaniel Bristot de Oliveira {
261bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.tainted)
262bce29ac9SDaniel Bristot de Oliveira 		seq_puts(s, "# osnoise is tainted!\n");
263bce29ac9SDaniel Bristot de Oliveira 
264bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
265bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
266bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
267bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth     ");
268bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                       MAX\n");
269bce29ac9SDaniel Bristot de Oliveira 
270bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              || /                         ");
271bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                    SINGLE      Interference counters:\n");
272bce29ac9SDaniel Bristot de Oliveira 
273bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||               RUNTIME   ");
274bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   NOISE  %% OF CPU  NOISE    +-----------------------------+\n");
275bce29ac9SDaniel Bristot de Oliveira 
276bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# ||||   TIMESTAMP    IN US    ");
277bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   IN US  AVAILABLE  IN US     HW    NMI    IRQ   SIRQ THREAD\n");
278bce29ac9SDaniel Bristot de Oliveira 
279bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   ||||      |           |      ");
280bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "       |    |            |      |      |      |      |      |\n");
281bce29ac9SDaniel Bristot de Oliveira }
282bce29ac9SDaniel Bristot de Oliveira 
283bce29ac9SDaniel Bristot de Oliveira /*
284bce29ac9SDaniel Bristot de Oliveira  * osnoise_taint - report an osnoise error.
285bce29ac9SDaniel Bristot de Oliveira  */
286bce29ac9SDaniel Bristot de Oliveira #define osnoise_taint(msg) ({							\
287bce29ac9SDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;					\
288bce29ac9SDaniel Bristot de Oliveira 										\
289bce29ac9SDaniel Bristot de Oliveira 	trace_array_printk_buf(tr->array_buffer.buffer, _THIS_IP_, msg);	\
290bce29ac9SDaniel Bristot de Oliveira 	osnoise_data.tainted = true;						\
291bce29ac9SDaniel Bristot de Oliveira })
292bce29ac9SDaniel Bristot de Oliveira 
293bce29ac9SDaniel Bristot de Oliveira /*
294bce29ac9SDaniel Bristot de Oliveira  * Record an osnoise_sample into the tracer buffer.
295bce29ac9SDaniel Bristot de Oliveira  */
296bce29ac9SDaniel Bristot de Oliveira static void trace_osnoise_sample(struct osnoise_sample *sample)
297bce29ac9SDaniel Bristot de Oliveira {
298bce29ac9SDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
299bce29ac9SDaniel Bristot de Oliveira 	struct trace_buffer *buffer = tr->array_buffer.buffer;
300bce29ac9SDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
301bce29ac9SDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
302bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_entry *entry;
303bce29ac9SDaniel Bristot de Oliveira 
304bce29ac9SDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_OSNOISE, sizeof(*entry),
305bce29ac9SDaniel Bristot de Oliveira 					  tracing_gen_ctx());
306bce29ac9SDaniel Bristot de Oliveira 	if (!event)
307bce29ac9SDaniel Bristot de Oliveira 		return;
308bce29ac9SDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
309bce29ac9SDaniel Bristot de Oliveira 	entry->runtime		= sample->runtime;
310bce29ac9SDaniel Bristot de Oliveira 	entry->noise		= sample->noise;
311bce29ac9SDaniel Bristot de Oliveira 	entry->max_sample	= sample->max_sample;
312bce29ac9SDaniel Bristot de Oliveira 	entry->hw_count		= sample->hw_count;
313bce29ac9SDaniel Bristot de Oliveira 	entry->nmi_count	= sample->nmi_count;
314bce29ac9SDaniel Bristot de Oliveira 	entry->irq_count	= sample->irq_count;
315bce29ac9SDaniel Bristot de Oliveira 	entry->softirq_count	= sample->softirq_count;
316bce29ac9SDaniel Bristot de Oliveira 	entry->thread_count	= sample->thread_count;
317bce29ac9SDaniel Bristot de Oliveira 
318bce29ac9SDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
319bce29ac9SDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
320bce29ac9SDaniel Bristot de Oliveira }
321bce29ac9SDaniel Bristot de Oliveira 
322*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
323*a955d7eaSDaniel Bristot de Oliveira /*
324*a955d7eaSDaniel Bristot de Oliveira  * Print the timerlat header info.
325*a955d7eaSDaniel Bristot de Oliveira  */
326*a955d7eaSDaniel Bristot de Oliveira static void print_timerlat_headers(struct seq_file *s)
327*a955d7eaSDaniel Bristot de Oliveira {
328*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
329*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
330*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
331*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth\n");
332*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || /\n");
333*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||             ACTIVATION\n");
334*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# ||||   TIMESTAMP    ID     ");
335*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "       CONTEXT                LATENCY\n");
336*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   ||||      |         |      ");
337*a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "            |                       |\n");
338*a955d7eaSDaniel Bristot de Oliveira }
339*a955d7eaSDaniel Bristot de Oliveira 
340*a955d7eaSDaniel Bristot de Oliveira /*
341*a955d7eaSDaniel Bristot de Oliveira  * Record an timerlat_sample into the tracer buffer.
342*a955d7eaSDaniel Bristot de Oliveira  */
343*a955d7eaSDaniel Bristot de Oliveira static void trace_timerlat_sample(struct timerlat_sample *sample)
344*a955d7eaSDaniel Bristot de Oliveira {
345*a955d7eaSDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
346*a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
347*a955d7eaSDaniel Bristot de Oliveira 	struct trace_buffer *buffer = tr->array_buffer.buffer;
348*a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
349*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_entry *entry;
350*a955d7eaSDaniel Bristot de Oliveira 
351*a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_TIMERLAT, sizeof(*entry),
352*a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
353*a955d7eaSDaniel Bristot de Oliveira 	if (!event)
354*a955d7eaSDaniel Bristot de Oliveira 		return;
355*a955d7eaSDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
356*a955d7eaSDaniel Bristot de Oliveira 	entry->seqnum			= sample->seqnum;
357*a955d7eaSDaniel Bristot de Oliveira 	entry->context			= sample->context;
358*a955d7eaSDaniel Bristot de Oliveira 	entry->timer_latency		= sample->timer_latency;
359*a955d7eaSDaniel Bristot de Oliveira 
360*a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
361*a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
362*a955d7eaSDaniel Bristot de Oliveira }
363*a955d7eaSDaniel Bristot de Oliveira 
364*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
365*a955d7eaSDaniel Bristot de Oliveira 
366*a955d7eaSDaniel Bristot de Oliveira #define	MAX_CALLS	256
367*a955d7eaSDaniel Bristot de Oliveira 
368*a955d7eaSDaniel Bristot de Oliveira /*
369*a955d7eaSDaniel Bristot de Oliveira  * Stack trace will take place only at IRQ level, so, no need
370*a955d7eaSDaniel Bristot de Oliveira  * to control nesting here.
371*a955d7eaSDaniel Bristot de Oliveira  */
372*a955d7eaSDaniel Bristot de Oliveira struct trace_stack {
373*a955d7eaSDaniel Bristot de Oliveira 	int		stack_size;
374*a955d7eaSDaniel Bristot de Oliveira 	int		nr_entries;
375*a955d7eaSDaniel Bristot de Oliveira 	unsigned long	calls[MAX_CALLS];
376*a955d7eaSDaniel Bristot de Oliveira };
377*a955d7eaSDaniel Bristot de Oliveira 
378*a955d7eaSDaniel Bristot de Oliveira static DEFINE_PER_CPU(struct trace_stack, trace_stack);
379*a955d7eaSDaniel Bristot de Oliveira 
380*a955d7eaSDaniel Bristot de Oliveira /*
381*a955d7eaSDaniel Bristot de Oliveira  * timerlat_save_stack - save a stack trace without printing
382*a955d7eaSDaniel Bristot de Oliveira  *
383*a955d7eaSDaniel Bristot de Oliveira  * Save the current stack trace without printing. The
384*a955d7eaSDaniel Bristot de Oliveira  * stack will be printed later, after the end of the measurement.
385*a955d7eaSDaniel Bristot de Oliveira  */
386*a955d7eaSDaniel Bristot de Oliveira static void timerlat_save_stack(int skip)
387*a955d7eaSDaniel Bristot de Oliveira {
388*a955d7eaSDaniel Bristot de Oliveira 	unsigned int size, nr_entries;
389*a955d7eaSDaniel Bristot de Oliveira 	struct trace_stack *fstack;
390*a955d7eaSDaniel Bristot de Oliveira 
391*a955d7eaSDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
392*a955d7eaSDaniel Bristot de Oliveira 
393*a955d7eaSDaniel Bristot de Oliveira 	size = ARRAY_SIZE(fstack->calls);
394*a955d7eaSDaniel Bristot de Oliveira 
395*a955d7eaSDaniel Bristot de Oliveira 	nr_entries = stack_trace_save(fstack->calls, size, skip);
396*a955d7eaSDaniel Bristot de Oliveira 
397*a955d7eaSDaniel Bristot de Oliveira 	fstack->stack_size = nr_entries * sizeof(unsigned long);
398*a955d7eaSDaniel Bristot de Oliveira 	fstack->nr_entries = nr_entries;
399*a955d7eaSDaniel Bristot de Oliveira 
400*a955d7eaSDaniel Bristot de Oliveira 	return;
401*a955d7eaSDaniel Bristot de Oliveira 
402*a955d7eaSDaniel Bristot de Oliveira }
403*a955d7eaSDaniel Bristot de Oliveira /*
404*a955d7eaSDaniel Bristot de Oliveira  * timerlat_dump_stack - dump a stack trace previously saved
405*a955d7eaSDaniel Bristot de Oliveira  *
406*a955d7eaSDaniel Bristot de Oliveira  * Dump a saved stack trace into the trace buffer.
407*a955d7eaSDaniel Bristot de Oliveira  */
408*a955d7eaSDaniel Bristot de Oliveira static void timerlat_dump_stack(void)
409*a955d7eaSDaniel Bristot de Oliveira {
410*a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
411*a955d7eaSDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
412*a955d7eaSDaniel Bristot de Oliveira 	struct trace_buffer *buffer = tr->array_buffer.buffer;
413*a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
414*a955d7eaSDaniel Bristot de Oliveira 	struct trace_stack *fstack;
415*a955d7eaSDaniel Bristot de Oliveira 	struct stack_entry *entry;
416*a955d7eaSDaniel Bristot de Oliveira 	unsigned int size;
417*a955d7eaSDaniel Bristot de Oliveira 
418*a955d7eaSDaniel Bristot de Oliveira 	preempt_disable_notrace();
419*a955d7eaSDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
420*a955d7eaSDaniel Bristot de Oliveira 	size = fstack->stack_size;
421*a955d7eaSDaniel Bristot de Oliveira 
422*a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_STACK, sizeof(*entry) + size,
423*a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
424*a955d7eaSDaniel Bristot de Oliveira 	if (!event)
425*a955d7eaSDaniel Bristot de Oliveira 		goto out;
426*a955d7eaSDaniel Bristot de Oliveira 
427*a955d7eaSDaniel Bristot de Oliveira 	entry = ring_buffer_event_data(event);
428*a955d7eaSDaniel Bristot de Oliveira 
429*a955d7eaSDaniel Bristot de Oliveira 	memcpy(&entry->caller, fstack->calls, size);
430*a955d7eaSDaniel Bristot de Oliveira 	entry->size = fstack->nr_entries;
431*a955d7eaSDaniel Bristot de Oliveira 
432*a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
433*a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
434*a955d7eaSDaniel Bristot de Oliveira 
435*a955d7eaSDaniel Bristot de Oliveira out:
436*a955d7eaSDaniel Bristot de Oliveira 	preempt_enable_notrace();
437*a955d7eaSDaniel Bristot de Oliveira }
438*a955d7eaSDaniel Bristot de Oliveira #else
439*a955d7eaSDaniel Bristot de Oliveira #define timerlat_dump_stack() do {} while (0)
440*a955d7eaSDaniel Bristot de Oliveira #define timerlat_save_stack(a) do {} while (0)
441*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
442*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
443*a955d7eaSDaniel Bristot de Oliveira 
444bce29ac9SDaniel Bristot de Oliveira /*
445bce29ac9SDaniel Bristot de Oliveira  * Macros to encapsulate the time capturing infrastructure.
446bce29ac9SDaniel Bristot de Oliveira  */
447bce29ac9SDaniel Bristot de Oliveira #define time_get()	trace_clock_local()
448bce29ac9SDaniel Bristot de Oliveira #define time_to_us(x)	div_u64(x, 1000)
449bce29ac9SDaniel Bristot de Oliveira #define time_sub(a, b)	((a) - (b))
450bce29ac9SDaniel Bristot de Oliveira 
451bce29ac9SDaniel Bristot de Oliveira /*
452bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start - Forward the delta_start of a running IRQ
453bce29ac9SDaniel Bristot de Oliveira  *
454bce29ac9SDaniel Bristot de Oliveira  * If an IRQ is preempted by an NMI, its delta_start is pushed forward
455bce29ac9SDaniel Bristot de Oliveira  * to discount the NMI interference.
456bce29ac9SDaniel Bristot de Oliveira  *
457bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
458bce29ac9SDaniel Bristot de Oliveira  */
459bce29ac9SDaniel Bristot de Oliveira static inline void
460bce29ac9SDaniel Bristot de Oliveira cond_move_irq_delta_start(struct osnoise_variables *osn_var, u64 duration)
461bce29ac9SDaniel Bristot de Oliveira {
462bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->irq.delta_start)
463bce29ac9SDaniel Bristot de Oliveira 		osn_var->irq.delta_start += duration;
464bce29ac9SDaniel Bristot de Oliveira }
465bce29ac9SDaniel Bristot de Oliveira 
466bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
467bce29ac9SDaniel Bristot de Oliveira /*
468bce29ac9SDaniel Bristot de Oliveira  * cond_move_softirq_delta_start - Forward the delta_start of a running softirq.
469bce29ac9SDaniel Bristot de Oliveira  *
470bce29ac9SDaniel Bristot de Oliveira  * If a softirq is preempted by an IRQ or NMI, its delta_start is pushed
471bce29ac9SDaniel Bristot de Oliveira  * forward to discount the interference.
472bce29ac9SDaniel Bristot de Oliveira  *
473bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
474bce29ac9SDaniel Bristot de Oliveira  */
475bce29ac9SDaniel Bristot de Oliveira static inline void
476bce29ac9SDaniel Bristot de Oliveira cond_move_softirq_delta_start(struct osnoise_variables *osn_var, u64 duration)
477bce29ac9SDaniel Bristot de Oliveira {
478bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->softirq.delta_start)
479bce29ac9SDaniel Bristot de Oliveira 		osn_var->softirq.delta_start += duration;
480bce29ac9SDaniel Bristot de Oliveira }
481bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
482bce29ac9SDaniel Bristot de Oliveira #define cond_move_softirq_delta_start(osn_var, duration) do {} while (0)
483bce29ac9SDaniel Bristot de Oliveira #endif
484bce29ac9SDaniel Bristot de Oliveira 
485bce29ac9SDaniel Bristot de Oliveira /*
486bce29ac9SDaniel Bristot de Oliveira  * cond_move_thread_delta_start - Forward the delta_start of a running thread
487bce29ac9SDaniel Bristot de Oliveira  *
488bce29ac9SDaniel Bristot de Oliveira  * If a noisy thread is preempted by an softirq, IRQ or NMI, its delta_start
489bce29ac9SDaniel Bristot de Oliveira  * is pushed forward to discount the interference.
490bce29ac9SDaniel Bristot de Oliveira  *
491bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
492bce29ac9SDaniel Bristot de Oliveira  */
493bce29ac9SDaniel Bristot de Oliveira static inline void
494bce29ac9SDaniel Bristot de Oliveira cond_move_thread_delta_start(struct osnoise_variables *osn_var, u64 duration)
495bce29ac9SDaniel Bristot de Oliveira {
496bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->thread.delta_start)
497bce29ac9SDaniel Bristot de Oliveira 		osn_var->thread.delta_start += duration;
498bce29ac9SDaniel Bristot de Oliveira }
499bce29ac9SDaniel Bristot de Oliveira 
500bce29ac9SDaniel Bristot de Oliveira /*
501bce29ac9SDaniel Bristot de Oliveira  * get_int_safe_duration - Get the duration of a window
502bce29ac9SDaniel Bristot de Oliveira  *
503bce29ac9SDaniel Bristot de Oliveira  * The irq, softirq and thread varaibles need to have its duration without
504bce29ac9SDaniel Bristot de Oliveira  * the interference from higher priority interrupts. Instead of keeping a
505bce29ac9SDaniel Bristot de Oliveira  * variable to discount the interrupt interference from these variables, the
506bce29ac9SDaniel Bristot de Oliveira  * starting time of these variables are pushed forward with the interrupt's
507bce29ac9SDaniel Bristot de Oliveira  * duration. In this way, a single variable is used to:
508bce29ac9SDaniel Bristot de Oliveira  *
509bce29ac9SDaniel Bristot de Oliveira  *   - Know if a given window is being measured.
510bce29ac9SDaniel Bristot de Oliveira  *   - Account its duration.
511bce29ac9SDaniel Bristot de Oliveira  *   - Discount the interference.
512bce29ac9SDaniel Bristot de Oliveira  *
513bce29ac9SDaniel Bristot de Oliveira  * To avoid getting inconsistent values, e.g.,:
514bce29ac9SDaniel Bristot de Oliveira  *
515bce29ac9SDaniel Bristot de Oliveira  *	now = time_get()
516bce29ac9SDaniel Bristot de Oliveira  *		--->	interrupt!
517bce29ac9SDaniel Bristot de Oliveira  *			delta_start -= int duration;
518bce29ac9SDaniel Bristot de Oliveira  *		<---
519bce29ac9SDaniel Bristot de Oliveira  *	duration = now - delta_start;
520bce29ac9SDaniel Bristot de Oliveira  *
521bce29ac9SDaniel Bristot de Oliveira  *	result: negative duration if the variable duration before the
522bce29ac9SDaniel Bristot de Oliveira  *	interrupt was smaller than the interrupt execution.
523bce29ac9SDaniel Bristot de Oliveira  *
524bce29ac9SDaniel Bristot de Oliveira  * A counter of interrupts is used. If the counter increased, try
525bce29ac9SDaniel Bristot de Oliveira  * to capture an interference safe duration.
526bce29ac9SDaniel Bristot de Oliveira  */
527bce29ac9SDaniel Bristot de Oliveira static inline s64
528bce29ac9SDaniel Bristot de Oliveira get_int_safe_duration(struct osnoise_variables *osn_var, u64 *delta_start)
529bce29ac9SDaniel Bristot de Oliveira {
530bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter, now;
531bce29ac9SDaniel Bristot de Oliveira 	s64 duration;
532bce29ac9SDaniel Bristot de Oliveira 
533bce29ac9SDaniel Bristot de Oliveira 	do {
534bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
535bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
536bce29ac9SDaniel Bristot de Oliveira 		barrier();
537bce29ac9SDaniel Bristot de Oliveira 
538bce29ac9SDaniel Bristot de Oliveira 		now = time_get();
539bce29ac9SDaniel Bristot de Oliveira 		duration = (now - *delta_start);
540bce29ac9SDaniel Bristot de Oliveira 
541bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
542bce29ac9SDaniel Bristot de Oliveira 		barrier();
543bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
544bce29ac9SDaniel Bristot de Oliveira 
545bce29ac9SDaniel Bristot de Oliveira 	/*
546bce29ac9SDaniel Bristot de Oliveira 	 * This is an evidence of race conditions that cause
547bce29ac9SDaniel Bristot de Oliveira 	 * a value to be "discounted" too much.
548bce29ac9SDaniel Bristot de Oliveira 	 */
549bce29ac9SDaniel Bristot de Oliveira 	if (duration < 0)
550bce29ac9SDaniel Bristot de Oliveira 		osnoise_taint("Negative duration!\n");
551bce29ac9SDaniel Bristot de Oliveira 
552bce29ac9SDaniel Bristot de Oliveira 	*delta_start = 0;
553bce29ac9SDaniel Bristot de Oliveira 
554bce29ac9SDaniel Bristot de Oliveira 	return duration;
555bce29ac9SDaniel Bristot de Oliveira }
556bce29ac9SDaniel Bristot de Oliveira 
557bce29ac9SDaniel Bristot de Oliveira /*
558bce29ac9SDaniel Bristot de Oliveira  *
559bce29ac9SDaniel Bristot de Oliveira  * set_int_safe_time - Save the current time on *time, aware of interference
560bce29ac9SDaniel Bristot de Oliveira  *
561bce29ac9SDaniel Bristot de Oliveira  * Get the time, taking into consideration a possible interference from
562bce29ac9SDaniel Bristot de Oliveira  * higher priority interrupts.
563bce29ac9SDaniel Bristot de Oliveira  *
564bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration() for an explanation.
565bce29ac9SDaniel Bristot de Oliveira  */
566bce29ac9SDaniel Bristot de Oliveira static u64
567bce29ac9SDaniel Bristot de Oliveira set_int_safe_time(struct osnoise_variables *osn_var, u64 *time)
568bce29ac9SDaniel Bristot de Oliveira {
569bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter;
570bce29ac9SDaniel Bristot de Oliveira 
571bce29ac9SDaniel Bristot de Oliveira 	do {
572bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
573bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
574bce29ac9SDaniel Bristot de Oliveira 		barrier();
575bce29ac9SDaniel Bristot de Oliveira 
576bce29ac9SDaniel Bristot de Oliveira 		*time = time_get();
577bce29ac9SDaniel Bristot de Oliveira 
578bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
579bce29ac9SDaniel Bristot de Oliveira 		barrier();
580bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
581bce29ac9SDaniel Bristot de Oliveira 
582bce29ac9SDaniel Bristot de Oliveira 	return int_counter;
583bce29ac9SDaniel Bristot de Oliveira }
584bce29ac9SDaniel Bristot de Oliveira 
585*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
586*a955d7eaSDaniel Bristot de Oliveira /*
587*a955d7eaSDaniel Bristot de Oliveira  * copy_int_safe_time - Copy *src into *desc aware of interference
588*a955d7eaSDaniel Bristot de Oliveira  */
589*a955d7eaSDaniel Bristot de Oliveira static u64
590*a955d7eaSDaniel Bristot de Oliveira copy_int_safe_time(struct osnoise_variables *osn_var, u64 *dst, u64 *src)
591*a955d7eaSDaniel Bristot de Oliveira {
592*a955d7eaSDaniel Bristot de Oliveira 	u64 int_counter;
593*a955d7eaSDaniel Bristot de Oliveira 
594*a955d7eaSDaniel Bristot de Oliveira 	do {
595*a955d7eaSDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
596*a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
597*a955d7eaSDaniel Bristot de Oliveira 		barrier();
598*a955d7eaSDaniel Bristot de Oliveira 
599*a955d7eaSDaniel Bristot de Oliveira 		*dst = *src;
600*a955d7eaSDaniel Bristot de Oliveira 
601*a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
602*a955d7eaSDaniel Bristot de Oliveira 		barrier();
603*a955d7eaSDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
604*a955d7eaSDaniel Bristot de Oliveira 
605*a955d7eaSDaniel Bristot de Oliveira 	return int_counter;
606*a955d7eaSDaniel Bristot de Oliveira }
607*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
608*a955d7eaSDaniel Bristot de Oliveira 
609bce29ac9SDaniel Bristot de Oliveira /*
610bce29ac9SDaniel Bristot de Oliveira  * trace_osnoise_callback - NMI entry/exit callback
611bce29ac9SDaniel Bristot de Oliveira  *
612bce29ac9SDaniel Bristot de Oliveira  * This function is called at the entry and exit NMI code. The bool enter
613bce29ac9SDaniel Bristot de Oliveira  * distinguishes between either case. This function is used to note a NMI
614bce29ac9SDaniel Bristot de Oliveira  * occurrence, compute the noise caused by the NMI, and to remove the noise
615bce29ac9SDaniel Bristot de Oliveira  * it is potentially causing on other interference variables.
616bce29ac9SDaniel Bristot de Oliveira  */
617bce29ac9SDaniel Bristot de Oliveira void trace_osnoise_callback(bool enter)
618bce29ac9SDaniel Bristot de Oliveira {
619bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
620bce29ac9SDaniel Bristot de Oliveira 	u64 duration;
621bce29ac9SDaniel Bristot de Oliveira 
622bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
623bce29ac9SDaniel Bristot de Oliveira 		return;
624bce29ac9SDaniel Bristot de Oliveira 
625bce29ac9SDaniel Bristot de Oliveira 	/*
626bce29ac9SDaniel Bristot de Oliveira 	 * Currently trace_clock_local() calls sched_clock() and the
627bce29ac9SDaniel Bristot de Oliveira 	 * generic version is not NMI safe.
628bce29ac9SDaniel Bristot de Oliveira 	 */
629bce29ac9SDaniel Bristot de Oliveira 	if (!IS_ENABLED(CONFIG_GENERIC_SCHED_CLOCK)) {
630bce29ac9SDaniel Bristot de Oliveira 		if (enter) {
631bce29ac9SDaniel Bristot de Oliveira 			osn_var->nmi.delta_start = time_get();
632bce29ac9SDaniel Bristot de Oliveira 			local_inc(&osn_var->int_counter);
633bce29ac9SDaniel Bristot de Oliveira 		} else {
634bce29ac9SDaniel Bristot de Oliveira 			duration = time_get() - osn_var->nmi.delta_start;
635bce29ac9SDaniel Bristot de Oliveira 
636bce29ac9SDaniel Bristot de Oliveira 			trace_nmi_noise(osn_var->nmi.delta_start, duration);
637bce29ac9SDaniel Bristot de Oliveira 
638bce29ac9SDaniel Bristot de Oliveira 			cond_move_irq_delta_start(osn_var, duration);
639bce29ac9SDaniel Bristot de Oliveira 			cond_move_softirq_delta_start(osn_var, duration);
640bce29ac9SDaniel Bristot de Oliveira 			cond_move_thread_delta_start(osn_var, duration);
641bce29ac9SDaniel Bristot de Oliveira 		}
642bce29ac9SDaniel Bristot de Oliveira 	}
643bce29ac9SDaniel Bristot de Oliveira 
644bce29ac9SDaniel Bristot de Oliveira 	if (enter)
645bce29ac9SDaniel Bristot de Oliveira 		osn_var->nmi.count++;
646bce29ac9SDaniel Bristot de Oliveira }
647bce29ac9SDaniel Bristot de Oliveira 
648bce29ac9SDaniel Bristot de Oliveira /*
649bce29ac9SDaniel Bristot de Oliveira  * osnoise_trace_irq_entry - Note the starting of an IRQ
650bce29ac9SDaniel Bristot de Oliveira  *
651bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of an IRQ. As IRQs are non-preemptive to other IRQs,
652bce29ac9SDaniel Bristot de Oliveira  * it is safe to use a single variable (ons_var->irq) to save the statistics.
653bce29ac9SDaniel Bristot de Oliveira  * The arrival_time is used to report... the arrival time. The delta_start
654bce29ac9SDaniel Bristot de Oliveira  * is used to compute the duration at the IRQ exit handler. See
655bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start().
656bce29ac9SDaniel Bristot de Oliveira  */
657bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_entry(int id)
658bce29ac9SDaniel Bristot de Oliveira {
659bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
660bce29ac9SDaniel Bristot de Oliveira 
661bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
662bce29ac9SDaniel Bristot de Oliveira 		return;
663bce29ac9SDaniel Bristot de Oliveira 	/*
664bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
665bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
666bce29ac9SDaniel Bristot de Oliveira 	 */
667bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = time_get();
668bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->irq.delta_start);
669bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.count++;
670bce29ac9SDaniel Bristot de Oliveira 
671bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
672bce29ac9SDaniel Bristot de Oliveira }
673bce29ac9SDaniel Bristot de Oliveira 
674bce29ac9SDaniel Bristot de Oliveira /*
675bce29ac9SDaniel Bristot de Oliveira  * osnoise_irq_exit - Note the end of an IRQ, sava data and trace
676bce29ac9SDaniel Bristot de Oliveira  *
677bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the IRQ noise, and trace it. Also discounts the
678bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
679bce29ac9SDaniel Bristot de Oliveira  */
680bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_exit(int id, const char *desc)
681bce29ac9SDaniel Bristot de Oliveira {
682bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
683bce29ac9SDaniel Bristot de Oliveira 	int duration;
684bce29ac9SDaniel Bristot de Oliveira 
685bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
686bce29ac9SDaniel Bristot de Oliveira 		return;
687bce29ac9SDaniel Bristot de Oliveira 
688bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->irq.delta_start);
689bce29ac9SDaniel Bristot de Oliveira 	trace_irq_noise(id, desc, osn_var->irq.arrival_time, duration);
690bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = 0;
691bce29ac9SDaniel Bristot de Oliveira 	cond_move_softirq_delta_start(osn_var, duration);
692bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
693bce29ac9SDaniel Bristot de Oliveira }
694bce29ac9SDaniel Bristot de Oliveira 
695bce29ac9SDaniel Bristot de Oliveira /*
696bce29ac9SDaniel Bristot de Oliveira  * trace_irqentry_callback - Callback to the irq:irq_entry traceevent
697bce29ac9SDaniel Bristot de Oliveira  *
698bce29ac9SDaniel Bristot de Oliveira  * Used to note the starting of an IRQ occurece.
699bce29ac9SDaniel Bristot de Oliveira  */
700bce29ac9SDaniel Bristot de Oliveira static void trace_irqentry_callback(void *data, int irq,
701bce29ac9SDaniel Bristot de Oliveira 				    struct irqaction *action)
702bce29ac9SDaniel Bristot de Oliveira {
703bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_entry(irq);
704bce29ac9SDaniel Bristot de Oliveira }
705bce29ac9SDaniel Bristot de Oliveira 
706bce29ac9SDaniel Bristot de Oliveira /*
707bce29ac9SDaniel Bristot de Oliveira  * trace_irqexit_callback - Callback to the irq:irq_exit traceevent
708bce29ac9SDaniel Bristot de Oliveira  *
709bce29ac9SDaniel Bristot de Oliveira  * Used to note the end of an IRQ occurece.
710bce29ac9SDaniel Bristot de Oliveira  */
711bce29ac9SDaniel Bristot de Oliveira static void trace_irqexit_callback(void *data, int irq,
712bce29ac9SDaniel Bristot de Oliveira 				   struct irqaction *action, int ret)
713bce29ac9SDaniel Bristot de Oliveira {
714bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_exit(irq, action->name);
715bce29ac9SDaniel Bristot de Oliveira }
716bce29ac9SDaniel Bristot de Oliveira 
717bce29ac9SDaniel Bristot de Oliveira /*
718bce29ac9SDaniel Bristot de Oliveira  * arch specific register function.
719bce29ac9SDaniel Bristot de Oliveira  */
720bce29ac9SDaniel Bristot de Oliveira int __weak osnoise_arch_register(void)
721bce29ac9SDaniel Bristot de Oliveira {
722bce29ac9SDaniel Bristot de Oliveira 	return 0;
723bce29ac9SDaniel Bristot de Oliveira }
724bce29ac9SDaniel Bristot de Oliveira 
725bce29ac9SDaniel Bristot de Oliveira /*
726bce29ac9SDaniel Bristot de Oliveira  * arch specific unregister function.
727bce29ac9SDaniel Bristot de Oliveira  */
728bce29ac9SDaniel Bristot de Oliveira void __weak osnoise_arch_unregister(void)
729bce29ac9SDaniel Bristot de Oliveira {
730bce29ac9SDaniel Bristot de Oliveira 	return;
731bce29ac9SDaniel Bristot de Oliveira }
732bce29ac9SDaniel Bristot de Oliveira 
733bce29ac9SDaniel Bristot de Oliveira /*
734bce29ac9SDaniel Bristot de Oliveira  * hook_irq_events - Hook IRQ handling events
735bce29ac9SDaniel Bristot de Oliveira  *
736bce29ac9SDaniel Bristot de Oliveira  * This function hooks the IRQ related callbacks to the respective trace
737bce29ac9SDaniel Bristot de Oliveira  * events.
738bce29ac9SDaniel Bristot de Oliveira  */
739bce29ac9SDaniel Bristot de Oliveira int hook_irq_events(void)
740bce29ac9SDaniel Bristot de Oliveira {
741bce29ac9SDaniel Bristot de Oliveira 	int ret;
742bce29ac9SDaniel Bristot de Oliveira 
743bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_entry(trace_irqentry_callback, NULL);
744bce29ac9SDaniel Bristot de Oliveira 	if (ret)
745bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
746bce29ac9SDaniel Bristot de Oliveira 
747bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_exit(trace_irqexit_callback, NULL);
748bce29ac9SDaniel Bristot de Oliveira 	if (ret)
749bce29ac9SDaniel Bristot de Oliveira 		goto out_unregister_entry;
750bce29ac9SDaniel Bristot de Oliveira 
751bce29ac9SDaniel Bristot de Oliveira 	ret = osnoise_arch_register();
752bce29ac9SDaniel Bristot de Oliveira 	if (ret)
753bce29ac9SDaniel Bristot de Oliveira 		goto out_irq_exit;
754bce29ac9SDaniel Bristot de Oliveira 
755bce29ac9SDaniel Bristot de Oliveira 	return 0;
756bce29ac9SDaniel Bristot de Oliveira 
757bce29ac9SDaniel Bristot de Oliveira out_irq_exit:
758bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
759bce29ac9SDaniel Bristot de Oliveira out_unregister_entry:
760bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
761bce29ac9SDaniel Bristot de Oliveira out_err:
762bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
763bce29ac9SDaniel Bristot de Oliveira }
764bce29ac9SDaniel Bristot de Oliveira 
765bce29ac9SDaniel Bristot de Oliveira /*
766bce29ac9SDaniel Bristot de Oliveira  * unhook_irq_events - Unhook IRQ handling events
767bce29ac9SDaniel Bristot de Oliveira  *
768bce29ac9SDaniel Bristot de Oliveira  * This function unhooks the IRQ related callbacks to the respective trace
769bce29ac9SDaniel Bristot de Oliveira  * events.
770bce29ac9SDaniel Bristot de Oliveira  */
771bce29ac9SDaniel Bristot de Oliveira void unhook_irq_events(void)
772bce29ac9SDaniel Bristot de Oliveira {
773bce29ac9SDaniel Bristot de Oliveira 	osnoise_arch_unregister();
774bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
775bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
776bce29ac9SDaniel Bristot de Oliveira }
777bce29ac9SDaniel Bristot de Oliveira 
778bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
779bce29ac9SDaniel Bristot de Oliveira /*
780bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_entry_callback - Note the starting of a softirq
781bce29ac9SDaniel Bristot de Oliveira  *
782bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of a softirq. As softirqs are non-preemptive to
783bce29ac9SDaniel Bristot de Oliveira  * other softirqs, it is safe to use a single variable (ons_var->softirq)
784bce29ac9SDaniel Bristot de Oliveira  * to save the statistics. The arrival_time is used to report... the
785bce29ac9SDaniel Bristot de Oliveira  * arrival time. The delta_start is used to compute the duration at the
786bce29ac9SDaniel Bristot de Oliveira  * softirq exit handler. See cond_move_softirq_delta_start().
787bce29ac9SDaniel Bristot de Oliveira  */
788bce29ac9SDaniel Bristot de Oliveira void trace_softirq_entry_callback(void *data, unsigned int vec_nr)
789bce29ac9SDaniel Bristot de Oliveira {
790bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
791bce29ac9SDaniel Bristot de Oliveira 
792bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
793bce29ac9SDaniel Bristot de Oliveira 		return;
794bce29ac9SDaniel Bristot de Oliveira 	/*
795bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
796bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
797bce29ac9SDaniel Bristot de Oliveira 	 */
798bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = time_get();
799bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->softirq.delta_start);
800bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.count++;
801bce29ac9SDaniel Bristot de Oliveira 
802bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
803bce29ac9SDaniel Bristot de Oliveira }
804bce29ac9SDaniel Bristot de Oliveira 
805bce29ac9SDaniel Bristot de Oliveira /*
806bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_exit_callback - Note the end of an softirq
807bce29ac9SDaniel Bristot de Oliveira  *
808bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the softirq noise, and trace it. Also discounts the
809bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
810bce29ac9SDaniel Bristot de Oliveira  */
811bce29ac9SDaniel Bristot de Oliveira void trace_softirq_exit_callback(void *data, unsigned int vec_nr)
812bce29ac9SDaniel Bristot de Oliveira {
813bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
814bce29ac9SDaniel Bristot de Oliveira 	int duration;
815bce29ac9SDaniel Bristot de Oliveira 
816bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
817bce29ac9SDaniel Bristot de Oliveira 		return;
818bce29ac9SDaniel Bristot de Oliveira 
819*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
820*a955d7eaSDaniel Bristot de Oliveira 	/*
821*a955d7eaSDaniel Bristot de Oliveira 	 * If the timerlat is enabled, but the irq handler did
822*a955d7eaSDaniel Bristot de Oliveira 	 * not run yet enabling timerlat_tracer, do not trace.
823*a955d7eaSDaniel Bristot de Oliveira 	 */
824*a955d7eaSDaniel Bristot de Oliveira 	if (unlikely(osnoise_data.timerlat_tracer)) {
825*a955d7eaSDaniel Bristot de Oliveira 		struct timerlat_variables *tlat_var;
826*a955d7eaSDaniel Bristot de Oliveira 		tlat_var = this_cpu_tmr_var();
827*a955d7eaSDaniel Bristot de Oliveira 		if (!tlat_var->tracing_thread) {
828*a955d7eaSDaniel Bristot de Oliveira 			osn_var->softirq.arrival_time = 0;
829*a955d7eaSDaniel Bristot de Oliveira 			osn_var->softirq.delta_start = 0;
830*a955d7eaSDaniel Bristot de Oliveira 			return;
831*a955d7eaSDaniel Bristot de Oliveira 		}
832*a955d7eaSDaniel Bristot de Oliveira 	}
833*a955d7eaSDaniel Bristot de Oliveira #endif
834*a955d7eaSDaniel Bristot de Oliveira 
835bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->softirq.delta_start);
836bce29ac9SDaniel Bristot de Oliveira 	trace_softirq_noise(vec_nr, osn_var->softirq.arrival_time, duration);
837bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
838bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = 0;
839bce29ac9SDaniel Bristot de Oliveira }
840bce29ac9SDaniel Bristot de Oliveira 
841bce29ac9SDaniel Bristot de Oliveira /*
842bce29ac9SDaniel Bristot de Oliveira  * hook_softirq_events - Hook softirq handling events
843bce29ac9SDaniel Bristot de Oliveira  *
844bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
845bce29ac9SDaniel Bristot de Oliveira  * events.
846bce29ac9SDaniel Bristot de Oliveira  */
847bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
848bce29ac9SDaniel Bristot de Oliveira {
849bce29ac9SDaniel Bristot de Oliveira 	int ret;
850bce29ac9SDaniel Bristot de Oliveira 
851bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_entry(trace_softirq_entry_callback, NULL);
852bce29ac9SDaniel Bristot de Oliveira 	if (ret)
853bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
854bce29ac9SDaniel Bristot de Oliveira 
855bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_exit(trace_softirq_exit_callback, NULL);
856bce29ac9SDaniel Bristot de Oliveira 	if (ret)
857bce29ac9SDaniel Bristot de Oliveira 		goto out_unreg_entry;
858bce29ac9SDaniel Bristot de Oliveira 
859bce29ac9SDaniel Bristot de Oliveira 	return 0;
860bce29ac9SDaniel Bristot de Oliveira 
861bce29ac9SDaniel Bristot de Oliveira out_unreg_entry:
862bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
863bce29ac9SDaniel Bristot de Oliveira out_err:
864bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
865bce29ac9SDaniel Bristot de Oliveira }
866bce29ac9SDaniel Bristot de Oliveira 
867bce29ac9SDaniel Bristot de Oliveira /*
868bce29ac9SDaniel Bristot de Oliveira  * unhook_softirq_events - Unhook softirq handling events
869bce29ac9SDaniel Bristot de Oliveira  *
870bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
871bce29ac9SDaniel Bristot de Oliveira  * events.
872bce29ac9SDaniel Bristot de Oliveira  */
873bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
874bce29ac9SDaniel Bristot de Oliveira {
875bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
876bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_exit(trace_softirq_exit_callback, NULL);
877bce29ac9SDaniel Bristot de Oliveira }
878bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
879bce29ac9SDaniel Bristot de Oliveira /*
880bce29ac9SDaniel Bristot de Oliveira  * softirq are threads on the PREEMPT_RT mode.
881bce29ac9SDaniel Bristot de Oliveira  */
882bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
883bce29ac9SDaniel Bristot de Oliveira {
884bce29ac9SDaniel Bristot de Oliveira 	return 0;
885bce29ac9SDaniel Bristot de Oliveira }
886bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
887bce29ac9SDaniel Bristot de Oliveira {
888bce29ac9SDaniel Bristot de Oliveira }
889bce29ac9SDaniel Bristot de Oliveira #endif
890bce29ac9SDaniel Bristot de Oliveira 
891bce29ac9SDaniel Bristot de Oliveira /*
892bce29ac9SDaniel Bristot de Oliveira  * thread_entry - Record the starting of a thread noise window
893bce29ac9SDaniel Bristot de Oliveira  *
894bce29ac9SDaniel Bristot de Oliveira  * It saves the context switch time for a noisy thread, and increments
895bce29ac9SDaniel Bristot de Oliveira  * the interference counters.
896bce29ac9SDaniel Bristot de Oliveira  */
897bce29ac9SDaniel Bristot de Oliveira static void
898bce29ac9SDaniel Bristot de Oliveira thread_entry(struct osnoise_variables *osn_var, struct task_struct *t)
899bce29ac9SDaniel Bristot de Oliveira {
900bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
901bce29ac9SDaniel Bristot de Oliveira 		return;
902bce29ac9SDaniel Bristot de Oliveira 	/*
903bce29ac9SDaniel Bristot de Oliveira 	 * The arrival time will be used in the report, but not to compute
904bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
905bce29ac9SDaniel Bristot de Oliveira 	 */
906bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
907bce29ac9SDaniel Bristot de Oliveira 
908bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->thread.delta_start);
909bce29ac9SDaniel Bristot de Oliveira 
910bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.count++;
911bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
912bce29ac9SDaniel Bristot de Oliveira }
913bce29ac9SDaniel Bristot de Oliveira 
914bce29ac9SDaniel Bristot de Oliveira /*
915bce29ac9SDaniel Bristot de Oliveira  * thread_exit - Report the end of a thread noise window
916bce29ac9SDaniel Bristot de Oliveira  *
917bce29ac9SDaniel Bristot de Oliveira  * It computes the total noise from a thread, tracing if needed.
918bce29ac9SDaniel Bristot de Oliveira  */
919bce29ac9SDaniel Bristot de Oliveira static void
920bce29ac9SDaniel Bristot de Oliveira thread_exit(struct osnoise_variables *osn_var, struct task_struct *t)
921bce29ac9SDaniel Bristot de Oliveira {
922bce29ac9SDaniel Bristot de Oliveira 	int duration;
923bce29ac9SDaniel Bristot de Oliveira 
924bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
925bce29ac9SDaniel Bristot de Oliveira 		return;
926bce29ac9SDaniel Bristot de Oliveira 
927*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
928*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.timerlat_tracer) {
929*a955d7eaSDaniel Bristot de Oliveira 		struct timerlat_variables *tlat_var;
930*a955d7eaSDaniel Bristot de Oliveira 		tlat_var = this_cpu_tmr_var();
931*a955d7eaSDaniel Bristot de Oliveira 		if (!tlat_var->tracing_thread) {
932*a955d7eaSDaniel Bristot de Oliveira 			osn_var->thread.delta_start = 0;
933*a955d7eaSDaniel Bristot de Oliveira 			osn_var->thread.arrival_time = 0;
934*a955d7eaSDaniel Bristot de Oliveira 			return;
935*a955d7eaSDaniel Bristot de Oliveira 		}
936*a955d7eaSDaniel Bristot de Oliveira 	}
937*a955d7eaSDaniel Bristot de Oliveira #endif
938*a955d7eaSDaniel Bristot de Oliveira 
939bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->thread.delta_start);
940bce29ac9SDaniel Bristot de Oliveira 
941bce29ac9SDaniel Bristot de Oliveira 	trace_thread_noise(t, osn_var->thread.arrival_time, duration);
942bce29ac9SDaniel Bristot de Oliveira 
943bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = 0;
944bce29ac9SDaniel Bristot de Oliveira }
945bce29ac9SDaniel Bristot de Oliveira 
946bce29ac9SDaniel Bristot de Oliveira /*
947bce29ac9SDaniel Bristot de Oliveira  * trace_sched_switch - sched:sched_switch trace event handler
948bce29ac9SDaniel Bristot de Oliveira  *
949bce29ac9SDaniel Bristot de Oliveira  * This function is hooked to the sched:sched_switch trace event, and it is
950bce29ac9SDaniel Bristot de Oliveira  * used to record the beginning and to report the end of a thread noise window.
951bce29ac9SDaniel Bristot de Oliveira  */
952bce29ac9SDaniel Bristot de Oliveira void
953bce29ac9SDaniel Bristot de Oliveira trace_sched_switch_callback(void *data, bool preempt, struct task_struct *p,
954bce29ac9SDaniel Bristot de Oliveira 			    struct task_struct *n)
955bce29ac9SDaniel Bristot de Oliveira {
956bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
957bce29ac9SDaniel Bristot de Oliveira 
958bce29ac9SDaniel Bristot de Oliveira 	if (p->pid != osn_var->pid)
959bce29ac9SDaniel Bristot de Oliveira 		thread_exit(osn_var, p);
960bce29ac9SDaniel Bristot de Oliveira 
961bce29ac9SDaniel Bristot de Oliveira 	if (n->pid != osn_var->pid)
962bce29ac9SDaniel Bristot de Oliveira 		thread_entry(osn_var, n);
963bce29ac9SDaniel Bristot de Oliveira }
964bce29ac9SDaniel Bristot de Oliveira 
965bce29ac9SDaniel Bristot de Oliveira /*
966bce29ac9SDaniel Bristot de Oliveira  * hook_thread_events - Hook the insturmentation for thread noise
967bce29ac9SDaniel Bristot de Oliveira  *
968bce29ac9SDaniel Bristot de Oliveira  * Hook the osnoise tracer callbacks to handle the noise from other
969bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
970bce29ac9SDaniel Bristot de Oliveira  */
971bce29ac9SDaniel Bristot de Oliveira int hook_thread_events(void)
972bce29ac9SDaniel Bristot de Oliveira {
973bce29ac9SDaniel Bristot de Oliveira 	int ret;
974bce29ac9SDaniel Bristot de Oliveira 
975bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_sched_switch(trace_sched_switch_callback, NULL);
976bce29ac9SDaniel Bristot de Oliveira 	if (ret)
977bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
978bce29ac9SDaniel Bristot de Oliveira 
979bce29ac9SDaniel Bristot de Oliveira 	return 0;
980bce29ac9SDaniel Bristot de Oliveira }
981bce29ac9SDaniel Bristot de Oliveira 
982bce29ac9SDaniel Bristot de Oliveira /*
983bce29ac9SDaniel Bristot de Oliveira  * unhook_thread_events - *nhook the insturmentation for thread noise
984bce29ac9SDaniel Bristot de Oliveira  *
985bce29ac9SDaniel Bristot de Oliveira  * Unook the osnoise tracer callbacks to handle the noise from other
986bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
987bce29ac9SDaniel Bristot de Oliveira  */
988bce29ac9SDaniel Bristot de Oliveira void unhook_thread_events(void)
989bce29ac9SDaniel Bristot de Oliveira {
990bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_sched_switch(trace_sched_switch_callback, NULL);
991bce29ac9SDaniel Bristot de Oliveira }
992bce29ac9SDaniel Bristot de Oliveira 
993bce29ac9SDaniel Bristot de Oliveira /*
994bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats - Save the osnoise_sample statistics
995bce29ac9SDaniel Bristot de Oliveira  *
996bce29ac9SDaniel Bristot de Oliveira  * Save the osnoise_sample statistics before the sampling phase. These
997bce29ac9SDaniel Bristot de Oliveira  * values will be used later to compute the diff betwneen the statistics
998bce29ac9SDaniel Bristot de Oliveira  * before and after the osnoise sampling.
999bce29ac9SDaniel Bristot de Oliveira  */
1000bce29ac9SDaniel Bristot de Oliveira void save_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1001bce29ac9SDaniel Bristot de Oliveira {
1002bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count;
1003bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count;
1004bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count;
1005bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count;
1006bce29ac9SDaniel Bristot de Oliveira }
1007bce29ac9SDaniel Bristot de Oliveira 
1008bce29ac9SDaniel Bristot de Oliveira /*
1009bce29ac9SDaniel Bristot de Oliveira  * diff_osn_sample_stats - Compute the osnoise_sample statistics
1010bce29ac9SDaniel Bristot de Oliveira  *
1011bce29ac9SDaniel Bristot de Oliveira  * After a sample period, compute the difference on the osnoise_sample
1012bce29ac9SDaniel Bristot de Oliveira  * statistics. The struct osnoise_sample *s contains the statistics saved via
1013bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats() before the osnoise sampling.
1014bce29ac9SDaniel Bristot de Oliveira  */
1015bce29ac9SDaniel Bristot de Oliveira void diff_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1016bce29ac9SDaniel Bristot de Oliveira {
1017bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count - s->nmi_count;
1018bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count - s->irq_count;
1019bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count - s->softirq_count;
1020bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count - s->thread_count;
1021bce29ac9SDaniel Bristot de Oliveira }
1022bce29ac9SDaniel Bristot de Oliveira 
1023bce29ac9SDaniel Bristot de Oliveira /*
1024bce29ac9SDaniel Bristot de Oliveira  * osnoise_stop_tracing - Stop tracing and the tracer.
1025bce29ac9SDaniel Bristot de Oliveira  */
1026bce29ac9SDaniel Bristot de Oliveira static void osnoise_stop_tracing(void)
1027bce29ac9SDaniel Bristot de Oliveira {
1028bce29ac9SDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
1029bce29ac9SDaniel Bristot de Oliveira 	tracer_tracing_off(tr);
1030bce29ac9SDaniel Bristot de Oliveira }
1031bce29ac9SDaniel Bristot de Oliveira 
1032bce29ac9SDaniel Bristot de Oliveira /*
1033bce29ac9SDaniel Bristot de Oliveira  * run_osnoise - Sample the time and look for osnoise
1034bce29ac9SDaniel Bristot de Oliveira  *
1035bce29ac9SDaniel Bristot de Oliveira  * Used to capture the time, looking for potential osnoise latency repeatedly.
1036bce29ac9SDaniel Bristot de Oliveira  * Different from hwlat_detector, it is called with preemption and interrupts
1037bce29ac9SDaniel Bristot de Oliveira  * enabled. This allows irqs, softirqs and threads to run, interfering on the
1038bce29ac9SDaniel Bristot de Oliveira  * osnoise sampling thread, as they would do with a regular thread.
1039bce29ac9SDaniel Bristot de Oliveira  */
1040bce29ac9SDaniel Bristot de Oliveira static int run_osnoise(void)
1041bce29ac9SDaniel Bristot de Oliveira {
1042bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1043bce29ac9SDaniel Bristot de Oliveira 	u64 noise = 0, sum_noise = 0, max_noise = 0;
1044bce29ac9SDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
1045bce29ac9SDaniel Bristot de Oliveira 	u64 start, sample, last_sample;
1046bce29ac9SDaniel Bristot de Oliveira 	u64 last_int_count, int_count;
1047bce29ac9SDaniel Bristot de Oliveira 	s64 total, last_total = 0;
1048bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_sample s;
1049bce29ac9SDaniel Bristot de Oliveira 	unsigned int threshold;
1050bce29ac9SDaniel Bristot de Oliveira 	int hw_count = 0;
1051bce29ac9SDaniel Bristot de Oliveira 	u64 runtime, stop_in;
1052bce29ac9SDaniel Bristot de Oliveira 	int ret = -1;
1053bce29ac9SDaniel Bristot de Oliveira 
1054bce29ac9SDaniel Bristot de Oliveira 	/*
1055bce29ac9SDaniel Bristot de Oliveira 	 * Considers the current thread as the workload.
1056bce29ac9SDaniel Bristot de Oliveira 	 */
1057bce29ac9SDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1058bce29ac9SDaniel Bristot de Oliveira 
1059bce29ac9SDaniel Bristot de Oliveira 	/*
1060bce29ac9SDaniel Bristot de Oliveira 	 * Save the current stats for the diff
1061bce29ac9SDaniel Bristot de Oliveira 	 */
1062bce29ac9SDaniel Bristot de Oliveira 	save_osn_sample_stats(osn_var, &s);
1063bce29ac9SDaniel Bristot de Oliveira 
1064bce29ac9SDaniel Bristot de Oliveira 	/*
1065bce29ac9SDaniel Bristot de Oliveira 	 * if threshold is 0, use the default value of 5 us.
1066bce29ac9SDaniel Bristot de Oliveira 	 */
1067bce29ac9SDaniel Bristot de Oliveira 	threshold = tracing_thresh ? : 5000;
1068bce29ac9SDaniel Bristot de Oliveira 
1069bce29ac9SDaniel Bristot de Oliveira 	/*
1070bce29ac9SDaniel Bristot de Oliveira 	 * Make sure NMIs see sampling first
1071bce29ac9SDaniel Bristot de Oliveira 	 */
1072bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = true;
1073bce29ac9SDaniel Bristot de Oliveira 	barrier();
1074bce29ac9SDaniel Bristot de Oliveira 
1075bce29ac9SDaniel Bristot de Oliveira 	/*
1076bce29ac9SDaniel Bristot de Oliveira 	 * Transform the *_us config to nanoseconds to avoid the
1077bce29ac9SDaniel Bristot de Oliveira 	 * division on the main loop.
1078bce29ac9SDaniel Bristot de Oliveira 	 */
1079bce29ac9SDaniel Bristot de Oliveira 	runtime = osnoise_data.sample_runtime * NSEC_PER_USEC;
1080bce29ac9SDaniel Bristot de Oliveira 	stop_in = osnoise_data.stop_tracing * NSEC_PER_USEC;
1081bce29ac9SDaniel Bristot de Oliveira 
1082bce29ac9SDaniel Bristot de Oliveira 	/*
1083bce29ac9SDaniel Bristot de Oliveira 	 * Start timestemp
1084bce29ac9SDaniel Bristot de Oliveira 	 */
1085bce29ac9SDaniel Bristot de Oliveira 	start = time_get();
1086bce29ac9SDaniel Bristot de Oliveira 
1087bce29ac9SDaniel Bristot de Oliveira 	/*
1088bce29ac9SDaniel Bristot de Oliveira 	 * "previous" loop.
1089bce29ac9SDaniel Bristot de Oliveira 	 */
1090bce29ac9SDaniel Bristot de Oliveira 	last_int_count = set_int_safe_time(osn_var, &last_sample);
1091bce29ac9SDaniel Bristot de Oliveira 
1092bce29ac9SDaniel Bristot de Oliveira 	do {
1093bce29ac9SDaniel Bristot de Oliveira 		/*
1094bce29ac9SDaniel Bristot de Oliveira 		 * Get sample!
1095bce29ac9SDaniel Bristot de Oliveira 		 */
1096bce29ac9SDaniel Bristot de Oliveira 		int_count = set_int_safe_time(osn_var, &sample);
1097bce29ac9SDaniel Bristot de Oliveira 
1098bce29ac9SDaniel Bristot de Oliveira 		noise = time_sub(sample, last_sample);
1099bce29ac9SDaniel Bristot de Oliveira 
1100bce29ac9SDaniel Bristot de Oliveira 		/*
1101bce29ac9SDaniel Bristot de Oliveira 		 * This shouldn't happen.
1102bce29ac9SDaniel Bristot de Oliveira 		 */
1103bce29ac9SDaniel Bristot de Oliveira 		if (noise < 0) {
1104bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("negative noise!");
1105bce29ac9SDaniel Bristot de Oliveira 			goto out;
1106bce29ac9SDaniel Bristot de Oliveira 		}
1107bce29ac9SDaniel Bristot de Oliveira 
1108bce29ac9SDaniel Bristot de Oliveira 		/*
1109bce29ac9SDaniel Bristot de Oliveira 		 * Sample runtime.
1110bce29ac9SDaniel Bristot de Oliveira 		 */
1111bce29ac9SDaniel Bristot de Oliveira 		total = time_sub(sample, start);
1112bce29ac9SDaniel Bristot de Oliveira 
1113bce29ac9SDaniel Bristot de Oliveira 		/*
1114bce29ac9SDaniel Bristot de Oliveira 		 * Check for possible overflows.
1115bce29ac9SDaniel Bristot de Oliveira 		 */
1116bce29ac9SDaniel Bristot de Oliveira 		if (total < last_total) {
1117bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("total overflow!");
1118bce29ac9SDaniel Bristot de Oliveira 			break;
1119bce29ac9SDaniel Bristot de Oliveira 		}
1120bce29ac9SDaniel Bristot de Oliveira 
1121bce29ac9SDaniel Bristot de Oliveira 		last_total = total;
1122bce29ac9SDaniel Bristot de Oliveira 
1123bce29ac9SDaniel Bristot de Oliveira 		if (noise >= threshold) {
1124bce29ac9SDaniel Bristot de Oliveira 			int interference = int_count - last_int_count;
1125bce29ac9SDaniel Bristot de Oliveira 
1126bce29ac9SDaniel Bristot de Oliveira 			if (noise > max_noise)
1127bce29ac9SDaniel Bristot de Oliveira 				max_noise = noise;
1128bce29ac9SDaniel Bristot de Oliveira 
1129bce29ac9SDaniel Bristot de Oliveira 			if (!interference)
1130bce29ac9SDaniel Bristot de Oliveira 				hw_count++;
1131bce29ac9SDaniel Bristot de Oliveira 
1132bce29ac9SDaniel Bristot de Oliveira 			sum_noise += noise;
1133bce29ac9SDaniel Bristot de Oliveira 
1134bce29ac9SDaniel Bristot de Oliveira 			trace_sample_threshold(last_sample, noise, interference);
1135bce29ac9SDaniel Bristot de Oliveira 
1136bce29ac9SDaniel Bristot de Oliveira 			if (osnoise_data.stop_tracing)
1137bce29ac9SDaniel Bristot de Oliveira 				if (noise > stop_in)
1138bce29ac9SDaniel Bristot de Oliveira 					osnoise_stop_tracing();
1139bce29ac9SDaniel Bristot de Oliveira 		}
1140bce29ac9SDaniel Bristot de Oliveira 
1141bce29ac9SDaniel Bristot de Oliveira 		/*
1142bce29ac9SDaniel Bristot de Oliveira 		 * For the non-preemptive kernel config: let threads runs, if
1143bce29ac9SDaniel Bristot de Oliveira 		 * they so wish.
1144bce29ac9SDaniel Bristot de Oliveira 		 */
1145bce29ac9SDaniel Bristot de Oliveira 		cond_resched();
1146bce29ac9SDaniel Bristot de Oliveira 
1147bce29ac9SDaniel Bristot de Oliveira 		last_sample = sample;
1148bce29ac9SDaniel Bristot de Oliveira 		last_int_count = int_count;
1149bce29ac9SDaniel Bristot de Oliveira 
1150bce29ac9SDaniel Bristot de Oliveira 	} while (total < runtime && !kthread_should_stop());
1151bce29ac9SDaniel Bristot de Oliveira 
1152bce29ac9SDaniel Bristot de Oliveira 	/*
1153bce29ac9SDaniel Bristot de Oliveira 	 * Finish the above in the view for interrupts.
1154bce29ac9SDaniel Bristot de Oliveira 	 */
1155bce29ac9SDaniel Bristot de Oliveira 	barrier();
1156bce29ac9SDaniel Bristot de Oliveira 
1157bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = false;
1158bce29ac9SDaniel Bristot de Oliveira 
1159bce29ac9SDaniel Bristot de Oliveira 	/*
1160bce29ac9SDaniel Bristot de Oliveira 	 * Make sure sampling data is no longer updated.
1161bce29ac9SDaniel Bristot de Oliveira 	 */
1162bce29ac9SDaniel Bristot de Oliveira 	barrier();
1163bce29ac9SDaniel Bristot de Oliveira 
1164bce29ac9SDaniel Bristot de Oliveira 	/*
1165bce29ac9SDaniel Bristot de Oliveira 	 * Save noise info.
1166bce29ac9SDaniel Bristot de Oliveira 	 */
1167bce29ac9SDaniel Bristot de Oliveira 	s.noise = time_to_us(sum_noise);
1168bce29ac9SDaniel Bristot de Oliveira 	s.runtime = time_to_us(total);
1169bce29ac9SDaniel Bristot de Oliveira 	s.max_sample = time_to_us(max_noise);
1170bce29ac9SDaniel Bristot de Oliveira 	s.hw_count = hw_count;
1171bce29ac9SDaniel Bristot de Oliveira 
1172bce29ac9SDaniel Bristot de Oliveira 	/* Save interference stats info */
1173bce29ac9SDaniel Bristot de Oliveira 	diff_osn_sample_stats(osn_var, &s);
1174bce29ac9SDaniel Bristot de Oliveira 
1175bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_sample(&s);
1176bce29ac9SDaniel Bristot de Oliveira 
1177bce29ac9SDaniel Bristot de Oliveira 	/* Keep a running maximum ever recorded osnoise "latency" */
1178bce29ac9SDaniel Bristot de Oliveira 	if (max_noise > tr->max_latency) {
1179bce29ac9SDaniel Bristot de Oliveira 		tr->max_latency = max_noise;
1180bce29ac9SDaniel Bristot de Oliveira 		latency_fsnotify(tr);
1181bce29ac9SDaniel Bristot de Oliveira 	}
1182bce29ac9SDaniel Bristot de Oliveira 
1183bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing_total)
1184bce29ac9SDaniel Bristot de Oliveira 		if (s.noise > osnoise_data.stop_tracing_total)
1185bce29ac9SDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1186bce29ac9SDaniel Bristot de Oliveira 
1187bce29ac9SDaniel Bristot de Oliveira 	return 0;
1188bce29ac9SDaniel Bristot de Oliveira out:
1189bce29ac9SDaniel Bristot de Oliveira 	return ret;
1190bce29ac9SDaniel Bristot de Oliveira }
1191bce29ac9SDaniel Bristot de Oliveira 
1192bce29ac9SDaniel Bristot de Oliveira static struct cpumask osnoise_cpumask;
1193bce29ac9SDaniel Bristot de Oliveira static struct cpumask save_cpumask;
1194bce29ac9SDaniel Bristot de Oliveira 
1195bce29ac9SDaniel Bristot de Oliveira /*
1196bce29ac9SDaniel Bristot de Oliveira  * osnoise_main - The osnoise detection kernel thread
1197bce29ac9SDaniel Bristot de Oliveira  *
1198bce29ac9SDaniel Bristot de Oliveira  * Calls run_osnoise() function to measure the osnoise for the configured runtime,
1199bce29ac9SDaniel Bristot de Oliveira  * every period.
1200bce29ac9SDaniel Bristot de Oliveira  */
1201bce29ac9SDaniel Bristot de Oliveira static int osnoise_main(void *data)
1202bce29ac9SDaniel Bristot de Oliveira {
1203bce29ac9SDaniel Bristot de Oliveira 	s64 interval;
1204bce29ac9SDaniel Bristot de Oliveira 
1205bce29ac9SDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
1206bce29ac9SDaniel Bristot de Oliveira 
1207bce29ac9SDaniel Bristot de Oliveira 		run_osnoise();
1208bce29ac9SDaniel Bristot de Oliveira 
1209bce29ac9SDaniel Bristot de Oliveira 		mutex_lock(&interface_lock);
1210bce29ac9SDaniel Bristot de Oliveira 		interval = osnoise_data.sample_period - osnoise_data.sample_runtime;
1211bce29ac9SDaniel Bristot de Oliveira 		mutex_unlock(&interface_lock);
1212bce29ac9SDaniel Bristot de Oliveira 
1213bce29ac9SDaniel Bristot de Oliveira 		do_div(interval, USEC_PER_MSEC);
1214bce29ac9SDaniel Bristot de Oliveira 
1215bce29ac9SDaniel Bristot de Oliveira 		/*
1216bce29ac9SDaniel Bristot de Oliveira 		 * differently from hwlat_detector, the osnoise tracer can run
1217bce29ac9SDaniel Bristot de Oliveira 		 * without a pause because preemption is on.
1218bce29ac9SDaniel Bristot de Oliveira 		 */
1219bce29ac9SDaniel Bristot de Oliveira 		if (interval < 1)
1220bce29ac9SDaniel Bristot de Oliveira 			continue;
1221bce29ac9SDaniel Bristot de Oliveira 
1222bce29ac9SDaniel Bristot de Oliveira 		if (msleep_interruptible(interval))
1223bce29ac9SDaniel Bristot de Oliveira 			break;
1224bce29ac9SDaniel Bristot de Oliveira 	}
1225bce29ac9SDaniel Bristot de Oliveira 
1226bce29ac9SDaniel Bristot de Oliveira 	return 0;
1227bce29ac9SDaniel Bristot de Oliveira }
1228bce29ac9SDaniel Bristot de Oliveira 
1229*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1230*a955d7eaSDaniel Bristot de Oliveira /*
1231*a955d7eaSDaniel Bristot de Oliveira  * timerlat_irq - hrtimer handler for timerlat.
1232*a955d7eaSDaniel Bristot de Oliveira  */
1233*a955d7eaSDaniel Bristot de Oliveira static enum hrtimer_restart timerlat_irq(struct hrtimer *timer)
1234*a955d7eaSDaniel Bristot de Oliveira {
1235*a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1236*a955d7eaSDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
1237*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat;
1238*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1239*a955d7eaSDaniel Bristot de Oliveira 	u64 now;
1240*a955d7eaSDaniel Bristot de Oliveira 	u64 diff;
1241*a955d7eaSDaniel Bristot de Oliveira 
1242*a955d7eaSDaniel Bristot de Oliveira 	/*
1243*a955d7eaSDaniel Bristot de Oliveira 	 * I am not sure if the timer was armed for this CPU. So, get
1244*a955d7eaSDaniel Bristot de Oliveira 	 * the timerlat struct from the timer itself, not from this
1245*a955d7eaSDaniel Bristot de Oliveira 	 * CPU.
1246*a955d7eaSDaniel Bristot de Oliveira 	 */
1247*a955d7eaSDaniel Bristot de Oliveira 	tlat = container_of(timer, struct timerlat_variables, timer);
1248*a955d7eaSDaniel Bristot de Oliveira 
1249*a955d7eaSDaniel Bristot de Oliveira 	now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1250*a955d7eaSDaniel Bristot de Oliveira 
1251*a955d7eaSDaniel Bristot de Oliveira 	/*
1252*a955d7eaSDaniel Bristot de Oliveira 	 * Enable the osnoise: events for thread an softirq.
1253*a955d7eaSDaniel Bristot de Oliveira 	 */
1254*a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = true;
1255*a955d7eaSDaniel Bristot de Oliveira 
1256*a955d7eaSDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
1257*a955d7eaSDaniel Bristot de Oliveira 
1258*a955d7eaSDaniel Bristot de Oliveira 	/*
1259*a955d7eaSDaniel Bristot de Oliveira 	 * A hardirq is running: the timer IRQ. It is for sure preempting
1260*a955d7eaSDaniel Bristot de Oliveira 	 * a thread, and potentially preempting a softirq.
1261*a955d7eaSDaniel Bristot de Oliveira 	 *
1262*a955d7eaSDaniel Bristot de Oliveira 	 * At this point, it is not interesting to know the duration of the
1263*a955d7eaSDaniel Bristot de Oliveira 	 * preempted thread (and maybe softirq), but how much time they will
1264*a955d7eaSDaniel Bristot de Oliveira 	 * delay the beginning of the execution of the timer thread.
1265*a955d7eaSDaniel Bristot de Oliveira 	 *
1266*a955d7eaSDaniel Bristot de Oliveira 	 * To get the correct (net) delay added by the softirq, its delta_start
1267*a955d7eaSDaniel Bristot de Oliveira 	 * is set as the IRQ one. In this way, at the return of the IRQ, the delta
1268*a955d7eaSDaniel Bristot de Oliveira 	 * start of the sofitrq will be zeroed, accounting then only the time
1269*a955d7eaSDaniel Bristot de Oliveira 	 * after that.
1270*a955d7eaSDaniel Bristot de Oliveira 	 *
1271*a955d7eaSDaniel Bristot de Oliveira 	 * The thread follows the same principle. However, if a softirq is
1272*a955d7eaSDaniel Bristot de Oliveira 	 * running, the thread needs to receive the softirq delta_start. The
1273*a955d7eaSDaniel Bristot de Oliveira 	 * reason being is that the softirq will be the last to be unfolded,
1274*a955d7eaSDaniel Bristot de Oliveira 	 * resseting the thread delay to zero.
1275*a955d7eaSDaniel Bristot de Oliveira 	 */
1276*a955d7eaSDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
1277*a955d7eaSDaniel Bristot de Oliveira 	if (osn_var->softirq.delta_start) {
1278*a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1279*a955d7eaSDaniel Bristot de Oliveira 				   &osn_var->softirq.delta_start);
1280*a955d7eaSDaniel Bristot de Oliveira 
1281*a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->softirq.delta_start,
1282*a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1283*a955d7eaSDaniel Bristot de Oliveira 	} else {
1284*a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1285*a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1286*a955d7eaSDaniel Bristot de Oliveira 	}
1287*a955d7eaSDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
1288*a955d7eaSDaniel Bristot de Oliveira 	/*
1289*a955d7eaSDaniel Bristot de Oliveira 	 * The sofirqs run as threads on RT, so there is not need
1290*a955d7eaSDaniel Bristot de Oliveira 	 * to keep track of it.
1291*a955d7eaSDaniel Bristot de Oliveira 	 */
1292*a955d7eaSDaniel Bristot de Oliveira 	copy_int_safe_time(osn_var, &osn_var->thread.delta_start, &osn_var->irq.delta_start);
1293*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_PREEMPT_RT */
1294*a955d7eaSDaniel Bristot de Oliveira 
1295*a955d7eaSDaniel Bristot de Oliveira 	/*
1296*a955d7eaSDaniel Bristot de Oliveira 	 * Compute the current time with the expected time.
1297*a955d7eaSDaniel Bristot de Oliveira 	 */
1298*a955d7eaSDaniel Bristot de Oliveira 	diff = now - tlat->abs_period;
1299*a955d7eaSDaniel Bristot de Oliveira 
1300*a955d7eaSDaniel Bristot de Oliveira 	tlat->count++;
1301*a955d7eaSDaniel Bristot de Oliveira 	s.seqnum = tlat->count;
1302*a955d7eaSDaniel Bristot de Oliveira 	s.timer_latency = diff;
1303*a955d7eaSDaniel Bristot de Oliveira 	s.context = IRQ_CONTEXT;
1304*a955d7eaSDaniel Bristot de Oliveira 
1305*a955d7eaSDaniel Bristot de Oliveira 	trace_timerlat_sample(&s);
1306*a955d7eaSDaniel Bristot de Oliveira 
1307*a955d7eaSDaniel Bristot de Oliveira 	/* Keep a running maximum ever recorded os noise "latency" */
1308*a955d7eaSDaniel Bristot de Oliveira 	if (diff > tr->max_latency) {
1309*a955d7eaSDaniel Bristot de Oliveira 		tr->max_latency = diff;
1310*a955d7eaSDaniel Bristot de Oliveira 		latency_fsnotify(tr);
1311*a955d7eaSDaniel Bristot de Oliveira 	}
1312*a955d7eaSDaniel Bristot de Oliveira 
1313*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing)
1314*a955d7eaSDaniel Bristot de Oliveira 		if (time_to_us(diff) >= osnoise_data.stop_tracing)
1315*a955d7eaSDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1316*a955d7eaSDaniel Bristot de Oliveira 
1317*a955d7eaSDaniel Bristot de Oliveira 	wake_up_process(tlat->kthread);
1318*a955d7eaSDaniel Bristot de Oliveira 
1319*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.print_stack)
1320*a955d7eaSDaniel Bristot de Oliveira 		timerlat_save_stack(0);
1321*a955d7eaSDaniel Bristot de Oliveira 
1322*a955d7eaSDaniel Bristot de Oliveira 	return HRTIMER_NORESTART;
1323*a955d7eaSDaniel Bristot de Oliveira }
1324*a955d7eaSDaniel Bristot de Oliveira 
1325*a955d7eaSDaniel Bristot de Oliveira /*
1326*a955d7eaSDaniel Bristot de Oliveira  * wait_next_period - Wait for the next period for timerlat
1327*a955d7eaSDaniel Bristot de Oliveira  */
1328*a955d7eaSDaniel Bristot de Oliveira static int wait_next_period(struct timerlat_variables *tlat)
1329*a955d7eaSDaniel Bristot de Oliveira {
1330*a955d7eaSDaniel Bristot de Oliveira 	ktime_t next_abs_period, now;
1331*a955d7eaSDaniel Bristot de Oliveira 	u64 rel_period = osnoise_data.timerlat_period * 1000;
1332*a955d7eaSDaniel Bristot de Oliveira 
1333*a955d7eaSDaniel Bristot de Oliveira 	now = hrtimer_cb_get_time(&tlat->timer);
1334*a955d7eaSDaniel Bristot de Oliveira 	next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1335*a955d7eaSDaniel Bristot de Oliveira 
1336*a955d7eaSDaniel Bristot de Oliveira 	/*
1337*a955d7eaSDaniel Bristot de Oliveira 	 * Save the next abs_period.
1338*a955d7eaSDaniel Bristot de Oliveira 	 */
1339*a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1340*a955d7eaSDaniel Bristot de Oliveira 
1341*a955d7eaSDaniel Bristot de Oliveira 	/*
1342*a955d7eaSDaniel Bristot de Oliveira 	 * If the new abs_period is in the past, skip the activation.
1343*a955d7eaSDaniel Bristot de Oliveira 	 */
1344*a955d7eaSDaniel Bristot de Oliveira 	while (ktime_compare(now, next_abs_period) > 0) {
1345*a955d7eaSDaniel Bristot de Oliveira 		next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1346*a955d7eaSDaniel Bristot de Oliveira 		tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1347*a955d7eaSDaniel Bristot de Oliveira 	}
1348*a955d7eaSDaniel Bristot de Oliveira 
1349*a955d7eaSDaniel Bristot de Oliveira 	set_current_state(TASK_INTERRUPTIBLE);
1350*a955d7eaSDaniel Bristot de Oliveira 
1351*a955d7eaSDaniel Bristot de Oliveira 	hrtimer_start(&tlat->timer, next_abs_period, HRTIMER_MODE_ABS_PINNED_HARD);
1352*a955d7eaSDaniel Bristot de Oliveira 	schedule();
1353*a955d7eaSDaniel Bristot de Oliveira 	return 1;
1354*a955d7eaSDaniel Bristot de Oliveira }
1355*a955d7eaSDaniel Bristot de Oliveira 
1356*a955d7eaSDaniel Bristot de Oliveira /*
1357*a955d7eaSDaniel Bristot de Oliveira  * timerlat_main- Timerlat main
1358*a955d7eaSDaniel Bristot de Oliveira  */
1359*a955d7eaSDaniel Bristot de Oliveira static int timerlat_main(void *data)
1360*a955d7eaSDaniel Bristot de Oliveira {
1361*a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1362*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat = this_cpu_tmr_var();
1363*a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1364*a955d7eaSDaniel Bristot de Oliveira 	struct sched_param sp;
1365*a955d7eaSDaniel Bristot de Oliveira 	u64 now, diff;
1366*a955d7eaSDaniel Bristot de Oliveira 
1367*a955d7eaSDaniel Bristot de Oliveira 	/*
1368*a955d7eaSDaniel Bristot de Oliveira 	 * Make the thread RT, that is how cyclictest is usually used.
1369*a955d7eaSDaniel Bristot de Oliveira 	 */
1370*a955d7eaSDaniel Bristot de Oliveira 	sp.sched_priority = DEFAULT_TIMERLAT_PRIO;
1371*a955d7eaSDaniel Bristot de Oliveira 	sched_setscheduler_nocheck(current, SCHED_FIFO, &sp);
1372*a955d7eaSDaniel Bristot de Oliveira 
1373*a955d7eaSDaniel Bristot de Oliveira 	tlat->count = 0;
1374*a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = false;
1375*a955d7eaSDaniel Bristot de Oliveira 
1376*a955d7eaSDaniel Bristot de Oliveira 	hrtimer_init(&tlat->timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS_PINNED_HARD);
1377*a955d7eaSDaniel Bristot de Oliveira 	tlat->timer.function = timerlat_irq;
1378*a955d7eaSDaniel Bristot de Oliveira 	tlat->kthread = current;
1379*a955d7eaSDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1380*a955d7eaSDaniel Bristot de Oliveira 	/*
1381*a955d7eaSDaniel Bristot de Oliveira 	 * Anotate the arrival time.
1382*a955d7eaSDaniel Bristot de Oliveira 	 */
1383*a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = hrtimer_cb_get_time(&tlat->timer);
1384*a955d7eaSDaniel Bristot de Oliveira 
1385*a955d7eaSDaniel Bristot de Oliveira 	wait_next_period(tlat);
1386*a955d7eaSDaniel Bristot de Oliveira 
1387*a955d7eaSDaniel Bristot de Oliveira 	osn_var->sampling = 1;
1388*a955d7eaSDaniel Bristot de Oliveira 
1389*a955d7eaSDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
1390*a955d7eaSDaniel Bristot de Oliveira 		now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1391*a955d7eaSDaniel Bristot de Oliveira 		diff = now - tlat->abs_period;
1392*a955d7eaSDaniel Bristot de Oliveira 
1393*a955d7eaSDaniel Bristot de Oliveira 		s.seqnum = tlat->count;
1394*a955d7eaSDaniel Bristot de Oliveira 		s.timer_latency = diff;
1395*a955d7eaSDaniel Bristot de Oliveira 		s.context = THREAD_CONTEXT;
1396*a955d7eaSDaniel Bristot de Oliveira 
1397*a955d7eaSDaniel Bristot de Oliveira 		trace_timerlat_sample(&s);
1398*a955d7eaSDaniel Bristot de Oliveira 
1399*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
1400*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.print_stack)
1401*a955d7eaSDaniel Bristot de Oliveira 		if (osnoise_data.print_stack <= time_to_us(diff))
1402*a955d7eaSDaniel Bristot de Oliveira 			timerlat_dump_stack();
1403*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
1404*a955d7eaSDaniel Bristot de Oliveira 
1405*a955d7eaSDaniel Bristot de Oliveira 		tlat->tracing_thread = false;
1406*a955d7eaSDaniel Bristot de Oliveira 		if (osnoise_data.stop_tracing_total)
1407*a955d7eaSDaniel Bristot de Oliveira 			if (time_to_us(diff) >= osnoise_data.stop_tracing_total)
1408*a955d7eaSDaniel Bristot de Oliveira 				osnoise_stop_tracing();
1409*a955d7eaSDaniel Bristot de Oliveira 
1410*a955d7eaSDaniel Bristot de Oliveira 		wait_next_period(tlat);
1411*a955d7eaSDaniel Bristot de Oliveira 	}
1412*a955d7eaSDaniel Bristot de Oliveira 
1413*a955d7eaSDaniel Bristot de Oliveira 	hrtimer_cancel(&tlat->timer);
1414*a955d7eaSDaniel Bristot de Oliveira 	return 0;
1415*a955d7eaSDaniel Bristot de Oliveira }
1416*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
1417*a955d7eaSDaniel Bristot de Oliveira 
1418bce29ac9SDaniel Bristot de Oliveira /*
1419bce29ac9SDaniel Bristot de Oliveira  * stop_per_cpu_kthread - stop per-cpu threads
1420bce29ac9SDaniel Bristot de Oliveira  *
1421bce29ac9SDaniel Bristot de Oliveira  * Stop the osnoise sampling htread. Use this on unload and at system
1422bce29ac9SDaniel Bristot de Oliveira  * shutdown.
1423bce29ac9SDaniel Bristot de Oliveira  */
1424bce29ac9SDaniel Bristot de Oliveira static void stop_per_cpu_kthreads(void)
1425bce29ac9SDaniel Bristot de Oliveira {
1426bce29ac9SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1427bce29ac9SDaniel Bristot de Oliveira 	int cpu;
1428bce29ac9SDaniel Bristot de Oliveira 
1429bce29ac9SDaniel Bristot de Oliveira 	for_each_online_cpu(cpu) {
1430bce29ac9SDaniel Bristot de Oliveira 		kthread = per_cpu(per_cpu_osnoise_var, cpu).kthread;
1431bce29ac9SDaniel Bristot de Oliveira 		if (kthread)
1432bce29ac9SDaniel Bristot de Oliveira 			kthread_stop(kthread);
1433bce29ac9SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
1434bce29ac9SDaniel Bristot de Oliveira 	}
1435bce29ac9SDaniel Bristot de Oliveira }
1436bce29ac9SDaniel Bristot de Oliveira 
1437bce29ac9SDaniel Bristot de Oliveira /*
1438bce29ac9SDaniel Bristot de Oliveira  * start_per_cpu_kthread - Kick off per-cpu osnoise sampling kthreads
1439bce29ac9SDaniel Bristot de Oliveira  *
1440bce29ac9SDaniel Bristot de Oliveira  * This starts the kernel thread that will look for osnoise on many
1441bce29ac9SDaniel Bristot de Oliveira  * cpus.
1442bce29ac9SDaniel Bristot de Oliveira  */
1443bce29ac9SDaniel Bristot de Oliveira static int start_per_cpu_kthreads(struct trace_array *tr)
1444bce29ac9SDaniel Bristot de Oliveira {
1445bce29ac9SDaniel Bristot de Oliveira 	struct cpumask *current_mask = &save_cpumask;
1446bce29ac9SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1447bce29ac9SDaniel Bristot de Oliveira 	char comm[24];
1448*a955d7eaSDaniel Bristot de Oliveira 	void *main = osnoise_main;
1449bce29ac9SDaniel Bristot de Oliveira 	int cpu;
1450bce29ac9SDaniel Bristot de Oliveira 
1451bce29ac9SDaniel Bristot de Oliveira 	get_online_cpus();
1452bce29ac9SDaniel Bristot de Oliveira 	/*
1453bce29ac9SDaniel Bristot de Oliveira 	 * Run only on CPUs in which trace and osnoise are allowed to run.
1454bce29ac9SDaniel Bristot de Oliveira 	 */
1455bce29ac9SDaniel Bristot de Oliveira 	cpumask_and(current_mask, tr->tracing_cpumask, &osnoise_cpumask);
1456bce29ac9SDaniel Bristot de Oliveira 	/*
1457bce29ac9SDaniel Bristot de Oliveira 	 * And the CPU is online.
1458bce29ac9SDaniel Bristot de Oliveira 	 */
1459bce29ac9SDaniel Bristot de Oliveira 	cpumask_and(current_mask, cpu_online_mask, current_mask);
1460bce29ac9SDaniel Bristot de Oliveira 	put_online_cpus();
1461bce29ac9SDaniel Bristot de Oliveira 
1462bce29ac9SDaniel Bristot de Oliveira 	for_each_online_cpu(cpu)
1463bce29ac9SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
1464bce29ac9SDaniel Bristot de Oliveira 
1465bce29ac9SDaniel Bristot de Oliveira 	for_each_cpu(cpu, current_mask) {
1466*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1467*a955d7eaSDaniel Bristot de Oliveira 		if (osnoise_data.timerlat_tracer) {
1468*a955d7eaSDaniel Bristot de Oliveira 			snprintf(comm, 24, "timerlat/%d", cpu);
1469*a955d7eaSDaniel Bristot de Oliveira 			main = timerlat_main;
1470*a955d7eaSDaniel Bristot de Oliveira 		} else {
1471bce29ac9SDaniel Bristot de Oliveira 			snprintf(comm, 24, "osnoise/%d", cpu);
1472*a955d7eaSDaniel Bristot de Oliveira 		}
1473*a955d7eaSDaniel Bristot de Oliveira #else
1474*a955d7eaSDaniel Bristot de Oliveira 		snprintf(comm, 24, "osnoise/%d", cpu);
1475*a955d7eaSDaniel Bristot de Oliveira #endif
1476*a955d7eaSDaniel Bristot de Oliveira 		kthread = kthread_create_on_cpu(main, NULL, cpu, comm);
1477bce29ac9SDaniel Bristot de Oliveira 
1478bce29ac9SDaniel Bristot de Oliveira 		if (IS_ERR(kthread)) {
1479bce29ac9SDaniel Bristot de Oliveira 			pr_err(BANNER "could not start sampling thread\n");
1480bce29ac9SDaniel Bristot de Oliveira 			stop_per_cpu_kthreads();
1481bce29ac9SDaniel Bristot de Oliveira 			return -ENOMEM;
1482bce29ac9SDaniel Bristot de Oliveira 		}
1483bce29ac9SDaniel Bristot de Oliveira 
1484bce29ac9SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = kthread;
1485bce29ac9SDaniel Bristot de Oliveira 		wake_up_process(kthread);
1486bce29ac9SDaniel Bristot de Oliveira 	}
1487bce29ac9SDaniel Bristot de Oliveira 
1488bce29ac9SDaniel Bristot de Oliveira 	return 0;
1489bce29ac9SDaniel Bristot de Oliveira }
1490bce29ac9SDaniel Bristot de Oliveira 
1491bce29ac9SDaniel Bristot de Oliveira /*
1492bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_read - Read function for reading the "cpus" file
1493bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
1494bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The userspace provided buffer to read value into
1495bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to read
1496bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current "file" position
1497bce29ac9SDaniel Bristot de Oliveira  *
1498bce29ac9SDaniel Bristot de Oliveira  * Prints the "cpus" output into the user-provided buffer.
1499bce29ac9SDaniel Bristot de Oliveira  */
1500bce29ac9SDaniel Bristot de Oliveira static ssize_t
1501bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_read(struct file *filp, char __user *ubuf, size_t count,
1502bce29ac9SDaniel Bristot de Oliveira 		  loff_t *ppos)
1503bce29ac9SDaniel Bristot de Oliveira {
1504bce29ac9SDaniel Bristot de Oliveira 	char *mask_str;
1505bce29ac9SDaniel Bristot de Oliveira 	int len;
1506bce29ac9SDaniel Bristot de Oliveira 
1507bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
1508bce29ac9SDaniel Bristot de Oliveira 
1509bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(NULL, 0, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask)) + 1;
1510bce29ac9SDaniel Bristot de Oliveira 	mask_str = kmalloc(len, GFP_KERNEL);
1511bce29ac9SDaniel Bristot de Oliveira 	if (!mask_str) {
1512bce29ac9SDaniel Bristot de Oliveira 		count = -ENOMEM;
1513bce29ac9SDaniel Bristot de Oliveira 		goto out_unlock;
1514bce29ac9SDaniel Bristot de Oliveira 	}
1515bce29ac9SDaniel Bristot de Oliveira 
1516bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(mask_str, len, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask));
1517bce29ac9SDaniel Bristot de Oliveira 	if (len >= count) {
1518bce29ac9SDaniel Bristot de Oliveira 		count = -EINVAL;
1519bce29ac9SDaniel Bristot de Oliveira 		goto out_free;
1520bce29ac9SDaniel Bristot de Oliveira 	}
1521bce29ac9SDaniel Bristot de Oliveira 
1522bce29ac9SDaniel Bristot de Oliveira 	count = simple_read_from_buffer(ubuf, count, ppos, mask_str, len);
1523bce29ac9SDaniel Bristot de Oliveira 
1524bce29ac9SDaniel Bristot de Oliveira out_free:
1525bce29ac9SDaniel Bristot de Oliveira 	kfree(mask_str);
1526bce29ac9SDaniel Bristot de Oliveira out_unlock:
1527bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1528bce29ac9SDaniel Bristot de Oliveira 
1529bce29ac9SDaniel Bristot de Oliveira 	return count;
1530bce29ac9SDaniel Bristot de Oliveira }
1531bce29ac9SDaniel Bristot de Oliveira 
1532bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_start(struct trace_array *tr);
1533bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_stop(struct trace_array *tr);
1534bce29ac9SDaniel Bristot de Oliveira 
1535bce29ac9SDaniel Bristot de Oliveira /*
1536bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_write - Write function for "cpus" entry
1537bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
1538bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The user buffer that contains the value to write
1539bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to write to "file"
1540bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current position in @file
1541bce29ac9SDaniel Bristot de Oliveira  *
1542bce29ac9SDaniel Bristot de Oliveira  * This function provides a write implementation for the "cpus"
1543bce29ac9SDaniel Bristot de Oliveira  * interface to the osnoise trace. By default, it lists all  CPUs,
1544bce29ac9SDaniel Bristot de Oliveira  * in this way, allowing osnoise threads to run on any online CPU
1545bce29ac9SDaniel Bristot de Oliveira  * of the system. It serves to restrict the execution of osnoise to the
1546bce29ac9SDaniel Bristot de Oliveira  * set of CPUs writing via this interface. Note that osnoise also
1547bce29ac9SDaniel Bristot de Oliveira  * respects the "tracing_cpumask." Hence, osnoise threads will run only
1548bce29ac9SDaniel Bristot de Oliveira  * on the set of CPUs allowed here AND on "tracing_cpumask." Why not
1549bce29ac9SDaniel Bristot de Oliveira  * have just "tracing_cpumask?" Because the user might be interested
1550bce29ac9SDaniel Bristot de Oliveira  * in tracing what is running on other CPUs. For instance, one might
1551bce29ac9SDaniel Bristot de Oliveira  * run osnoise in one HT CPU while observing what is running on the
1552bce29ac9SDaniel Bristot de Oliveira  * sibling HT CPU.
1553bce29ac9SDaniel Bristot de Oliveira  */
1554bce29ac9SDaniel Bristot de Oliveira static ssize_t
1555bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_write(struct file *filp, const char __user *ubuf, size_t count,
1556bce29ac9SDaniel Bristot de Oliveira 		   loff_t *ppos)
1557bce29ac9SDaniel Bristot de Oliveira {
1558bce29ac9SDaniel Bristot de Oliveira 	struct trace_array *tr = osnoise_trace;
1559bce29ac9SDaniel Bristot de Oliveira 	cpumask_var_t osnoise_cpumask_new;
1560bce29ac9SDaniel Bristot de Oliveira 	int running, err;
1561bce29ac9SDaniel Bristot de Oliveira 	char buf[256];
1562bce29ac9SDaniel Bristot de Oliveira 
1563bce29ac9SDaniel Bristot de Oliveira 	if (count >= 256)
1564bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
1565bce29ac9SDaniel Bristot de Oliveira 
1566bce29ac9SDaniel Bristot de Oliveira 	if (copy_from_user(buf, ubuf, count))
1567bce29ac9SDaniel Bristot de Oliveira 		return -EFAULT;
1568bce29ac9SDaniel Bristot de Oliveira 
1569bce29ac9SDaniel Bristot de Oliveira 	if (!zalloc_cpumask_var(&osnoise_cpumask_new, GFP_KERNEL))
1570bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
1571bce29ac9SDaniel Bristot de Oliveira 
1572bce29ac9SDaniel Bristot de Oliveira 	err = cpulist_parse(buf, osnoise_cpumask_new);
1573bce29ac9SDaniel Bristot de Oliveira 	if (err)
1574bce29ac9SDaniel Bristot de Oliveira 		goto err_free;
1575bce29ac9SDaniel Bristot de Oliveira 
1576bce29ac9SDaniel Bristot de Oliveira 	/*
1577bce29ac9SDaniel Bristot de Oliveira 	 * trace_types_lock is taken to avoid concurrency on start/stop
1578bce29ac9SDaniel Bristot de Oliveira 	 * and osnoise_busy.
1579bce29ac9SDaniel Bristot de Oliveira 	 */
1580bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
1581bce29ac9SDaniel Bristot de Oliveira 	running = osnoise_busy;
1582bce29ac9SDaniel Bristot de Oliveira 	if (running)
1583bce29ac9SDaniel Bristot de Oliveira 		osnoise_tracer_stop(tr);
1584bce29ac9SDaniel Bristot de Oliveira 
1585bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
1586bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, osnoise_cpumask_new);
1587bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1588bce29ac9SDaniel Bristot de Oliveira 
1589bce29ac9SDaniel Bristot de Oliveira 	if (running)
1590bce29ac9SDaniel Bristot de Oliveira 		osnoise_tracer_start(tr);
1591bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
1592bce29ac9SDaniel Bristot de Oliveira 
1593bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
1594bce29ac9SDaniel Bristot de Oliveira 	return count;
1595bce29ac9SDaniel Bristot de Oliveira 
1596bce29ac9SDaniel Bristot de Oliveira err_free:
1597bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
1598bce29ac9SDaniel Bristot de Oliveira 
1599bce29ac9SDaniel Bristot de Oliveira 	return err;
1600bce29ac9SDaniel Bristot de Oliveira }
1601bce29ac9SDaniel Bristot de Oliveira 
1602bce29ac9SDaniel Bristot de Oliveira /*
1603bce29ac9SDaniel Bristot de Oliveira  * osnoise/runtime_us: cannot be greater than the period.
1604bce29ac9SDaniel Bristot de Oliveira  */
1605bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_runtime = {
1606bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1607bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_runtime,
1608bce29ac9SDaniel Bristot de Oliveira 	.max	= &osnoise_data.sample_period,
1609bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
1610bce29ac9SDaniel Bristot de Oliveira };
1611bce29ac9SDaniel Bristot de Oliveira 
1612bce29ac9SDaniel Bristot de Oliveira /*
1613bce29ac9SDaniel Bristot de Oliveira  * osnoise/period_us: cannot be smaller than the runtime.
1614bce29ac9SDaniel Bristot de Oliveira  */
1615bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_period = {
1616bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1617bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_period,
1618bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
1619bce29ac9SDaniel Bristot de Oliveira 	.min	= &osnoise_data.sample_runtime,
1620bce29ac9SDaniel Bristot de Oliveira };
1621bce29ac9SDaniel Bristot de Oliveira 
1622bce29ac9SDaniel Bristot de Oliveira /*
1623bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_us: no limit.
1624bce29ac9SDaniel Bristot de Oliveira  */
1625bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_in = {
1626bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1627bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing,
1628bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
1629bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
1630bce29ac9SDaniel Bristot de Oliveira };
1631bce29ac9SDaniel Bristot de Oliveira 
1632bce29ac9SDaniel Bristot de Oliveira /*
1633bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_total_us: no limit.
1634bce29ac9SDaniel Bristot de Oliveira  */
1635bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_total = {
1636bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1637bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing_total,
1638bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
1639bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
1640bce29ac9SDaniel Bristot de Oliveira };
1641bce29ac9SDaniel Bristot de Oliveira 
1642*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1643*a955d7eaSDaniel Bristot de Oliveira /*
1644*a955d7eaSDaniel Bristot de Oliveira  * osnoise/print_stack: print the stacktrace of the IRQ handler if the total
1645*a955d7eaSDaniel Bristot de Oliveira  * latency is higher than val.
1646*a955d7eaSDaniel Bristot de Oliveira  */
1647*a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_print_stack = {
1648*a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1649*a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.print_stack,
1650*a955d7eaSDaniel Bristot de Oliveira 	.max	= NULL,
1651*a955d7eaSDaniel Bristot de Oliveira 	.min	= NULL,
1652*a955d7eaSDaniel Bristot de Oliveira };
1653*a955d7eaSDaniel Bristot de Oliveira 
1654*a955d7eaSDaniel Bristot de Oliveira /*
1655*a955d7eaSDaniel Bristot de Oliveira  * osnoise/timerlat_period: min 100 us, max 1 s
1656*a955d7eaSDaniel Bristot de Oliveira  */
1657*a955d7eaSDaniel Bristot de Oliveira u64 timerlat_min_period = 100;
1658*a955d7eaSDaniel Bristot de Oliveira u64 timerlat_max_period = 1000000;
1659*a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param timerlat_period = {
1660*a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
1661*a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.timerlat_period,
1662*a955d7eaSDaniel Bristot de Oliveira 	.max	= &timerlat_max_period,
1663*a955d7eaSDaniel Bristot de Oliveira 	.min	= &timerlat_min_period,
1664*a955d7eaSDaniel Bristot de Oliveira };
1665*a955d7eaSDaniel Bristot de Oliveira #endif
1666*a955d7eaSDaniel Bristot de Oliveira 
1667bce29ac9SDaniel Bristot de Oliveira static const struct file_operations cpus_fops = {
1668bce29ac9SDaniel Bristot de Oliveira 	.open		= tracing_open_generic,
1669bce29ac9SDaniel Bristot de Oliveira 	.read		= osnoise_cpus_read,
1670bce29ac9SDaniel Bristot de Oliveira 	.write		= osnoise_cpus_write,
1671bce29ac9SDaniel Bristot de Oliveira 	.llseek		= generic_file_llseek,
1672bce29ac9SDaniel Bristot de Oliveira };
1673bce29ac9SDaniel Bristot de Oliveira 
1674bce29ac9SDaniel Bristot de Oliveira /*
1675bce29ac9SDaniel Bristot de Oliveira  * init_tracefs - A function to initialize the tracefs interface files
1676bce29ac9SDaniel Bristot de Oliveira  *
1677*a955d7eaSDaniel Bristot de Oliveira  * This function creates entries in tracefs for "osnoise" and "timerlat".
1678*a955d7eaSDaniel Bristot de Oliveira  * It creates these directories in the tracing directory, and within that
1679*a955d7eaSDaniel Bristot de Oliveira  * directory the use can change and view the configs.
1680bce29ac9SDaniel Bristot de Oliveira  */
1681bce29ac9SDaniel Bristot de Oliveira static int init_tracefs(void)
1682bce29ac9SDaniel Bristot de Oliveira {
1683bce29ac9SDaniel Bristot de Oliveira 	struct dentry *top_dir;
1684bce29ac9SDaniel Bristot de Oliveira 	struct dentry *tmp;
1685bce29ac9SDaniel Bristot de Oliveira 	int ret;
1686bce29ac9SDaniel Bristot de Oliveira 
1687bce29ac9SDaniel Bristot de Oliveira 	ret = tracing_init_dentry();
1688bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1689bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
1690bce29ac9SDaniel Bristot de Oliveira 
1691bce29ac9SDaniel Bristot de Oliveira 	top_dir = tracefs_create_dir("osnoise", NULL);
1692bce29ac9SDaniel Bristot de Oliveira 	if (!top_dir)
1693*a955d7eaSDaniel Bristot de Oliveira 		return 0;
1694bce29ac9SDaniel Bristot de Oliveira 
1695bce29ac9SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("period_us", 0640, top_dir,
1696bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_period, &trace_min_max_fops);
1697bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
1698bce29ac9SDaniel Bristot de Oliveira 		goto err;
1699bce29ac9SDaniel Bristot de Oliveira 
1700bce29ac9SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("runtime_us", 0644, top_dir,
1701bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_runtime, &trace_min_max_fops);
1702bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
1703bce29ac9SDaniel Bristot de Oliveira 		goto err;
1704bce29ac9SDaniel Bristot de Oliveira 
1705bce29ac9SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("stop_tracing_us", 0640, top_dir,
1706bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_in, &trace_min_max_fops);
1707bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
1708bce29ac9SDaniel Bristot de Oliveira 		goto err;
1709bce29ac9SDaniel Bristot de Oliveira 
1710bce29ac9SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("stop_tracing_total_us", 0640, top_dir,
1711bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_total, &trace_min_max_fops);
1712bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
1713bce29ac9SDaniel Bristot de Oliveira 		goto err;
1714bce29ac9SDaniel Bristot de Oliveira 
1715bce29ac9SDaniel Bristot de Oliveira 	tmp = trace_create_file("cpus", 0644, top_dir, NULL, &cpus_fops);
1716bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
1717bce29ac9SDaniel Bristot de Oliveira 		goto err;
1718*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1719*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
1720*a955d7eaSDaniel Bristot de Oliveira 	tmp = tracefs_create_file("print_stack", 0640, top_dir,
1721*a955d7eaSDaniel Bristot de Oliveira 				  &osnoise_print_stack, &trace_min_max_fops);
1722*a955d7eaSDaniel Bristot de Oliveira 	if (!tmp)
1723*a955d7eaSDaniel Bristot de Oliveira 		goto err;
1724*a955d7eaSDaniel Bristot de Oliveira #endif
1725*a955d7eaSDaniel Bristot de Oliveira 
1726*a955d7eaSDaniel Bristot de Oliveira 	tmp = tracefs_create_file("timerlat_period_us", 0640, top_dir,
1727*a955d7eaSDaniel Bristot de Oliveira 				  &timerlat_period, &trace_min_max_fops);
1728*a955d7eaSDaniel Bristot de Oliveira 	if (!tmp)
1729*a955d7eaSDaniel Bristot de Oliveira 		goto err;
1730*a955d7eaSDaniel Bristot de Oliveira #endif
1731bce29ac9SDaniel Bristot de Oliveira 
1732bce29ac9SDaniel Bristot de Oliveira 	return 0;
1733bce29ac9SDaniel Bristot de Oliveira 
1734bce29ac9SDaniel Bristot de Oliveira err:
1735bce29ac9SDaniel Bristot de Oliveira 	tracefs_remove(top_dir);
1736bce29ac9SDaniel Bristot de Oliveira 	return -ENOMEM;
1737bce29ac9SDaniel Bristot de Oliveira }
1738bce29ac9SDaniel Bristot de Oliveira 
1739bce29ac9SDaniel Bristot de Oliveira static int osnoise_hook_events(void)
1740bce29ac9SDaniel Bristot de Oliveira {
1741bce29ac9SDaniel Bristot de Oliveira 	int retval;
1742bce29ac9SDaniel Bristot de Oliveira 
1743bce29ac9SDaniel Bristot de Oliveira 	/*
1744bce29ac9SDaniel Bristot de Oliveira 	 * Trace is already hooked, we are re-enabling from
1745bce29ac9SDaniel Bristot de Oliveira 	 * a stop_tracing_*.
1746bce29ac9SDaniel Bristot de Oliveira 	 */
1747bce29ac9SDaniel Bristot de Oliveira 	if (trace_osnoise_callback_enabled)
1748bce29ac9SDaniel Bristot de Oliveira 		return 0;
1749bce29ac9SDaniel Bristot de Oliveira 
1750bce29ac9SDaniel Bristot de Oliveira 	retval = hook_irq_events();
1751bce29ac9SDaniel Bristot de Oliveira 	if (retval)
1752bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
1753bce29ac9SDaniel Bristot de Oliveira 
1754bce29ac9SDaniel Bristot de Oliveira 	retval = hook_softirq_events();
1755bce29ac9SDaniel Bristot de Oliveira 	if (retval)
1756bce29ac9SDaniel Bristot de Oliveira 		goto out_unhook_irq;
1757bce29ac9SDaniel Bristot de Oliveira 
1758bce29ac9SDaniel Bristot de Oliveira 	retval = hook_thread_events();
1759bce29ac9SDaniel Bristot de Oliveira 	/*
1760bce29ac9SDaniel Bristot de Oliveira 	 * All fine!
1761bce29ac9SDaniel Bristot de Oliveira 	 */
1762bce29ac9SDaniel Bristot de Oliveira 	if (!retval)
1763bce29ac9SDaniel Bristot de Oliveira 		return 0;
1764bce29ac9SDaniel Bristot de Oliveira 
1765bce29ac9SDaniel Bristot de Oliveira 	unhook_softirq_events();
1766bce29ac9SDaniel Bristot de Oliveira out_unhook_irq:
1767bce29ac9SDaniel Bristot de Oliveira 	unhook_irq_events();
1768bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
1769bce29ac9SDaniel Bristot de Oliveira }
1770bce29ac9SDaniel Bristot de Oliveira 
1771*a955d7eaSDaniel Bristot de Oliveira static int __osnoise_tracer_start(struct trace_array *tr)
1772bce29ac9SDaniel Bristot de Oliveira {
1773bce29ac9SDaniel Bristot de Oliveira 	int retval;
1774bce29ac9SDaniel Bristot de Oliveira 
1775bce29ac9SDaniel Bristot de Oliveira 	osn_var_reset_all();
1776bce29ac9SDaniel Bristot de Oliveira 
1777bce29ac9SDaniel Bristot de Oliveira 	retval = osnoise_hook_events();
1778bce29ac9SDaniel Bristot de Oliveira 	if (retval)
1779*a955d7eaSDaniel Bristot de Oliveira 		return retval;
1780bce29ac9SDaniel Bristot de Oliveira 	/*
1781bce29ac9SDaniel Bristot de Oliveira 	 * Make sure NMIs see reseted values.
1782bce29ac9SDaniel Bristot de Oliveira 	 */
1783bce29ac9SDaniel Bristot de Oliveira 	barrier();
1784bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = true;
1785bce29ac9SDaniel Bristot de Oliveira 
1786bce29ac9SDaniel Bristot de Oliveira 	retval = start_per_cpu_kthreads(tr);
1787*a955d7eaSDaniel Bristot de Oliveira 	if (retval) {
1788*a955d7eaSDaniel Bristot de Oliveira 		unhook_irq_events();
1789*a955d7eaSDaniel Bristot de Oliveira 		return retval;
1790*a955d7eaSDaniel Bristot de Oliveira 	}
1791*a955d7eaSDaniel Bristot de Oliveira 
1792*a955d7eaSDaniel Bristot de Oliveira 	osnoise_busy = true;
1793*a955d7eaSDaniel Bristot de Oliveira 
1794*a955d7eaSDaniel Bristot de Oliveira 	return 0;
1795*a955d7eaSDaniel Bristot de Oliveira }
1796*a955d7eaSDaniel Bristot de Oliveira 
1797*a955d7eaSDaniel Bristot de Oliveira static void osnoise_tracer_start(struct trace_array *tr)
1798*a955d7eaSDaniel Bristot de Oliveira {
1799*a955d7eaSDaniel Bristot de Oliveira 	int retval;
1800*a955d7eaSDaniel Bristot de Oliveira 
1801*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_busy)
1802bce29ac9SDaniel Bristot de Oliveira 		return;
1803bce29ac9SDaniel Bristot de Oliveira 
1804*a955d7eaSDaniel Bristot de Oliveira 	retval = __osnoise_tracer_start(tr);
1805*a955d7eaSDaniel Bristot de Oliveira 	if (retval)
1806bce29ac9SDaniel Bristot de Oliveira 		pr_err(BANNER "Error starting osnoise tracer\n");
1807*a955d7eaSDaniel Bristot de Oliveira 
1808bce29ac9SDaniel Bristot de Oliveira }
1809bce29ac9SDaniel Bristot de Oliveira 
1810bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_stop(struct trace_array *tr)
1811bce29ac9SDaniel Bristot de Oliveira {
1812bce29ac9SDaniel Bristot de Oliveira 	if (!osnoise_busy)
1813bce29ac9SDaniel Bristot de Oliveira 		return;
1814bce29ac9SDaniel Bristot de Oliveira 
1815bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = false;
1816bce29ac9SDaniel Bristot de Oliveira 	barrier();
1817bce29ac9SDaniel Bristot de Oliveira 
1818bce29ac9SDaniel Bristot de Oliveira 	stop_per_cpu_kthreads();
1819bce29ac9SDaniel Bristot de Oliveira 
1820bce29ac9SDaniel Bristot de Oliveira 	unhook_irq_events();
1821bce29ac9SDaniel Bristot de Oliveira 	unhook_softirq_events();
1822bce29ac9SDaniel Bristot de Oliveira 	unhook_thread_events();
1823bce29ac9SDaniel Bristot de Oliveira 
1824bce29ac9SDaniel Bristot de Oliveira 	osnoise_busy = false;
1825bce29ac9SDaniel Bristot de Oliveira }
1826bce29ac9SDaniel Bristot de Oliveira 
1827bce29ac9SDaniel Bristot de Oliveira static int osnoise_tracer_init(struct trace_array *tr)
1828bce29ac9SDaniel Bristot de Oliveira {
1829*a955d7eaSDaniel Bristot de Oliveira 
1830bce29ac9SDaniel Bristot de Oliveira 	/* Only allow one instance to enable this */
1831bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_busy)
1832bce29ac9SDaniel Bristot de Oliveira 		return -EBUSY;
1833bce29ac9SDaniel Bristot de Oliveira 
1834bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace = tr;
1835bce29ac9SDaniel Bristot de Oliveira 	tr->max_latency = 0;
1836bce29ac9SDaniel Bristot de Oliveira 
1837bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_start(tr);
1838bce29ac9SDaniel Bristot de Oliveira 
1839bce29ac9SDaniel Bristot de Oliveira 	return 0;
1840bce29ac9SDaniel Bristot de Oliveira }
1841bce29ac9SDaniel Bristot de Oliveira 
1842bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_reset(struct trace_array *tr)
1843bce29ac9SDaniel Bristot de Oliveira {
1844bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_stop(tr);
1845bce29ac9SDaniel Bristot de Oliveira }
1846bce29ac9SDaniel Bristot de Oliveira 
1847bce29ac9SDaniel Bristot de Oliveira static struct tracer osnoise_tracer __read_mostly = {
1848bce29ac9SDaniel Bristot de Oliveira 	.name		= "osnoise",
1849bce29ac9SDaniel Bristot de Oliveira 	.init		= osnoise_tracer_init,
1850bce29ac9SDaniel Bristot de Oliveira 	.reset		= osnoise_tracer_reset,
1851bce29ac9SDaniel Bristot de Oliveira 	.start		= osnoise_tracer_start,
1852bce29ac9SDaniel Bristot de Oliveira 	.stop		= osnoise_tracer_stop,
1853bce29ac9SDaniel Bristot de Oliveira 	.print_header	= print_osnoise_headers,
1854bce29ac9SDaniel Bristot de Oliveira 	.allow_instances = true,
1855bce29ac9SDaniel Bristot de Oliveira };
1856bce29ac9SDaniel Bristot de Oliveira 
1857*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1858*a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_start(struct trace_array *tr)
1859*a955d7eaSDaniel Bristot de Oliveira {
1860*a955d7eaSDaniel Bristot de Oliveira 	int retval;
1861*a955d7eaSDaniel Bristot de Oliveira 
1862*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_busy)
1863*a955d7eaSDaniel Bristot de Oliveira 		return;
1864*a955d7eaSDaniel Bristot de Oliveira 
1865*a955d7eaSDaniel Bristot de Oliveira 	osnoise_data.timerlat_tracer = 1;
1866*a955d7eaSDaniel Bristot de Oliveira 
1867*a955d7eaSDaniel Bristot de Oliveira 	retval = __osnoise_tracer_start(tr);
1868*a955d7eaSDaniel Bristot de Oliveira 	if (retval)
1869*a955d7eaSDaniel Bristot de Oliveira 		goto out_err;
1870*a955d7eaSDaniel Bristot de Oliveira 
1871*a955d7eaSDaniel Bristot de Oliveira 	return;
1872*a955d7eaSDaniel Bristot de Oliveira out_err:
1873*a955d7eaSDaniel Bristot de Oliveira 	pr_err(BANNER "Error starting timerlat tracer\n");
1874*a955d7eaSDaniel Bristot de Oliveira }
1875*a955d7eaSDaniel Bristot de Oliveira 
1876*a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_stop(struct trace_array *tr)
1877*a955d7eaSDaniel Bristot de Oliveira {
1878*a955d7eaSDaniel Bristot de Oliveira 	int cpu;
1879*a955d7eaSDaniel Bristot de Oliveira 
1880*a955d7eaSDaniel Bristot de Oliveira 	if (!osnoise_busy)
1881*a955d7eaSDaniel Bristot de Oliveira 		return;
1882*a955d7eaSDaniel Bristot de Oliveira 
1883*a955d7eaSDaniel Bristot de Oliveira 	for_each_online_cpu(cpu)
1884*a955d7eaSDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).sampling = 0;
1885*a955d7eaSDaniel Bristot de Oliveira 
1886*a955d7eaSDaniel Bristot de Oliveira 	osnoise_tracer_stop(tr);
1887*a955d7eaSDaniel Bristot de Oliveira 
1888*a955d7eaSDaniel Bristot de Oliveira 	osnoise_data.timerlat_tracer = 0;
1889*a955d7eaSDaniel Bristot de Oliveira }
1890*a955d7eaSDaniel Bristot de Oliveira 
1891*a955d7eaSDaniel Bristot de Oliveira static int timerlat_tracer_init(struct trace_array *tr)
1892*a955d7eaSDaniel Bristot de Oliveira {
1893*a955d7eaSDaniel Bristot de Oliveira 	/* Only allow one instance to enable this */
1894*a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_busy)
1895*a955d7eaSDaniel Bristot de Oliveira 		return -EBUSY;
1896*a955d7eaSDaniel Bristot de Oliveira 
1897*a955d7eaSDaniel Bristot de Oliveira 	osnoise_trace = tr;
1898*a955d7eaSDaniel Bristot de Oliveira 
1899*a955d7eaSDaniel Bristot de Oliveira 	tr->max_latency = 0;
1900*a955d7eaSDaniel Bristot de Oliveira 
1901*a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_start(tr);
1902*a955d7eaSDaniel Bristot de Oliveira 
1903*a955d7eaSDaniel Bristot de Oliveira 	return 0;
1904*a955d7eaSDaniel Bristot de Oliveira }
1905*a955d7eaSDaniel Bristot de Oliveira 
1906*a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_reset(struct trace_array *tr)
1907*a955d7eaSDaniel Bristot de Oliveira {
1908*a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_stop(tr);
1909*a955d7eaSDaniel Bristot de Oliveira }
1910*a955d7eaSDaniel Bristot de Oliveira 
1911*a955d7eaSDaniel Bristot de Oliveira static struct tracer timerlat_tracer __read_mostly = {
1912*a955d7eaSDaniel Bristot de Oliveira 	.name		= "timerlat",
1913*a955d7eaSDaniel Bristot de Oliveira 	.init		= timerlat_tracer_init,
1914*a955d7eaSDaniel Bristot de Oliveira 	.reset		= timerlat_tracer_reset,
1915*a955d7eaSDaniel Bristot de Oliveira 	.start		= timerlat_tracer_start,
1916*a955d7eaSDaniel Bristot de Oliveira 	.stop		= timerlat_tracer_stop,
1917*a955d7eaSDaniel Bristot de Oliveira 	.print_header	= print_timerlat_headers,
1918*a955d7eaSDaniel Bristot de Oliveira 	.allow_instances = true,
1919*a955d7eaSDaniel Bristot de Oliveira };
1920*a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
1921*a955d7eaSDaniel Bristot de Oliveira 
1922bce29ac9SDaniel Bristot de Oliveira __init static int init_osnoise_tracer(void)
1923bce29ac9SDaniel Bristot de Oliveira {
1924bce29ac9SDaniel Bristot de Oliveira 	int ret;
1925bce29ac9SDaniel Bristot de Oliveira 
1926bce29ac9SDaniel Bristot de Oliveira 	mutex_init(&interface_lock);
1927bce29ac9SDaniel Bristot de Oliveira 
1928bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, cpu_all_mask);
1929bce29ac9SDaniel Bristot de Oliveira 
1930bce29ac9SDaniel Bristot de Oliveira 	ret = register_tracer(&osnoise_tracer);
1931*a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
1932*a955d7eaSDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering osnoise!\n");
1933bce29ac9SDaniel Bristot de Oliveira 		return ret;
1934*a955d7eaSDaniel Bristot de Oliveira 	}
1935*a955d7eaSDaniel Bristot de Oliveira 
1936*a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1937*a955d7eaSDaniel Bristot de Oliveira 	ret = register_tracer(&timerlat_tracer);
1938*a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
1939*a955d7eaSDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering timerlat\n");
1940*a955d7eaSDaniel Bristot de Oliveira 		return ret;
1941*a955d7eaSDaniel Bristot de Oliveira 	}
1942*a955d7eaSDaniel Bristot de Oliveira #endif
1943bce29ac9SDaniel Bristot de Oliveira 
1944bce29ac9SDaniel Bristot de Oliveira 	init_tracefs();
1945bce29ac9SDaniel Bristot de Oliveira 
1946bce29ac9SDaniel Bristot de Oliveira 	return 0;
1947bce29ac9SDaniel Bristot de Oliveira }
1948bce29ac9SDaniel Bristot de Oliveira late_initcall(init_osnoise_tracer);
1949