xref: /openbmc/linux/kernel/trace/trace_osnoise.c (revision ec370890f92ba8ad5476a34068655b06ba48def7)
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.
4a955d7eaSDaniel 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>
25a955d7eaSDaniel 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 /*
42bce29ac9SDaniel Bristot de Oliveira  * Default values.
43bce29ac9SDaniel Bristot de Oliveira  */
44bce29ac9SDaniel Bristot de Oliveira #define BANNER			"osnoise: "
45bce29ac9SDaniel Bristot de Oliveira #define DEFAULT_SAMPLE_PERIOD	1000000			/* 1s */
46bce29ac9SDaniel Bristot de Oliveira #define DEFAULT_SAMPLE_RUNTIME	1000000			/* 1s */
47bce29ac9SDaniel Bristot de Oliveira 
48a955d7eaSDaniel Bristot de Oliveira #define DEFAULT_TIMERLAT_PERIOD	1000			/* 1ms */
49a955d7eaSDaniel Bristot de Oliveira #define DEFAULT_TIMERLAT_PRIO	95			/* FIFO 95 */
50a955d7eaSDaniel Bristot de Oliveira 
51bce29ac9SDaniel Bristot de Oliveira /*
52b179d48bSDaniel Bristot de Oliveira  * osnoise/options entries.
53b179d48bSDaniel Bristot de Oliveira  */
54b179d48bSDaniel Bristot de Oliveira enum osnoise_options_index {
55b179d48bSDaniel Bristot de Oliveira 	OSN_DEFAULTS = 0,
5630838fcdSDaniel Bristot de Oliveira 	OSN_WORKLOAD,
57b179d48bSDaniel Bristot de Oliveira 	OSN_MAX
58b179d48bSDaniel Bristot de Oliveira };
59b179d48bSDaniel Bristot de Oliveira 
6030838fcdSDaniel Bristot de Oliveira static const char * const osnoise_options_str[OSN_MAX] = { "DEFAULTS", "OSNOISE_WORKLOAD" };
61b179d48bSDaniel Bristot de Oliveira 
6230838fcdSDaniel Bristot de Oliveira #define OSN_DEFAULT_OPTIONS		0x2
63*ec370890SDaniel Bristot de Oliveira static unsigned long osnoise_options	= OSN_DEFAULT_OPTIONS;
64b179d48bSDaniel Bristot de Oliveira 
65b179d48bSDaniel Bristot de Oliveira /*
66dae18134SDaniel Bristot de Oliveira  * trace_array of the enabled osnoise/timerlat instances.
67dae18134SDaniel Bristot de Oliveira  */
68dae18134SDaniel Bristot de Oliveira struct osnoise_instance {
69dae18134SDaniel Bristot de Oliveira 	struct list_head	list;
70dae18134SDaniel Bristot de Oliveira 	struct trace_array	*tr;
71dae18134SDaniel Bristot de Oliveira };
72d7458bc0SDaniel Bristot de Oliveira 
73d7458bc0SDaniel Bristot de Oliveira static struct list_head osnoise_instances;
74dae18134SDaniel Bristot de Oliveira 
75dae18134SDaniel Bristot de Oliveira static bool osnoise_has_registered_instances(void)
76dae18134SDaniel Bristot de Oliveira {
77dae18134SDaniel Bristot de Oliveira 	return !!list_first_or_null_rcu(&osnoise_instances,
78dae18134SDaniel Bristot de Oliveira 					struct osnoise_instance,
79dae18134SDaniel Bristot de Oliveira 					list);
80dae18134SDaniel Bristot de Oliveira }
81dae18134SDaniel Bristot de Oliveira 
82dae18134SDaniel Bristot de Oliveira /*
832fac8d64SDaniel Bristot de Oliveira  * osnoise_instance_registered - check if a tr is already registered
842fac8d64SDaniel Bristot de Oliveira  */
852fac8d64SDaniel Bristot de Oliveira static int osnoise_instance_registered(struct trace_array *tr)
862fac8d64SDaniel Bristot de Oliveira {
872fac8d64SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
882fac8d64SDaniel Bristot de Oliveira 	int found = 0;
892fac8d64SDaniel Bristot de Oliveira 
902fac8d64SDaniel Bristot de Oliveira 	rcu_read_lock();
912fac8d64SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
922fac8d64SDaniel Bristot de Oliveira 		if (inst->tr == tr)
932fac8d64SDaniel Bristot de Oliveira 			found = 1;
942fac8d64SDaniel Bristot de Oliveira 	}
952fac8d64SDaniel Bristot de Oliveira 	rcu_read_unlock();
962fac8d64SDaniel Bristot de Oliveira 
972fac8d64SDaniel Bristot de Oliveira 	return found;
982fac8d64SDaniel Bristot de Oliveira }
992fac8d64SDaniel Bristot de Oliveira 
1002fac8d64SDaniel Bristot de Oliveira /*
101dae18134SDaniel Bristot de Oliveira  * osnoise_register_instance - register a new trace instance
102dae18134SDaniel Bristot de Oliveira  *
103dae18134SDaniel Bristot de Oliveira  * Register a trace_array *tr in the list of instances running
104dae18134SDaniel Bristot de Oliveira  * osnoise/timerlat tracers.
105dae18134SDaniel Bristot de Oliveira  */
106dae18134SDaniel Bristot de Oliveira static int osnoise_register_instance(struct trace_array *tr)
107dae18134SDaniel Bristot de Oliveira {
108dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
109dae18134SDaniel Bristot de Oliveira 
110dae18134SDaniel Bristot de Oliveira 	/*
111dae18134SDaniel Bristot de Oliveira 	 * register/unregister serialization is provided by trace's
112dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock.
113dae18134SDaniel Bristot de Oliveira 	 */
114dae18134SDaniel Bristot de Oliveira 	lockdep_assert_held(&trace_types_lock);
115dae18134SDaniel Bristot de Oliveira 
116dae18134SDaniel Bristot de Oliveira 	inst = kmalloc(sizeof(*inst), GFP_KERNEL);
117dae18134SDaniel Bristot de Oliveira 	if (!inst)
118dae18134SDaniel Bristot de Oliveira 		return -ENOMEM;
119dae18134SDaniel Bristot de Oliveira 
120dae18134SDaniel Bristot de Oliveira 	INIT_LIST_HEAD_RCU(&inst->list);
121dae18134SDaniel Bristot de Oliveira 	inst->tr = tr;
122dae18134SDaniel Bristot de Oliveira 	list_add_tail_rcu(&inst->list, &osnoise_instances);
123dae18134SDaniel Bristot de Oliveira 
124dae18134SDaniel Bristot de Oliveira 	return 0;
125dae18134SDaniel Bristot de Oliveira }
126dae18134SDaniel Bristot de Oliveira 
127dae18134SDaniel Bristot de Oliveira /*
128dae18134SDaniel Bristot de Oliveira  *  osnoise_unregister_instance - unregister a registered trace instance
129dae18134SDaniel Bristot de Oliveira  *
130dae18134SDaniel Bristot de Oliveira  * Remove the trace_array *tr from the list of instances running
131dae18134SDaniel Bristot de Oliveira  * osnoise/timerlat tracers.
132dae18134SDaniel Bristot de Oliveira  */
133dae18134SDaniel Bristot de Oliveira static void osnoise_unregister_instance(struct trace_array *tr)
134dae18134SDaniel Bristot de Oliveira {
135dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
136dae18134SDaniel Bristot de Oliveira 	int found = 0;
137dae18134SDaniel Bristot de Oliveira 
138dae18134SDaniel Bristot de Oliveira 	/*
139dae18134SDaniel Bristot de Oliveira 	 * register/unregister serialization is provided by trace's
140dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock.
141dae18134SDaniel Bristot de Oliveira 	 */
142dae18134SDaniel Bristot de Oliveira 	lockdep_assert_held(&trace_types_lock);
143dae18134SDaniel Bristot de Oliveira 
144dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
145dae18134SDaniel Bristot de Oliveira 		if (inst->tr == tr) {
146dae18134SDaniel Bristot de Oliveira 			list_del_rcu(&inst->list);
147dae18134SDaniel Bristot de Oliveira 			found = 1;
148dae18134SDaniel Bristot de Oliveira 			break;
149dae18134SDaniel Bristot de Oliveira 		}
150dae18134SDaniel Bristot de Oliveira 	}
151dae18134SDaniel Bristot de Oliveira 
152dae18134SDaniel Bristot de Oliveira 	if (!found)
153dae18134SDaniel Bristot de Oliveira 		return;
154dae18134SDaniel Bristot de Oliveira 
155a6ed2aeeSUladzislau Rezki (Sony) 	kvfree_rcu(inst);
156dae18134SDaniel Bristot de Oliveira }
157dae18134SDaniel Bristot de Oliveira 
158dae18134SDaniel Bristot de Oliveira /*
159bce29ac9SDaniel Bristot de Oliveira  * NMI runtime info.
160bce29ac9SDaniel Bristot de Oliveira  */
161bce29ac9SDaniel Bristot de Oliveira struct osn_nmi {
162bce29ac9SDaniel Bristot de Oliveira 	u64	count;
163bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
164bce29ac9SDaniel Bristot de Oliveira };
165bce29ac9SDaniel Bristot de Oliveira 
166bce29ac9SDaniel Bristot de Oliveira /*
167bce29ac9SDaniel Bristot de Oliveira  * IRQ runtime info.
168bce29ac9SDaniel Bristot de Oliveira  */
169bce29ac9SDaniel Bristot de Oliveira struct osn_irq {
170bce29ac9SDaniel Bristot de Oliveira 	u64	count;
171bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
172bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
173bce29ac9SDaniel Bristot de Oliveira };
174bce29ac9SDaniel Bristot de Oliveira 
175a955d7eaSDaniel Bristot de Oliveira #define IRQ_CONTEXT	0
176a955d7eaSDaniel Bristot de Oliveira #define THREAD_CONTEXT	1
177bce29ac9SDaniel Bristot de Oliveira /*
178bce29ac9SDaniel Bristot de Oliveira  * sofirq runtime info.
179bce29ac9SDaniel Bristot de Oliveira  */
180bce29ac9SDaniel Bristot de Oliveira struct osn_softirq {
181bce29ac9SDaniel Bristot de Oliveira 	u64	count;
182bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
183bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
184bce29ac9SDaniel Bristot de Oliveira };
185bce29ac9SDaniel Bristot de Oliveira 
186bce29ac9SDaniel Bristot de Oliveira /*
187bce29ac9SDaniel Bristot de Oliveira  * thread runtime info.
188bce29ac9SDaniel Bristot de Oliveira  */
189bce29ac9SDaniel Bristot de Oliveira struct osn_thread {
190bce29ac9SDaniel Bristot de Oliveira 	u64	count;
191bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
192bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
193bce29ac9SDaniel Bristot de Oliveira };
194bce29ac9SDaniel Bristot de Oliveira 
195bce29ac9SDaniel Bristot de Oliveira /*
196bce29ac9SDaniel Bristot de Oliveira  * Runtime information: this structure saves the runtime information used by
197bce29ac9SDaniel Bristot de Oliveira  * one sampling thread.
198bce29ac9SDaniel Bristot de Oliveira  */
199bce29ac9SDaniel Bristot de Oliveira struct osnoise_variables {
200bce29ac9SDaniel Bristot de Oliveira 	struct task_struct	*kthread;
201bce29ac9SDaniel Bristot de Oliveira 	bool			sampling;
202bce29ac9SDaniel Bristot de Oliveira 	pid_t			pid;
203bce29ac9SDaniel Bristot de Oliveira 	struct osn_nmi		nmi;
204bce29ac9SDaniel Bristot de Oliveira 	struct osn_irq		irq;
205bce29ac9SDaniel Bristot de Oliveira 	struct osn_softirq	softirq;
206bce29ac9SDaniel Bristot de Oliveira 	struct osn_thread	thread;
207bce29ac9SDaniel Bristot de Oliveira 	local_t			int_counter;
208bce29ac9SDaniel Bristot de Oliveira };
209bce29ac9SDaniel Bristot de Oliveira 
210bce29ac9SDaniel Bristot de Oliveira /*
211bce29ac9SDaniel Bristot de Oliveira  * Per-cpu runtime information.
212bce29ac9SDaniel Bristot de Oliveira  */
213bce29ac9SDaniel Bristot de Oliveira DEFINE_PER_CPU(struct osnoise_variables, per_cpu_osnoise_var);
214bce29ac9SDaniel Bristot de Oliveira 
215bce29ac9SDaniel Bristot de Oliveira /*
216bce29ac9SDaniel Bristot de Oliveira  * this_cpu_osn_var - Return the per-cpu osnoise_variables on its relative CPU
217bce29ac9SDaniel Bristot de Oliveira  */
218bce29ac9SDaniel Bristot de Oliveira static inline struct osnoise_variables *this_cpu_osn_var(void)
219bce29ac9SDaniel Bristot de Oliveira {
220bce29ac9SDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_osnoise_var);
221bce29ac9SDaniel Bristot de Oliveira }
222bce29ac9SDaniel Bristot de Oliveira 
223a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
224bce29ac9SDaniel Bristot de Oliveira /*
225a955d7eaSDaniel Bristot de Oliveira  * Runtime information for the timer mode.
226bce29ac9SDaniel Bristot de Oliveira  */
227a955d7eaSDaniel Bristot de Oliveira struct timerlat_variables {
228a955d7eaSDaniel Bristot de Oliveira 	struct task_struct	*kthread;
229a955d7eaSDaniel Bristot de Oliveira 	struct hrtimer		timer;
230a955d7eaSDaniel Bristot de Oliveira 	u64			rel_period;
231a955d7eaSDaniel Bristot de Oliveira 	u64			abs_period;
232a955d7eaSDaniel Bristot de Oliveira 	bool			tracing_thread;
233a955d7eaSDaniel Bristot de Oliveira 	u64			count;
234a955d7eaSDaniel Bristot de Oliveira };
235a955d7eaSDaniel Bristot de Oliveira 
236a955d7eaSDaniel Bristot de Oliveira DEFINE_PER_CPU(struct timerlat_variables, per_cpu_timerlat_var);
237a955d7eaSDaniel Bristot de Oliveira 
238a955d7eaSDaniel Bristot de Oliveira /*
239a955d7eaSDaniel Bristot de Oliveira  * this_cpu_tmr_var - Return the per-cpu timerlat_variables on its relative CPU
240a955d7eaSDaniel Bristot de Oliveira  */
241a955d7eaSDaniel Bristot de Oliveira static inline struct timerlat_variables *this_cpu_tmr_var(void)
242bce29ac9SDaniel Bristot de Oliveira {
243a955d7eaSDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_timerlat_var);
244a955d7eaSDaniel Bristot de Oliveira }
245a955d7eaSDaniel Bristot de Oliveira 
246a955d7eaSDaniel Bristot de Oliveira /*
247a955d7eaSDaniel Bristot de Oliveira  * tlat_var_reset - Reset the values of the given timerlat_variables
248a955d7eaSDaniel Bristot de Oliveira  */
249a955d7eaSDaniel Bristot de Oliveira static inline void tlat_var_reset(void)
250a955d7eaSDaniel Bristot de Oliveira {
251a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var;
252a955d7eaSDaniel Bristot de Oliveira 	int cpu;
253bce29ac9SDaniel Bristot de Oliveira 	/*
254bce29ac9SDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
255bce29ac9SDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
256bce29ac9SDaniel Bristot de Oliveira 	 */
257a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
258a955d7eaSDaniel Bristot de Oliveira 		tlat_var = per_cpu_ptr(&per_cpu_timerlat_var, cpu);
259a955d7eaSDaniel Bristot de Oliveira 		memset(tlat_var, 0, sizeof(*tlat_var));
260a955d7eaSDaniel Bristot de Oliveira 	}
261a955d7eaSDaniel Bristot de Oliveira }
262a955d7eaSDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
263a955d7eaSDaniel Bristot de Oliveira #define tlat_var_reset()	do {} while (0)
264a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
265a955d7eaSDaniel Bristot de Oliveira 
266a955d7eaSDaniel Bristot de Oliveira /*
267a955d7eaSDaniel Bristot de Oliveira  * osn_var_reset - Reset the values of the given osnoise_variables
268a955d7eaSDaniel Bristot de Oliveira  */
269a955d7eaSDaniel Bristot de Oliveira static inline void osn_var_reset(void)
270a955d7eaSDaniel Bristot de Oliveira {
271a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var;
272a955d7eaSDaniel Bristot de Oliveira 	int cpu;
273a955d7eaSDaniel Bristot de Oliveira 
274a955d7eaSDaniel Bristot de Oliveira 	/*
275a955d7eaSDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
276a955d7eaSDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
277a955d7eaSDaniel Bristot de Oliveira 	 */
278a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
279a955d7eaSDaniel Bristot de Oliveira 		osn_var = per_cpu_ptr(&per_cpu_osnoise_var, cpu);
280bce29ac9SDaniel Bristot de Oliveira 		memset(osn_var, 0, sizeof(*osn_var));
281bce29ac9SDaniel Bristot de Oliveira 	}
282a955d7eaSDaniel Bristot de Oliveira }
283bce29ac9SDaniel Bristot de Oliveira 
284bce29ac9SDaniel Bristot de Oliveira /*
285bce29ac9SDaniel Bristot de Oliveira  * osn_var_reset_all - Reset the value of all per-cpu osnoise_variables
286bce29ac9SDaniel Bristot de Oliveira  */
287bce29ac9SDaniel Bristot de Oliveira static inline void osn_var_reset_all(void)
288bce29ac9SDaniel Bristot de Oliveira {
289a955d7eaSDaniel Bristot de Oliveira 	osn_var_reset();
290a955d7eaSDaniel Bristot de Oliveira 	tlat_var_reset();
291bce29ac9SDaniel Bristot de Oliveira }
292bce29ac9SDaniel Bristot de Oliveira 
293bce29ac9SDaniel Bristot de Oliveira /*
294bce29ac9SDaniel Bristot de Oliveira  * Tells NMIs to call back to the osnoise tracer to record timestamps.
295bce29ac9SDaniel Bristot de Oliveira  */
296bce29ac9SDaniel Bristot de Oliveira bool trace_osnoise_callback_enabled;
297bce29ac9SDaniel Bristot de Oliveira 
298bce29ac9SDaniel Bristot de Oliveira /*
299bce29ac9SDaniel Bristot de Oliveira  * osnoise sample structure definition. Used to store the statistics of a
300bce29ac9SDaniel Bristot de Oliveira  * sample run.
301bce29ac9SDaniel Bristot de Oliveira  */
302bce29ac9SDaniel Bristot de Oliveira struct osnoise_sample {
303bce29ac9SDaniel Bristot de Oliveira 	u64			runtime;	/* runtime */
304bce29ac9SDaniel Bristot de Oliveira 	u64			noise;		/* noise */
305bce29ac9SDaniel Bristot de Oliveira 	u64			max_sample;	/* max single noise sample */
306bce29ac9SDaniel Bristot de Oliveira 	int			hw_count;	/* # HW (incl. hypervisor) interference */
307bce29ac9SDaniel Bristot de Oliveira 	int			nmi_count;	/* # NMIs during this sample */
308bce29ac9SDaniel Bristot de Oliveira 	int			irq_count;	/* # IRQs during this sample */
309bce29ac9SDaniel Bristot de Oliveira 	int			softirq_count;	/* # softirqs during this sample */
310bce29ac9SDaniel Bristot de Oliveira 	int			thread_count;	/* # threads during this sample */
311bce29ac9SDaniel Bristot de Oliveira };
312bce29ac9SDaniel Bristot de Oliveira 
313a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
314a955d7eaSDaniel Bristot de Oliveira /*
315a955d7eaSDaniel Bristot de Oliveira  * timerlat sample structure definition. Used to store the statistics of
316a955d7eaSDaniel Bristot de Oliveira  * a sample run.
317a955d7eaSDaniel Bristot de Oliveira  */
318a955d7eaSDaniel Bristot de Oliveira struct timerlat_sample {
319a955d7eaSDaniel Bristot de Oliveira 	u64			timer_latency;	/* timer_latency */
320a955d7eaSDaniel Bristot de Oliveira 	unsigned int		seqnum;		/* unique sequence */
321a955d7eaSDaniel Bristot de Oliveira 	int			context;	/* timer context */
322a955d7eaSDaniel Bristot de Oliveira };
323a955d7eaSDaniel Bristot de Oliveira #endif
324a955d7eaSDaniel Bristot de Oliveira 
325bce29ac9SDaniel Bristot de Oliveira /*
326bce29ac9SDaniel Bristot de Oliveira  * Protect the interface.
327bce29ac9SDaniel Bristot de Oliveira  */
328bce29ac9SDaniel Bristot de Oliveira struct mutex interface_lock;
329bce29ac9SDaniel Bristot de Oliveira 
330bce29ac9SDaniel Bristot de Oliveira /*
331bce29ac9SDaniel Bristot de Oliveira  * Tracer data.
332bce29ac9SDaniel Bristot de Oliveira  */
333bce29ac9SDaniel Bristot de Oliveira static struct osnoise_data {
334bce29ac9SDaniel Bristot de Oliveira 	u64	sample_period;		/* total sampling period */
335bce29ac9SDaniel Bristot de Oliveira 	u64	sample_runtime;		/* active sampling portion of period */
336a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing;		/* stop trace in the internal operation (loop/irq) */
337a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing_total;	/* stop trace in the final operation (report/thread) */
338a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
339a955d7eaSDaniel Bristot de Oliveira 	u64	timerlat_period;	/* timerlat period */
340a955d7eaSDaniel Bristot de Oliveira 	u64	print_stack;		/* print IRQ stack if total > */
341a955d7eaSDaniel Bristot de Oliveira 	int	timerlat_tracer;	/* timerlat tracer */
342a955d7eaSDaniel Bristot de Oliveira #endif
343bce29ac9SDaniel Bristot de Oliveira 	bool	tainted;		/* infor users and developers about a problem */
344bce29ac9SDaniel Bristot de Oliveira } osnoise_data = {
345bce29ac9SDaniel Bristot de Oliveira 	.sample_period			= DEFAULT_SAMPLE_PERIOD,
346bce29ac9SDaniel Bristot de Oliveira 	.sample_runtime			= DEFAULT_SAMPLE_RUNTIME,
347bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing			= 0,
348bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing_total		= 0,
349a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
350a955d7eaSDaniel Bristot de Oliveira 	.print_stack			= 0,
351a955d7eaSDaniel Bristot de Oliveira 	.timerlat_period		= DEFAULT_TIMERLAT_PERIOD,
352a955d7eaSDaniel Bristot de Oliveira 	.timerlat_tracer		= 0,
353a955d7eaSDaniel Bristot de Oliveira #endif
354bce29ac9SDaniel Bristot de Oliveira };
355bce29ac9SDaniel Bristot de Oliveira 
356ccb67544SDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
357ccb67544SDaniel Bristot de Oliveira static inline bool timerlat_enabled(void)
358ccb67544SDaniel Bristot de Oliveira {
359ccb67544SDaniel Bristot de Oliveira 	return osnoise_data.timerlat_tracer;
360ccb67544SDaniel Bristot de Oliveira }
361ccb67544SDaniel Bristot de Oliveira 
362ccb67544SDaniel Bristot de Oliveira static inline int timerlat_softirq_exit(struct osnoise_variables *osn_var)
363ccb67544SDaniel Bristot de Oliveira {
364ccb67544SDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var = this_cpu_tmr_var();
365ccb67544SDaniel Bristot de Oliveira 	/*
366ccb67544SDaniel Bristot de Oliveira 	 * If the timerlat is enabled, but the irq handler did
367ccb67544SDaniel Bristot de Oliveira 	 * not run yet enabling timerlat_tracer, do not trace.
368ccb67544SDaniel Bristot de Oliveira 	 */
369ccb67544SDaniel Bristot de Oliveira 	if (!tlat_var->tracing_thread) {
370ccb67544SDaniel Bristot de Oliveira 		osn_var->softirq.arrival_time = 0;
371ccb67544SDaniel Bristot de Oliveira 		osn_var->softirq.delta_start = 0;
372ccb67544SDaniel Bristot de Oliveira 		return 0;
373ccb67544SDaniel Bristot de Oliveira 	}
374ccb67544SDaniel Bristot de Oliveira 	return 1;
375ccb67544SDaniel Bristot de Oliveira }
376ccb67544SDaniel Bristot de Oliveira 
377ccb67544SDaniel Bristot de Oliveira static inline int timerlat_thread_exit(struct osnoise_variables *osn_var)
378ccb67544SDaniel Bristot de Oliveira {
379ccb67544SDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var = this_cpu_tmr_var();
380ccb67544SDaniel Bristot de Oliveira 	/*
381ccb67544SDaniel Bristot de Oliveira 	 * If the timerlat is enabled, but the irq handler did
382ccb67544SDaniel Bristot de Oliveira 	 * not run yet enabling timerlat_tracer, do not trace.
383ccb67544SDaniel Bristot de Oliveira 	 */
384ccb67544SDaniel Bristot de Oliveira 	if (!tlat_var->tracing_thread) {
385ccb67544SDaniel Bristot de Oliveira 		osn_var->thread.delta_start = 0;
386ccb67544SDaniel Bristot de Oliveira 		osn_var->thread.arrival_time = 0;
387ccb67544SDaniel Bristot de Oliveira 		return 0;
388ccb67544SDaniel Bristot de Oliveira 	}
389ccb67544SDaniel Bristot de Oliveira 	return 1;
390ccb67544SDaniel Bristot de Oliveira }
391ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
392ccb67544SDaniel Bristot de Oliveira static inline bool timerlat_enabled(void)
393ccb67544SDaniel Bristot de Oliveira {
394ccb67544SDaniel Bristot de Oliveira 	return false;
395ccb67544SDaniel Bristot de Oliveira }
396ccb67544SDaniel Bristot de Oliveira 
397ccb67544SDaniel Bristot de Oliveira static inline int timerlat_softirq_exit(struct osnoise_variables *osn_var)
398ccb67544SDaniel Bristot de Oliveira {
399ccb67544SDaniel Bristot de Oliveira 	return 1;
400ccb67544SDaniel Bristot de Oliveira }
401ccb67544SDaniel Bristot de Oliveira static inline int timerlat_thread_exit(struct osnoise_variables *osn_var)
402ccb67544SDaniel Bristot de Oliveira {
403ccb67544SDaniel Bristot de Oliveira 	return 1;
404ccb67544SDaniel Bristot de Oliveira }
405ccb67544SDaniel Bristot de Oliveira #endif
406ccb67544SDaniel Bristot de Oliveira 
407d03721a6SDaniel Bristot de Oliveira #ifdef CONFIG_PREEMPT_RT
408bce29ac9SDaniel Bristot de Oliveira /*
409bce29ac9SDaniel Bristot de Oliveira  * Print the osnoise header info.
410bce29ac9SDaniel Bristot de Oliveira  */
411bce29ac9SDaniel Bristot de Oliveira static void print_osnoise_headers(struct seq_file *s)
412bce29ac9SDaniel Bristot de Oliveira {
413bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.tainted)
414bce29ac9SDaniel Bristot de Oliveira 		seq_puts(s, "# osnoise is tainted!\n");
415bce29ac9SDaniel Bristot de Oliveira 
416d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-------=> irqs-off\n");
417d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _------=> need-resched\n");
418d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _-----=> need-resched-lazy\n");
419d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _----=> hardirq/softirq\n");
420d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _---=> preempt-depth\n");
421d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| / _--=> preempt-lazy-depth\n");
422d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| / _-=> migrate-disable\n");
423d03721a6SDaniel Bristot de Oliveira 
424d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||| /          ");
425d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "                                     MAX\n");
426d03721a6SDaniel Bristot de Oliveira 
427d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| /                         ");
428d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "                    SINGLE      Interference counters:\n");
429d03721a6SDaniel Bristot de Oliveira 
430d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||||               RUNTIME   ");
431d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "   NOISE  %% OF CPU  NOISE    +-----------------------------+\n");
432d03721a6SDaniel Bristot de Oliveira 
433d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||||   TIMESTAMP    IN US    ");
434d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "   IN US  AVAILABLE  IN US     HW    NMI    IRQ   SIRQ THREAD\n");
435d03721a6SDaniel Bristot de Oliveira 
436d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||||      |           |      ");
437d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "       |    |            |      |      |      |      |      |\n");
438d03721a6SDaniel Bristot de Oliveira }
439d03721a6SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
440d03721a6SDaniel Bristot de Oliveira static void print_osnoise_headers(struct seq_file *s)
441d03721a6SDaniel Bristot de Oliveira {
442d03721a6SDaniel Bristot de Oliveira 	if (osnoise_data.tainted)
443d03721a6SDaniel Bristot de Oliveira 		seq_puts(s, "# osnoise is tainted!\n");
444d03721a6SDaniel Bristot de Oliveira 
445bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
446bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
447bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
448e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth\n");
449e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _-=> migrate-disable     ");
450bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                    MAX\n");
451e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| /     delay               ");
452bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                    SINGLE      Interference counters:\n");
453bce29ac9SDaniel Bristot de Oliveira 
454e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||               RUNTIME   ");
455bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   NOISE  %% OF CPU  NOISE    +-----------------------------+\n");
456bce29ac9SDaniel Bristot de Oliveira 
457e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||   TIMESTAMP    IN US    ");
458bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   IN US  AVAILABLE  IN US     HW    NMI    IRQ   SIRQ THREAD\n");
459bce29ac9SDaniel Bristot de Oliveira 
460e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||      |           |      ");
461bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "       |    |            |      |      |      |      |      |\n");
462bce29ac9SDaniel Bristot de Oliveira }
463d03721a6SDaniel Bristot de Oliveira #endif /* CONFIG_PREEMPT_RT */
464bce29ac9SDaniel Bristot de Oliveira 
465bce29ac9SDaniel Bristot de Oliveira /*
466bce29ac9SDaniel Bristot de Oliveira  * osnoise_taint - report an osnoise error.
467bce29ac9SDaniel Bristot de Oliveira  */
468bce29ac9SDaniel Bristot de Oliveira #define osnoise_taint(msg) ({							\
469dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;						\
470dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;						\
471bce29ac9SDaniel Bristot de Oliveira 										\
472dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();							\
473dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {		\
474dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;				\
475dae18134SDaniel Bristot de Oliveira 		trace_array_printk_buf(buffer, _THIS_IP_, msg);			\
476dae18134SDaniel Bristot de Oliveira 	}									\
477dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();							\
478bce29ac9SDaniel Bristot de Oliveira 	osnoise_data.tainted = true;						\
479bce29ac9SDaniel Bristot de Oliveira })
480bce29ac9SDaniel Bristot de Oliveira 
481bce29ac9SDaniel Bristot de Oliveira /*
482bce29ac9SDaniel Bristot de Oliveira  * Record an osnoise_sample into the tracer buffer.
483bce29ac9SDaniel Bristot de Oliveira  */
484dae18134SDaniel Bristot de Oliveira static void
485dae18134SDaniel Bristot de Oliveira __trace_osnoise_sample(struct osnoise_sample *sample, struct trace_buffer *buffer)
486bce29ac9SDaniel Bristot de Oliveira {
487bce29ac9SDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
488bce29ac9SDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
489bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_entry *entry;
490bce29ac9SDaniel Bristot de Oliveira 
491bce29ac9SDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_OSNOISE, sizeof(*entry),
492bce29ac9SDaniel Bristot de Oliveira 					  tracing_gen_ctx());
493bce29ac9SDaniel Bristot de Oliveira 	if (!event)
494bce29ac9SDaniel Bristot de Oliveira 		return;
495bce29ac9SDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
496bce29ac9SDaniel Bristot de Oliveira 	entry->runtime		= sample->runtime;
497bce29ac9SDaniel Bristot de Oliveira 	entry->noise		= sample->noise;
498bce29ac9SDaniel Bristot de Oliveira 	entry->max_sample	= sample->max_sample;
499bce29ac9SDaniel Bristot de Oliveira 	entry->hw_count		= sample->hw_count;
500bce29ac9SDaniel Bristot de Oliveira 	entry->nmi_count	= sample->nmi_count;
501bce29ac9SDaniel Bristot de Oliveira 	entry->irq_count	= sample->irq_count;
502bce29ac9SDaniel Bristot de Oliveira 	entry->softirq_count	= sample->softirq_count;
503bce29ac9SDaniel Bristot de Oliveira 	entry->thread_count	= sample->thread_count;
504bce29ac9SDaniel Bristot de Oliveira 
505bce29ac9SDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
506bce29ac9SDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
507bce29ac9SDaniel Bristot de Oliveira }
508bce29ac9SDaniel Bristot de Oliveira 
509dae18134SDaniel Bristot de Oliveira /*
510dae18134SDaniel Bristot de Oliveira  * Record an osnoise_sample on all osnoise instances.
511dae18134SDaniel Bristot de Oliveira  */
512dae18134SDaniel Bristot de Oliveira static void trace_osnoise_sample(struct osnoise_sample *sample)
513dae18134SDaniel Bristot de Oliveira {
514dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
515dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
516dae18134SDaniel Bristot de Oliveira 
517dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
518dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
519dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
520dae18134SDaniel Bristot de Oliveira 		__trace_osnoise_sample(sample, buffer);
521dae18134SDaniel Bristot de Oliveira 	}
522dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
523dae18134SDaniel Bristot de Oliveira }
524dae18134SDaniel Bristot de Oliveira 
525a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
526a955d7eaSDaniel Bristot de Oliveira /*
527a955d7eaSDaniel Bristot de Oliveira  * Print the timerlat header info.
528a955d7eaSDaniel Bristot de Oliveira  */
529e1c4ad4aSDaniel Bristot de Oliveira #ifdef CONFIG_PREEMPT_RT
530e1c4ad4aSDaniel Bristot de Oliveira static void print_timerlat_headers(struct seq_file *s)
531e1c4ad4aSDaniel Bristot de Oliveira {
532e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-------=> irqs-off\n");
533e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _------=> need-resched\n");
534e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _-----=> need-resched-lazy\n");
535e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _----=> hardirq/softirq\n");
536e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _---=> preempt-depth\n");
537e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| / _--=> preempt-lazy-depth\n");
538e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| / _-=> migrate-disable\n");
539e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||| /\n");
540e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||||             ACTIVATION\n");
541e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||||   TIMESTAMP    ID     ");
542e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "       CONTEXT                LATENCY\n");
543e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||||      |         |      ");
544e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "            |                       |\n");
545e1c4ad4aSDaniel Bristot de Oliveira }
546e1c4ad4aSDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
547a955d7eaSDaniel Bristot de Oliveira static void print_timerlat_headers(struct seq_file *s)
548a955d7eaSDaniel Bristot de Oliveira {
549a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
550a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
551a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
552a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth\n");
553aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _-=> migrate-disable\n");
554aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| /     delay\n");
555aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||            ACTIVATION\n");
556aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||   TIMESTAMP   ID      ");
557a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "      CONTEXT                 LATENCY\n");
558aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||      |         |      ");
559a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "            |                       |\n");
560a955d7eaSDaniel Bristot de Oliveira }
561e1c4ad4aSDaniel Bristot de Oliveira #endif /* CONFIG_PREEMPT_RT */
562a955d7eaSDaniel Bristot de Oliveira 
563dae18134SDaniel Bristot de Oliveira static void
564dae18134SDaniel Bristot de Oliveira __trace_timerlat_sample(struct timerlat_sample *sample, struct trace_buffer *buffer)
565a955d7eaSDaniel Bristot de Oliveira {
566a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
567a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
568a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_entry *entry;
569a955d7eaSDaniel Bristot de Oliveira 
570a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_TIMERLAT, sizeof(*entry),
571a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
572a955d7eaSDaniel Bristot de Oliveira 	if (!event)
573a955d7eaSDaniel Bristot de Oliveira 		return;
574a955d7eaSDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
575a955d7eaSDaniel Bristot de Oliveira 	entry->seqnum			= sample->seqnum;
576a955d7eaSDaniel Bristot de Oliveira 	entry->context			= sample->context;
577a955d7eaSDaniel Bristot de Oliveira 	entry->timer_latency		= sample->timer_latency;
578a955d7eaSDaniel Bristot de Oliveira 
579a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
580a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
581a955d7eaSDaniel Bristot de Oliveira }
582a955d7eaSDaniel Bristot de Oliveira 
583dae18134SDaniel Bristot de Oliveira /*
584dae18134SDaniel Bristot de Oliveira  * Record an timerlat_sample into the tracer buffer.
585dae18134SDaniel Bristot de Oliveira  */
586dae18134SDaniel Bristot de Oliveira static void trace_timerlat_sample(struct timerlat_sample *sample)
587dae18134SDaniel Bristot de Oliveira {
588dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
589dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
590dae18134SDaniel Bristot de Oliveira 
591dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
592dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
593dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
594dae18134SDaniel Bristot de Oliveira 		__trace_timerlat_sample(sample, buffer);
595dae18134SDaniel Bristot de Oliveira 	}
596dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
597dae18134SDaniel Bristot de Oliveira }
598dae18134SDaniel Bristot de Oliveira 
599a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
600a955d7eaSDaniel Bristot de Oliveira 
601a955d7eaSDaniel Bristot de Oliveira #define	MAX_CALLS	256
602a955d7eaSDaniel Bristot de Oliveira 
603a955d7eaSDaniel Bristot de Oliveira /*
604a955d7eaSDaniel Bristot de Oliveira  * Stack trace will take place only at IRQ level, so, no need
605a955d7eaSDaniel Bristot de Oliveira  * to control nesting here.
606a955d7eaSDaniel Bristot de Oliveira  */
607a955d7eaSDaniel Bristot de Oliveira struct trace_stack {
608a955d7eaSDaniel Bristot de Oliveira 	int		stack_size;
609a955d7eaSDaniel Bristot de Oliveira 	int		nr_entries;
610a955d7eaSDaniel Bristot de Oliveira 	unsigned long	calls[MAX_CALLS];
611a955d7eaSDaniel Bristot de Oliveira };
612a955d7eaSDaniel Bristot de Oliveira 
613a955d7eaSDaniel Bristot de Oliveira static DEFINE_PER_CPU(struct trace_stack, trace_stack);
614a955d7eaSDaniel Bristot de Oliveira 
615a955d7eaSDaniel Bristot de Oliveira /*
616a955d7eaSDaniel Bristot de Oliveira  * timerlat_save_stack - save a stack trace without printing
617a955d7eaSDaniel Bristot de Oliveira  *
618a955d7eaSDaniel Bristot de Oliveira  * Save the current stack trace without printing. The
619a955d7eaSDaniel Bristot de Oliveira  * stack will be printed later, after the end of the measurement.
620a955d7eaSDaniel Bristot de Oliveira  */
621a955d7eaSDaniel Bristot de Oliveira static void timerlat_save_stack(int skip)
622a955d7eaSDaniel Bristot de Oliveira {
623a955d7eaSDaniel Bristot de Oliveira 	unsigned int size, nr_entries;
624a955d7eaSDaniel Bristot de Oliveira 	struct trace_stack *fstack;
625a955d7eaSDaniel Bristot de Oliveira 
626a955d7eaSDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
627a955d7eaSDaniel Bristot de Oliveira 
628a955d7eaSDaniel Bristot de Oliveira 	size = ARRAY_SIZE(fstack->calls);
629a955d7eaSDaniel Bristot de Oliveira 
630a955d7eaSDaniel Bristot de Oliveira 	nr_entries = stack_trace_save(fstack->calls, size, skip);
631a955d7eaSDaniel Bristot de Oliveira 
632a955d7eaSDaniel Bristot de Oliveira 	fstack->stack_size = nr_entries * sizeof(unsigned long);
633a955d7eaSDaniel Bristot de Oliveira 	fstack->nr_entries = nr_entries;
634a955d7eaSDaniel Bristot de Oliveira 
635a955d7eaSDaniel Bristot de Oliveira 	return;
636a955d7eaSDaniel Bristot de Oliveira 
637a955d7eaSDaniel Bristot de Oliveira }
638dae18134SDaniel Bristot de Oliveira 
639dae18134SDaniel Bristot de Oliveira static void
640dae18134SDaniel Bristot de Oliveira __timerlat_dump_stack(struct trace_buffer *buffer, struct trace_stack *fstack, unsigned int size)
641a955d7eaSDaniel Bristot de Oliveira {
642a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
643a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
644a955d7eaSDaniel Bristot de Oliveira 	struct stack_entry *entry;
645a955d7eaSDaniel Bristot de Oliveira 
646a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_STACK, sizeof(*entry) + size,
647a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
648a955d7eaSDaniel Bristot de Oliveira 	if (!event)
649dae18134SDaniel Bristot de Oliveira 		return;
650a955d7eaSDaniel Bristot de Oliveira 
651a955d7eaSDaniel Bristot de Oliveira 	entry = ring_buffer_event_data(event);
652a955d7eaSDaniel Bristot de Oliveira 
653a955d7eaSDaniel Bristot de Oliveira 	memcpy(&entry->caller, fstack->calls, size);
654a955d7eaSDaniel Bristot de Oliveira 	entry->size = fstack->nr_entries;
655a955d7eaSDaniel Bristot de Oliveira 
656a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
657a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
658dae18134SDaniel Bristot de Oliveira }
659a955d7eaSDaniel Bristot de Oliveira 
660dae18134SDaniel Bristot de Oliveira /*
661dae18134SDaniel Bristot de Oliveira  * timerlat_dump_stack - dump a stack trace previously saved
662dae18134SDaniel Bristot de Oliveira  */
663b14f4568SDaniel Bristot de Oliveira static void timerlat_dump_stack(u64 latency)
664dae18134SDaniel Bristot de Oliveira {
665dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
666dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
667dae18134SDaniel Bristot de Oliveira 	struct trace_stack *fstack;
668dae18134SDaniel Bristot de Oliveira 	unsigned int size;
669dae18134SDaniel Bristot de Oliveira 
670b14f4568SDaniel Bristot de Oliveira 	/*
671b14f4568SDaniel Bristot de Oliveira 	 * trace only if latency > print_stack config, if enabled.
672b14f4568SDaniel Bristot de Oliveira 	 */
673b14f4568SDaniel Bristot de Oliveira 	if (!osnoise_data.print_stack || osnoise_data.print_stack > latency)
674b14f4568SDaniel Bristot de Oliveira 		return;
675b14f4568SDaniel Bristot de Oliveira 
676dae18134SDaniel Bristot de Oliveira 	preempt_disable_notrace();
677dae18134SDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
678dae18134SDaniel Bristot de Oliveira 	size = fstack->stack_size;
679dae18134SDaniel Bristot de Oliveira 
680dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
681dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
682dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
683dae18134SDaniel Bristot de Oliveira 		__timerlat_dump_stack(buffer, fstack, size);
684dae18134SDaniel Bristot de Oliveira 
685dae18134SDaniel Bristot de Oliveira 	}
686dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
687a955d7eaSDaniel Bristot de Oliveira 	preempt_enable_notrace();
688a955d7eaSDaniel Bristot de Oliveira }
689b14f4568SDaniel Bristot de Oliveira #else /* CONFIG_STACKTRACE */
690b14f4568SDaniel Bristot de Oliveira #define timerlat_dump_stack(u64 latency) do {} while (0)
691a955d7eaSDaniel Bristot de Oliveira #define timerlat_save_stack(a) do {} while (0)
692a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
693a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
694a955d7eaSDaniel Bristot de Oliveira 
695bce29ac9SDaniel Bristot de Oliveira /*
696bce29ac9SDaniel Bristot de Oliveira  * Macros to encapsulate the time capturing infrastructure.
697bce29ac9SDaniel Bristot de Oliveira  */
698bce29ac9SDaniel Bristot de Oliveira #define time_get()	trace_clock_local()
699bce29ac9SDaniel Bristot de Oliveira #define time_to_us(x)	div_u64(x, 1000)
700bce29ac9SDaniel Bristot de Oliveira #define time_sub(a, b)	((a) - (b))
701bce29ac9SDaniel Bristot de Oliveira 
702bce29ac9SDaniel Bristot de Oliveira /*
703bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start - Forward the delta_start of a running IRQ
704bce29ac9SDaniel Bristot de Oliveira  *
705bce29ac9SDaniel Bristot de Oliveira  * If an IRQ is preempted by an NMI, its delta_start is pushed forward
706bce29ac9SDaniel Bristot de Oliveira  * to discount the NMI interference.
707bce29ac9SDaniel Bristot de Oliveira  *
708bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
709bce29ac9SDaniel Bristot de Oliveira  */
710bce29ac9SDaniel Bristot de Oliveira static inline void
711bce29ac9SDaniel Bristot de Oliveira cond_move_irq_delta_start(struct osnoise_variables *osn_var, u64 duration)
712bce29ac9SDaniel Bristot de Oliveira {
713bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->irq.delta_start)
714bce29ac9SDaniel Bristot de Oliveira 		osn_var->irq.delta_start += duration;
715bce29ac9SDaniel Bristot de Oliveira }
716bce29ac9SDaniel Bristot de Oliveira 
717bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
718bce29ac9SDaniel Bristot de Oliveira /*
719bce29ac9SDaniel Bristot de Oliveira  * cond_move_softirq_delta_start - Forward the delta_start of a running softirq.
720bce29ac9SDaniel Bristot de Oliveira  *
721bce29ac9SDaniel Bristot de Oliveira  * If a softirq is preempted by an IRQ or NMI, its delta_start is pushed
722bce29ac9SDaniel Bristot de Oliveira  * forward to discount the interference.
723bce29ac9SDaniel Bristot de Oliveira  *
724bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
725bce29ac9SDaniel Bristot de Oliveira  */
726bce29ac9SDaniel Bristot de Oliveira static inline void
727bce29ac9SDaniel Bristot de Oliveira cond_move_softirq_delta_start(struct osnoise_variables *osn_var, u64 duration)
728bce29ac9SDaniel Bristot de Oliveira {
729bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->softirq.delta_start)
730bce29ac9SDaniel Bristot de Oliveira 		osn_var->softirq.delta_start += duration;
731bce29ac9SDaniel Bristot de Oliveira }
732bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
733bce29ac9SDaniel Bristot de Oliveira #define cond_move_softirq_delta_start(osn_var, duration) do {} while (0)
734bce29ac9SDaniel Bristot de Oliveira #endif
735bce29ac9SDaniel Bristot de Oliveira 
736bce29ac9SDaniel Bristot de Oliveira /*
737bce29ac9SDaniel Bristot de Oliveira  * cond_move_thread_delta_start - Forward the delta_start of a running thread
738bce29ac9SDaniel Bristot de Oliveira  *
739bce29ac9SDaniel Bristot de Oliveira  * If a noisy thread is preempted by an softirq, IRQ or NMI, its delta_start
740bce29ac9SDaniel Bristot de Oliveira  * is pushed forward to discount the interference.
741bce29ac9SDaniel Bristot de Oliveira  *
742bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
743bce29ac9SDaniel Bristot de Oliveira  */
744bce29ac9SDaniel Bristot de Oliveira static inline void
745bce29ac9SDaniel Bristot de Oliveira cond_move_thread_delta_start(struct osnoise_variables *osn_var, u64 duration)
746bce29ac9SDaniel Bristot de Oliveira {
747bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->thread.delta_start)
748bce29ac9SDaniel Bristot de Oliveira 		osn_var->thread.delta_start += duration;
749bce29ac9SDaniel Bristot de Oliveira }
750bce29ac9SDaniel Bristot de Oliveira 
751bce29ac9SDaniel Bristot de Oliveira /*
752bce29ac9SDaniel Bristot de Oliveira  * get_int_safe_duration - Get the duration of a window
753bce29ac9SDaniel Bristot de Oliveira  *
754bce29ac9SDaniel Bristot de Oliveira  * The irq, softirq and thread varaibles need to have its duration without
755bce29ac9SDaniel Bristot de Oliveira  * the interference from higher priority interrupts. Instead of keeping a
756bce29ac9SDaniel Bristot de Oliveira  * variable to discount the interrupt interference from these variables, the
757bce29ac9SDaniel Bristot de Oliveira  * starting time of these variables are pushed forward with the interrupt's
758bce29ac9SDaniel Bristot de Oliveira  * duration. In this way, a single variable is used to:
759bce29ac9SDaniel Bristot de Oliveira  *
760bce29ac9SDaniel Bristot de Oliveira  *   - Know if a given window is being measured.
761bce29ac9SDaniel Bristot de Oliveira  *   - Account its duration.
762bce29ac9SDaniel Bristot de Oliveira  *   - Discount the interference.
763bce29ac9SDaniel Bristot de Oliveira  *
764bce29ac9SDaniel Bristot de Oliveira  * To avoid getting inconsistent values, e.g.,:
765bce29ac9SDaniel Bristot de Oliveira  *
766bce29ac9SDaniel Bristot de Oliveira  *	now = time_get()
767bce29ac9SDaniel Bristot de Oliveira  *		--->	interrupt!
768bce29ac9SDaniel Bristot de Oliveira  *			delta_start -= int duration;
769bce29ac9SDaniel Bristot de Oliveira  *		<---
770bce29ac9SDaniel Bristot de Oliveira  *	duration = now - delta_start;
771bce29ac9SDaniel Bristot de Oliveira  *
772bce29ac9SDaniel Bristot de Oliveira  *	result: negative duration if the variable duration before the
773bce29ac9SDaniel Bristot de Oliveira  *	interrupt was smaller than the interrupt execution.
774bce29ac9SDaniel Bristot de Oliveira  *
775bce29ac9SDaniel Bristot de Oliveira  * A counter of interrupts is used. If the counter increased, try
776bce29ac9SDaniel Bristot de Oliveira  * to capture an interference safe duration.
777bce29ac9SDaniel Bristot de Oliveira  */
778bce29ac9SDaniel Bristot de Oliveira static inline s64
779bce29ac9SDaniel Bristot de Oliveira get_int_safe_duration(struct osnoise_variables *osn_var, u64 *delta_start)
780bce29ac9SDaniel Bristot de Oliveira {
781bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter, now;
782bce29ac9SDaniel Bristot de Oliveira 	s64 duration;
783bce29ac9SDaniel Bristot de Oliveira 
784bce29ac9SDaniel Bristot de Oliveira 	do {
785bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
786bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
787bce29ac9SDaniel Bristot de Oliveira 		barrier();
788bce29ac9SDaniel Bristot de Oliveira 
789bce29ac9SDaniel Bristot de Oliveira 		now = time_get();
790bce29ac9SDaniel Bristot de Oliveira 		duration = (now - *delta_start);
791bce29ac9SDaniel Bristot de Oliveira 
792bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
793bce29ac9SDaniel Bristot de Oliveira 		barrier();
794bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
795bce29ac9SDaniel Bristot de Oliveira 
796bce29ac9SDaniel Bristot de Oliveira 	/*
797bce29ac9SDaniel Bristot de Oliveira 	 * This is an evidence of race conditions that cause
798bce29ac9SDaniel Bristot de Oliveira 	 * a value to be "discounted" too much.
799bce29ac9SDaniel Bristot de Oliveira 	 */
800bce29ac9SDaniel Bristot de Oliveira 	if (duration < 0)
801bce29ac9SDaniel Bristot de Oliveira 		osnoise_taint("Negative duration!\n");
802bce29ac9SDaniel Bristot de Oliveira 
803bce29ac9SDaniel Bristot de Oliveira 	*delta_start = 0;
804bce29ac9SDaniel Bristot de Oliveira 
805bce29ac9SDaniel Bristot de Oliveira 	return duration;
806bce29ac9SDaniel Bristot de Oliveira }
807bce29ac9SDaniel Bristot de Oliveira 
808bce29ac9SDaniel Bristot de Oliveira /*
809bce29ac9SDaniel Bristot de Oliveira  *
810bce29ac9SDaniel Bristot de Oliveira  * set_int_safe_time - Save the current time on *time, aware of interference
811bce29ac9SDaniel Bristot de Oliveira  *
812bce29ac9SDaniel Bristot de Oliveira  * Get the time, taking into consideration a possible interference from
813bce29ac9SDaniel Bristot de Oliveira  * higher priority interrupts.
814bce29ac9SDaniel Bristot de Oliveira  *
815bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration() for an explanation.
816bce29ac9SDaniel Bristot de Oliveira  */
817bce29ac9SDaniel Bristot de Oliveira static u64
818bce29ac9SDaniel Bristot de Oliveira set_int_safe_time(struct osnoise_variables *osn_var, u64 *time)
819bce29ac9SDaniel Bristot de Oliveira {
820bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter;
821bce29ac9SDaniel Bristot de Oliveira 
822bce29ac9SDaniel Bristot de Oliveira 	do {
823bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
824bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
825bce29ac9SDaniel Bristot de Oliveira 		barrier();
826bce29ac9SDaniel Bristot de Oliveira 
827bce29ac9SDaniel Bristot de Oliveira 		*time = time_get();
828bce29ac9SDaniel Bristot de Oliveira 
829bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
830bce29ac9SDaniel Bristot de Oliveira 		barrier();
831bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
832bce29ac9SDaniel Bristot de Oliveira 
833bce29ac9SDaniel Bristot de Oliveira 	return int_counter;
834bce29ac9SDaniel Bristot de Oliveira }
835bce29ac9SDaniel Bristot de Oliveira 
836a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
837a955d7eaSDaniel Bristot de Oliveira /*
838a955d7eaSDaniel Bristot de Oliveira  * copy_int_safe_time - Copy *src into *desc aware of interference
839a955d7eaSDaniel Bristot de Oliveira  */
840a955d7eaSDaniel Bristot de Oliveira static u64
841a955d7eaSDaniel Bristot de Oliveira copy_int_safe_time(struct osnoise_variables *osn_var, u64 *dst, u64 *src)
842a955d7eaSDaniel Bristot de Oliveira {
843a955d7eaSDaniel Bristot de Oliveira 	u64 int_counter;
844a955d7eaSDaniel Bristot de Oliveira 
845a955d7eaSDaniel Bristot de Oliveira 	do {
846a955d7eaSDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
847a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
848a955d7eaSDaniel Bristot de Oliveira 		barrier();
849a955d7eaSDaniel Bristot de Oliveira 
850a955d7eaSDaniel Bristot de Oliveira 		*dst = *src;
851a955d7eaSDaniel Bristot de Oliveira 
852a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
853a955d7eaSDaniel Bristot de Oliveira 		barrier();
854a955d7eaSDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
855a955d7eaSDaniel Bristot de Oliveira 
856a955d7eaSDaniel Bristot de Oliveira 	return int_counter;
857a955d7eaSDaniel Bristot de Oliveira }
858a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
859a955d7eaSDaniel Bristot de Oliveira 
860bce29ac9SDaniel Bristot de Oliveira /*
861bce29ac9SDaniel Bristot de Oliveira  * trace_osnoise_callback - NMI entry/exit callback
862bce29ac9SDaniel Bristot de Oliveira  *
863bce29ac9SDaniel Bristot de Oliveira  * This function is called at the entry and exit NMI code. The bool enter
864bce29ac9SDaniel Bristot de Oliveira  * distinguishes between either case. This function is used to note a NMI
865bce29ac9SDaniel Bristot de Oliveira  * occurrence, compute the noise caused by the NMI, and to remove the noise
866bce29ac9SDaniel Bristot de Oliveira  * it is potentially causing on other interference variables.
867bce29ac9SDaniel Bristot de Oliveira  */
868bce29ac9SDaniel Bristot de Oliveira void trace_osnoise_callback(bool enter)
869bce29ac9SDaniel Bristot de Oliveira {
870bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
871bce29ac9SDaniel Bristot de Oliveira 	u64 duration;
872bce29ac9SDaniel Bristot de Oliveira 
873bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
874bce29ac9SDaniel Bristot de Oliveira 		return;
875bce29ac9SDaniel Bristot de Oliveira 
876bce29ac9SDaniel Bristot de Oliveira 	/*
877bce29ac9SDaniel Bristot de Oliveira 	 * Currently trace_clock_local() calls sched_clock() and the
878bce29ac9SDaniel Bristot de Oliveira 	 * generic version is not NMI safe.
879bce29ac9SDaniel Bristot de Oliveira 	 */
880bce29ac9SDaniel Bristot de Oliveira 	if (!IS_ENABLED(CONFIG_GENERIC_SCHED_CLOCK)) {
881bce29ac9SDaniel Bristot de Oliveira 		if (enter) {
882bce29ac9SDaniel Bristot de Oliveira 			osn_var->nmi.delta_start = time_get();
883bce29ac9SDaniel Bristot de Oliveira 			local_inc(&osn_var->int_counter);
884bce29ac9SDaniel Bristot de Oliveira 		} else {
885bce29ac9SDaniel Bristot de Oliveira 			duration = time_get() - osn_var->nmi.delta_start;
886bce29ac9SDaniel Bristot de Oliveira 
887bce29ac9SDaniel Bristot de Oliveira 			trace_nmi_noise(osn_var->nmi.delta_start, duration);
888bce29ac9SDaniel Bristot de Oliveira 
889bce29ac9SDaniel Bristot de Oliveira 			cond_move_irq_delta_start(osn_var, duration);
890bce29ac9SDaniel Bristot de Oliveira 			cond_move_softirq_delta_start(osn_var, duration);
891bce29ac9SDaniel Bristot de Oliveira 			cond_move_thread_delta_start(osn_var, duration);
892bce29ac9SDaniel Bristot de Oliveira 		}
893bce29ac9SDaniel Bristot de Oliveira 	}
894bce29ac9SDaniel Bristot de Oliveira 
895bce29ac9SDaniel Bristot de Oliveira 	if (enter)
896bce29ac9SDaniel Bristot de Oliveira 		osn_var->nmi.count++;
897bce29ac9SDaniel Bristot de Oliveira }
898bce29ac9SDaniel Bristot de Oliveira 
899bce29ac9SDaniel Bristot de Oliveira /*
900bce29ac9SDaniel Bristot de Oliveira  * osnoise_trace_irq_entry - Note the starting of an IRQ
901bce29ac9SDaniel Bristot de Oliveira  *
902bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of an IRQ. As IRQs are non-preemptive to other IRQs,
903bce29ac9SDaniel Bristot de Oliveira  * it is safe to use a single variable (ons_var->irq) to save the statistics.
904bce29ac9SDaniel Bristot de Oliveira  * The arrival_time is used to report... the arrival time. The delta_start
905bce29ac9SDaniel Bristot de Oliveira  * is used to compute the duration at the IRQ exit handler. See
906bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start().
907bce29ac9SDaniel Bristot de Oliveira  */
908bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_entry(int id)
909bce29ac9SDaniel Bristot de Oliveira {
910bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
911bce29ac9SDaniel Bristot de Oliveira 
912bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
913bce29ac9SDaniel Bristot de Oliveira 		return;
914bce29ac9SDaniel Bristot de Oliveira 	/*
915bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
916bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
917bce29ac9SDaniel Bristot de Oliveira 	 */
918bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = time_get();
919bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->irq.delta_start);
920bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.count++;
921bce29ac9SDaniel Bristot de Oliveira 
922bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
923bce29ac9SDaniel Bristot de Oliveira }
924bce29ac9SDaniel Bristot de Oliveira 
925bce29ac9SDaniel Bristot de Oliveira /*
926bce29ac9SDaniel Bristot de Oliveira  * osnoise_irq_exit - Note the end of an IRQ, sava data and trace
927bce29ac9SDaniel Bristot de Oliveira  *
928bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the IRQ noise, and trace it. Also discounts the
929bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
930bce29ac9SDaniel Bristot de Oliveira  */
931bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_exit(int id, const char *desc)
932bce29ac9SDaniel Bristot de Oliveira {
933bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
934022632f6SDaniel Bristot de Oliveira 	s64 duration;
935bce29ac9SDaniel Bristot de Oliveira 
936bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
937bce29ac9SDaniel Bristot de Oliveira 		return;
938bce29ac9SDaniel Bristot de Oliveira 
939bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->irq.delta_start);
940bce29ac9SDaniel Bristot de Oliveira 	trace_irq_noise(id, desc, osn_var->irq.arrival_time, duration);
941bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = 0;
942bce29ac9SDaniel Bristot de Oliveira 	cond_move_softirq_delta_start(osn_var, duration);
943bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
944bce29ac9SDaniel Bristot de Oliveira }
945bce29ac9SDaniel Bristot de Oliveira 
946bce29ac9SDaniel Bristot de Oliveira /*
947bce29ac9SDaniel Bristot de Oliveira  * trace_irqentry_callback - Callback to the irq:irq_entry traceevent
948bce29ac9SDaniel Bristot de Oliveira  *
949bce29ac9SDaniel Bristot de Oliveira  * Used to note the starting of an IRQ occurece.
950bce29ac9SDaniel Bristot de Oliveira  */
951bce29ac9SDaniel Bristot de Oliveira static void trace_irqentry_callback(void *data, int irq,
952bce29ac9SDaniel Bristot de Oliveira 				    struct irqaction *action)
953bce29ac9SDaniel Bristot de Oliveira {
954bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_entry(irq);
955bce29ac9SDaniel Bristot de Oliveira }
956bce29ac9SDaniel Bristot de Oliveira 
957bce29ac9SDaniel Bristot de Oliveira /*
958bce29ac9SDaniel Bristot de Oliveira  * trace_irqexit_callback - Callback to the irq:irq_exit traceevent
959bce29ac9SDaniel Bristot de Oliveira  *
960bce29ac9SDaniel Bristot de Oliveira  * Used to note the end of an IRQ occurece.
961bce29ac9SDaniel Bristot de Oliveira  */
962bce29ac9SDaniel Bristot de Oliveira static void trace_irqexit_callback(void *data, int irq,
963bce29ac9SDaniel Bristot de Oliveira 				   struct irqaction *action, int ret)
964bce29ac9SDaniel Bristot de Oliveira {
965bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_exit(irq, action->name);
966bce29ac9SDaniel Bristot de Oliveira }
967bce29ac9SDaniel Bristot de Oliveira 
968bce29ac9SDaniel Bristot de Oliveira /*
969bce29ac9SDaniel Bristot de Oliveira  * arch specific register function.
970bce29ac9SDaniel Bristot de Oliveira  */
971bce29ac9SDaniel Bristot de Oliveira int __weak osnoise_arch_register(void)
972bce29ac9SDaniel Bristot de Oliveira {
973bce29ac9SDaniel Bristot de Oliveira 	return 0;
974bce29ac9SDaniel Bristot de Oliveira }
975bce29ac9SDaniel Bristot de Oliveira 
976bce29ac9SDaniel Bristot de Oliveira /*
977bce29ac9SDaniel Bristot de Oliveira  * arch specific unregister function.
978bce29ac9SDaniel Bristot de Oliveira  */
979bce29ac9SDaniel Bristot de Oliveira void __weak osnoise_arch_unregister(void)
980bce29ac9SDaniel Bristot de Oliveira {
981bce29ac9SDaniel Bristot de Oliveira 	return;
982bce29ac9SDaniel Bristot de Oliveira }
983bce29ac9SDaniel Bristot de Oliveira 
984bce29ac9SDaniel Bristot de Oliveira /*
985bce29ac9SDaniel Bristot de Oliveira  * hook_irq_events - Hook IRQ handling events
986bce29ac9SDaniel Bristot de Oliveira  *
987bce29ac9SDaniel Bristot de Oliveira  * This function hooks the IRQ related callbacks to the respective trace
988bce29ac9SDaniel Bristot de Oliveira  * events.
989bce29ac9SDaniel Bristot de Oliveira  */
990f7d9f637SDaniel Bristot de Oliveira static int hook_irq_events(void)
991bce29ac9SDaniel Bristot de Oliveira {
992bce29ac9SDaniel Bristot de Oliveira 	int ret;
993bce29ac9SDaniel Bristot de Oliveira 
994bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_entry(trace_irqentry_callback, NULL);
995bce29ac9SDaniel Bristot de Oliveira 	if (ret)
996bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
997bce29ac9SDaniel Bristot de Oliveira 
998bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_exit(trace_irqexit_callback, NULL);
999bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1000bce29ac9SDaniel Bristot de Oliveira 		goto out_unregister_entry;
1001bce29ac9SDaniel Bristot de Oliveira 
1002bce29ac9SDaniel Bristot de Oliveira 	ret = osnoise_arch_register();
1003bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1004bce29ac9SDaniel Bristot de Oliveira 		goto out_irq_exit;
1005bce29ac9SDaniel Bristot de Oliveira 
1006bce29ac9SDaniel Bristot de Oliveira 	return 0;
1007bce29ac9SDaniel Bristot de Oliveira 
1008bce29ac9SDaniel Bristot de Oliveira out_irq_exit:
1009bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
1010bce29ac9SDaniel Bristot de Oliveira out_unregister_entry:
1011bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
1012bce29ac9SDaniel Bristot de Oliveira out_err:
1013bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
1014bce29ac9SDaniel Bristot de Oliveira }
1015bce29ac9SDaniel Bristot de Oliveira 
1016bce29ac9SDaniel Bristot de Oliveira /*
1017bce29ac9SDaniel Bristot de Oliveira  * unhook_irq_events - Unhook IRQ handling events
1018bce29ac9SDaniel Bristot de Oliveira  *
1019bce29ac9SDaniel Bristot de Oliveira  * This function unhooks the IRQ related callbacks to the respective trace
1020bce29ac9SDaniel Bristot de Oliveira  * events.
1021bce29ac9SDaniel Bristot de Oliveira  */
1022f7d9f637SDaniel Bristot de Oliveira static void unhook_irq_events(void)
1023bce29ac9SDaniel Bristot de Oliveira {
1024bce29ac9SDaniel Bristot de Oliveira 	osnoise_arch_unregister();
1025bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
1026bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
1027bce29ac9SDaniel Bristot de Oliveira }
1028bce29ac9SDaniel Bristot de Oliveira 
1029bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
1030bce29ac9SDaniel Bristot de Oliveira /*
1031bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_entry_callback - Note the starting of a softirq
1032bce29ac9SDaniel Bristot de Oliveira  *
1033bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of a softirq. As softirqs are non-preemptive to
1034bce29ac9SDaniel Bristot de Oliveira  * other softirqs, it is safe to use a single variable (ons_var->softirq)
1035bce29ac9SDaniel Bristot de Oliveira  * to save the statistics. The arrival_time is used to report... the
1036bce29ac9SDaniel Bristot de Oliveira  * arrival time. The delta_start is used to compute the duration at the
1037bce29ac9SDaniel Bristot de Oliveira  * softirq exit handler. See cond_move_softirq_delta_start().
1038bce29ac9SDaniel Bristot de Oliveira  */
1039f7d9f637SDaniel Bristot de Oliveira static void trace_softirq_entry_callback(void *data, unsigned int vec_nr)
1040bce29ac9SDaniel Bristot de Oliveira {
1041bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1042bce29ac9SDaniel Bristot de Oliveira 
1043bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1044bce29ac9SDaniel Bristot de Oliveira 		return;
1045bce29ac9SDaniel Bristot de Oliveira 	/*
1046bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
1047bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
1048bce29ac9SDaniel Bristot de Oliveira 	 */
1049bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = time_get();
1050bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->softirq.delta_start);
1051bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.count++;
1052bce29ac9SDaniel Bristot de Oliveira 
1053bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
1054bce29ac9SDaniel Bristot de Oliveira }
1055bce29ac9SDaniel Bristot de Oliveira 
1056bce29ac9SDaniel Bristot de Oliveira /*
1057bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_exit_callback - Note the end of an softirq
1058bce29ac9SDaniel Bristot de Oliveira  *
1059bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the softirq noise, and trace it. Also discounts the
1060bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
1061bce29ac9SDaniel Bristot de Oliveira  */
1062f7d9f637SDaniel Bristot de Oliveira static void trace_softirq_exit_callback(void *data, unsigned int vec_nr)
1063bce29ac9SDaniel Bristot de Oliveira {
1064bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1065022632f6SDaniel Bristot de Oliveira 	s64 duration;
1066bce29ac9SDaniel Bristot de Oliveira 
1067bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1068bce29ac9SDaniel Bristot de Oliveira 		return;
1069bce29ac9SDaniel Bristot de Oliveira 
1070ccb67544SDaniel Bristot de Oliveira 	if (unlikely(timerlat_enabled()))
1071ccb67544SDaniel Bristot de Oliveira 		if (!timerlat_softirq_exit(osn_var))
1072a955d7eaSDaniel Bristot de Oliveira 			return;
1073a955d7eaSDaniel Bristot de Oliveira 
1074bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->softirq.delta_start);
1075bce29ac9SDaniel Bristot de Oliveira 	trace_softirq_noise(vec_nr, osn_var->softirq.arrival_time, duration);
1076bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
1077bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = 0;
1078bce29ac9SDaniel Bristot de Oliveira }
1079bce29ac9SDaniel Bristot de Oliveira 
1080bce29ac9SDaniel Bristot de Oliveira /*
1081bce29ac9SDaniel Bristot de Oliveira  * hook_softirq_events - Hook softirq handling events
1082bce29ac9SDaniel Bristot de Oliveira  *
1083bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
1084bce29ac9SDaniel Bristot de Oliveira  * events.
1085bce29ac9SDaniel Bristot de Oliveira  */
1086bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
1087bce29ac9SDaniel Bristot de Oliveira {
1088bce29ac9SDaniel Bristot de Oliveira 	int ret;
1089bce29ac9SDaniel Bristot de Oliveira 
1090bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1091bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1092bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
1093bce29ac9SDaniel Bristot de Oliveira 
1094bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_exit(trace_softirq_exit_callback, NULL);
1095bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1096bce29ac9SDaniel Bristot de Oliveira 		goto out_unreg_entry;
1097bce29ac9SDaniel Bristot de Oliveira 
1098bce29ac9SDaniel Bristot de Oliveira 	return 0;
1099bce29ac9SDaniel Bristot de Oliveira 
1100bce29ac9SDaniel Bristot de Oliveira out_unreg_entry:
1101bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1102bce29ac9SDaniel Bristot de Oliveira out_err:
1103bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
1104bce29ac9SDaniel Bristot de Oliveira }
1105bce29ac9SDaniel Bristot de Oliveira 
1106bce29ac9SDaniel Bristot de Oliveira /*
1107bce29ac9SDaniel Bristot de Oliveira  * unhook_softirq_events - Unhook softirq handling events
1108bce29ac9SDaniel Bristot de Oliveira  *
1109bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
1110bce29ac9SDaniel Bristot de Oliveira  * events.
1111bce29ac9SDaniel Bristot de Oliveira  */
1112bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
1113bce29ac9SDaniel Bristot de Oliveira {
1114bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1115bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_exit(trace_softirq_exit_callback, NULL);
1116bce29ac9SDaniel Bristot de Oliveira }
1117bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
1118bce29ac9SDaniel Bristot de Oliveira /*
1119bce29ac9SDaniel Bristot de Oliveira  * softirq are threads on the PREEMPT_RT mode.
1120bce29ac9SDaniel Bristot de Oliveira  */
1121bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
1122bce29ac9SDaniel Bristot de Oliveira {
1123bce29ac9SDaniel Bristot de Oliveira 	return 0;
1124bce29ac9SDaniel Bristot de Oliveira }
1125bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
1126bce29ac9SDaniel Bristot de Oliveira {
1127bce29ac9SDaniel Bristot de Oliveira }
1128bce29ac9SDaniel Bristot de Oliveira #endif
1129bce29ac9SDaniel Bristot de Oliveira 
1130bce29ac9SDaniel Bristot de Oliveira /*
1131bce29ac9SDaniel Bristot de Oliveira  * thread_entry - Record the starting of a thread noise window
1132bce29ac9SDaniel Bristot de Oliveira  *
1133bce29ac9SDaniel Bristot de Oliveira  * It saves the context switch time for a noisy thread, and increments
1134bce29ac9SDaniel Bristot de Oliveira  * the interference counters.
1135bce29ac9SDaniel Bristot de Oliveira  */
1136bce29ac9SDaniel Bristot de Oliveira static void
1137bce29ac9SDaniel Bristot de Oliveira thread_entry(struct osnoise_variables *osn_var, struct task_struct *t)
1138bce29ac9SDaniel Bristot de Oliveira {
1139bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1140bce29ac9SDaniel Bristot de Oliveira 		return;
1141bce29ac9SDaniel Bristot de Oliveira 	/*
1142bce29ac9SDaniel Bristot de Oliveira 	 * The arrival time will be used in the report, but not to compute
1143bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
1144bce29ac9SDaniel Bristot de Oliveira 	 */
1145bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
1146bce29ac9SDaniel Bristot de Oliveira 
1147bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->thread.delta_start);
1148bce29ac9SDaniel Bristot de Oliveira 
1149bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.count++;
1150bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
1151bce29ac9SDaniel Bristot de Oliveira }
1152bce29ac9SDaniel Bristot de Oliveira 
1153bce29ac9SDaniel Bristot de Oliveira /*
1154bce29ac9SDaniel Bristot de Oliveira  * thread_exit - Report the end of a thread noise window
1155bce29ac9SDaniel Bristot de Oliveira  *
1156bce29ac9SDaniel Bristot de Oliveira  * It computes the total noise from a thread, tracing if needed.
1157bce29ac9SDaniel Bristot de Oliveira  */
1158bce29ac9SDaniel Bristot de Oliveira static void
1159bce29ac9SDaniel Bristot de Oliveira thread_exit(struct osnoise_variables *osn_var, struct task_struct *t)
1160bce29ac9SDaniel Bristot de Oliveira {
1161022632f6SDaniel Bristot de Oliveira 	s64 duration;
1162bce29ac9SDaniel Bristot de Oliveira 
1163bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1164bce29ac9SDaniel Bristot de Oliveira 		return;
1165bce29ac9SDaniel Bristot de Oliveira 
1166ccb67544SDaniel Bristot de Oliveira 	if (unlikely(timerlat_enabled()))
1167ccb67544SDaniel Bristot de Oliveira 		if (!timerlat_thread_exit(osn_var))
1168a955d7eaSDaniel Bristot de Oliveira 			return;
1169a955d7eaSDaniel Bristot de Oliveira 
1170bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->thread.delta_start);
1171bce29ac9SDaniel Bristot de Oliveira 
1172bce29ac9SDaniel Bristot de Oliveira 	trace_thread_noise(t, osn_var->thread.arrival_time, duration);
1173bce29ac9SDaniel Bristot de Oliveira 
1174bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = 0;
1175bce29ac9SDaniel Bristot de Oliveira }
1176bce29ac9SDaniel Bristot de Oliveira 
1177bce29ac9SDaniel Bristot de Oliveira /*
1178bce29ac9SDaniel Bristot de Oliveira  * trace_sched_switch - sched:sched_switch trace event handler
1179bce29ac9SDaniel Bristot de Oliveira  *
1180bce29ac9SDaniel Bristot de Oliveira  * This function is hooked to the sched:sched_switch trace event, and it is
1181bce29ac9SDaniel Bristot de Oliveira  * used to record the beginning and to report the end of a thread noise window.
1182bce29ac9SDaniel Bristot de Oliveira  */
1183f7d9f637SDaniel Bristot de Oliveira static void
1184fa2c3254SValentin Schneider trace_sched_switch_callback(void *data, bool preempt,
1185fa2c3254SValentin Schneider 			    struct task_struct *p,
11869c2136beSDelyan Kratunov 			    struct task_struct *n,
11879c2136beSDelyan Kratunov 			    unsigned int prev_state)
1188bce29ac9SDaniel Bristot de Oliveira {
1189bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
119030838fcdSDaniel Bristot de Oliveira 	int workload = test_bit(OSN_WORKLOAD, &osnoise_options);
1191bce29ac9SDaniel Bristot de Oliveira 
119230838fcdSDaniel Bristot de Oliveira 	if ((p->pid != osn_var->pid) || !workload)
1193bce29ac9SDaniel Bristot de Oliveira 		thread_exit(osn_var, p);
1194bce29ac9SDaniel Bristot de Oliveira 
119530838fcdSDaniel Bristot de Oliveira 	if ((n->pid != osn_var->pid) || !workload)
1196bce29ac9SDaniel Bristot de Oliveira 		thread_entry(osn_var, n);
1197bce29ac9SDaniel Bristot de Oliveira }
1198bce29ac9SDaniel Bristot de Oliveira 
1199bce29ac9SDaniel Bristot de Oliveira /*
1200bce29ac9SDaniel Bristot de Oliveira  * hook_thread_events - Hook the insturmentation for thread noise
1201bce29ac9SDaniel Bristot de Oliveira  *
1202bce29ac9SDaniel Bristot de Oliveira  * Hook the osnoise tracer callbacks to handle the noise from other
1203bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
1204bce29ac9SDaniel Bristot de Oliveira  */
1205f7d9f637SDaniel Bristot de Oliveira static int hook_thread_events(void)
1206bce29ac9SDaniel Bristot de Oliveira {
1207bce29ac9SDaniel Bristot de Oliveira 	int ret;
1208bce29ac9SDaniel Bristot de Oliveira 
1209bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_sched_switch(trace_sched_switch_callback, NULL);
1210bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1211bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
1212bce29ac9SDaniel Bristot de Oliveira 
1213bce29ac9SDaniel Bristot de Oliveira 	return 0;
1214bce29ac9SDaniel Bristot de Oliveira }
1215bce29ac9SDaniel Bristot de Oliveira 
1216bce29ac9SDaniel Bristot de Oliveira /*
1217bce29ac9SDaniel Bristot de Oliveira  * unhook_thread_events - *nhook the insturmentation for thread noise
1218bce29ac9SDaniel Bristot de Oliveira  *
1219bce29ac9SDaniel Bristot de Oliveira  * Unook the osnoise tracer callbacks to handle the noise from other
1220bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
1221bce29ac9SDaniel Bristot de Oliveira  */
1222f7d9f637SDaniel Bristot de Oliveira static void unhook_thread_events(void)
1223bce29ac9SDaniel Bristot de Oliveira {
1224bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_sched_switch(trace_sched_switch_callback, NULL);
1225bce29ac9SDaniel Bristot de Oliveira }
1226bce29ac9SDaniel Bristot de Oliveira 
1227bce29ac9SDaniel Bristot de Oliveira /*
1228bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats - Save the osnoise_sample statistics
1229bce29ac9SDaniel Bristot de Oliveira  *
1230bce29ac9SDaniel Bristot de Oliveira  * Save the osnoise_sample statistics before the sampling phase. These
1231bce29ac9SDaniel Bristot de Oliveira  * values will be used later to compute the diff betwneen the statistics
1232bce29ac9SDaniel Bristot de Oliveira  * before and after the osnoise sampling.
1233bce29ac9SDaniel Bristot de Oliveira  */
1234f7d9f637SDaniel Bristot de Oliveira static void
1235f7d9f637SDaniel Bristot de Oliveira save_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1236bce29ac9SDaniel Bristot de Oliveira {
1237bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count;
1238bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count;
1239bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count;
1240bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count;
1241bce29ac9SDaniel Bristot de Oliveira }
1242bce29ac9SDaniel Bristot de Oliveira 
1243bce29ac9SDaniel Bristot de Oliveira /*
1244bce29ac9SDaniel Bristot de Oliveira  * diff_osn_sample_stats - Compute the osnoise_sample statistics
1245bce29ac9SDaniel Bristot de Oliveira  *
1246bce29ac9SDaniel Bristot de Oliveira  * After a sample period, compute the difference on the osnoise_sample
1247bce29ac9SDaniel Bristot de Oliveira  * statistics. The struct osnoise_sample *s contains the statistics saved via
1248bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats() before the osnoise sampling.
1249bce29ac9SDaniel Bristot de Oliveira  */
1250f7d9f637SDaniel Bristot de Oliveira static void
1251f7d9f637SDaniel Bristot de Oliveira diff_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1252bce29ac9SDaniel Bristot de Oliveira {
1253bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count - s->nmi_count;
1254bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count - s->irq_count;
1255bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count - s->softirq_count;
1256bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count - s->thread_count;
1257bce29ac9SDaniel Bristot de Oliveira }
1258bce29ac9SDaniel Bristot de Oliveira 
1259bce29ac9SDaniel Bristot de Oliveira /*
1260bce29ac9SDaniel Bristot de Oliveira  * osnoise_stop_tracing - Stop tracing and the tracer.
1261bce29ac9SDaniel Bristot de Oliveira  */
12620e05ba49SDaniel Bristot de Oliveira static __always_inline void osnoise_stop_tracing(void)
1263bce29ac9SDaniel Bristot de Oliveira {
1264dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
1265dae18134SDaniel Bristot de Oliveira 	struct trace_array *tr;
12660e05ba49SDaniel Bristot de Oliveira 
1267dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
1268dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
1269dae18134SDaniel Bristot de Oliveira 		tr = inst->tr;
12700e05ba49SDaniel Bristot de Oliveira 		trace_array_printk_buf(tr->array_buffer.buffer, _THIS_IP_,
12710e05ba49SDaniel Bristot de Oliveira 				"stop tracing hit on cpu %d\n", smp_processor_id());
12720e05ba49SDaniel Bristot de Oliveira 
1273bce29ac9SDaniel Bristot de Oliveira 		tracer_tracing_off(tr);
1274bce29ac9SDaniel Bristot de Oliveira 	}
1275dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
1276dae18134SDaniel Bristot de Oliveira }
1277dae18134SDaniel Bristot de Oliveira 
1278dae18134SDaniel Bristot de Oliveira /*
1279dae18134SDaniel Bristot de Oliveira  * notify_new_max_latency - Notify a new max latency via fsnotify interface.
1280dae18134SDaniel Bristot de Oliveira  */
1281dae18134SDaniel Bristot de Oliveira static void notify_new_max_latency(u64 latency)
1282dae18134SDaniel Bristot de Oliveira {
1283dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
1284dae18134SDaniel Bristot de Oliveira 	struct trace_array *tr;
1285dae18134SDaniel Bristot de Oliveira 
1286dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
1287dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
1288dae18134SDaniel Bristot de Oliveira 		tr = inst->tr;
1289dae18134SDaniel Bristot de Oliveira 		if (tr->max_latency < latency) {
1290dae18134SDaniel Bristot de Oliveira 			tr->max_latency = latency;
1291dae18134SDaniel Bristot de Oliveira 			latency_fsnotify(tr);
1292dae18134SDaniel Bristot de Oliveira 		}
1293dae18134SDaniel Bristot de Oliveira 	}
1294dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
1295dae18134SDaniel Bristot de Oliveira }
1296bce29ac9SDaniel Bristot de Oliveira 
1297bce29ac9SDaniel Bristot de Oliveira /*
1298bce29ac9SDaniel Bristot de Oliveira  * run_osnoise - Sample the time and look for osnoise
1299bce29ac9SDaniel Bristot de Oliveira  *
1300bce29ac9SDaniel Bristot de Oliveira  * Used to capture the time, looking for potential osnoise latency repeatedly.
1301bce29ac9SDaniel Bristot de Oliveira  * Different from hwlat_detector, it is called with preemption and interrupts
1302bce29ac9SDaniel Bristot de Oliveira  * enabled. This allows irqs, softirqs and threads to run, interfering on the
1303bce29ac9SDaniel Bristot de Oliveira  * osnoise sampling thread, as they would do with a regular thread.
1304bce29ac9SDaniel Bristot de Oliveira  */
1305bce29ac9SDaniel Bristot de Oliveira static int run_osnoise(void)
1306bce29ac9SDaniel Bristot de Oliveira {
1307bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1308bce29ac9SDaniel Bristot de Oliveira 	u64 start, sample, last_sample;
1309bce29ac9SDaniel Bristot de Oliveira 	u64 last_int_count, int_count;
131019c3eaa7SDaniel Bristot de Oliveira 	s64 noise = 0, max_noise = 0;
1311bce29ac9SDaniel Bristot de Oliveira 	s64 total, last_total = 0;
1312bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_sample s;
1313bce29ac9SDaniel Bristot de Oliveira 	unsigned int threshold;
1314bce29ac9SDaniel Bristot de Oliveira 	u64 runtime, stop_in;
131519c3eaa7SDaniel Bristot de Oliveira 	u64 sum_noise = 0;
131619c3eaa7SDaniel Bristot de Oliveira 	int hw_count = 0;
1317bce29ac9SDaniel Bristot de Oliveira 	int ret = -1;
1318bce29ac9SDaniel Bristot de Oliveira 
1319bce29ac9SDaniel Bristot de Oliveira 	/*
1320bce29ac9SDaniel Bristot de Oliveira 	 * Considers the current thread as the workload.
1321bce29ac9SDaniel Bristot de Oliveira 	 */
1322bce29ac9SDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1323bce29ac9SDaniel Bristot de Oliveira 
1324bce29ac9SDaniel Bristot de Oliveira 	/*
1325bce29ac9SDaniel Bristot de Oliveira 	 * Save the current stats for the diff
1326bce29ac9SDaniel Bristot de Oliveira 	 */
1327bce29ac9SDaniel Bristot de Oliveira 	save_osn_sample_stats(osn_var, &s);
1328bce29ac9SDaniel Bristot de Oliveira 
1329bce29ac9SDaniel Bristot de Oliveira 	/*
1330bce29ac9SDaniel Bristot de Oliveira 	 * if threshold is 0, use the default value of 5 us.
1331bce29ac9SDaniel Bristot de Oliveira 	 */
1332bce29ac9SDaniel Bristot de Oliveira 	threshold = tracing_thresh ? : 5000;
1333bce29ac9SDaniel Bristot de Oliveira 
1334bce29ac9SDaniel Bristot de Oliveira 	/*
1335bce29ac9SDaniel Bristot de Oliveira 	 * Make sure NMIs see sampling first
1336bce29ac9SDaniel Bristot de Oliveira 	 */
1337bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = true;
1338bce29ac9SDaniel Bristot de Oliveira 	barrier();
1339bce29ac9SDaniel Bristot de Oliveira 
1340bce29ac9SDaniel Bristot de Oliveira 	/*
1341bce29ac9SDaniel Bristot de Oliveira 	 * Transform the *_us config to nanoseconds to avoid the
1342bce29ac9SDaniel Bristot de Oliveira 	 * division on the main loop.
1343bce29ac9SDaniel Bristot de Oliveira 	 */
1344bce29ac9SDaniel Bristot de Oliveira 	runtime = osnoise_data.sample_runtime * NSEC_PER_USEC;
1345bce29ac9SDaniel Bristot de Oliveira 	stop_in = osnoise_data.stop_tracing * NSEC_PER_USEC;
1346bce29ac9SDaniel Bristot de Oliveira 
1347bce29ac9SDaniel Bristot de Oliveira 	/*
1348bce29ac9SDaniel Bristot de Oliveira 	 * Start timestemp
1349bce29ac9SDaniel Bristot de Oliveira 	 */
1350bce29ac9SDaniel Bristot de Oliveira 	start = time_get();
1351bce29ac9SDaniel Bristot de Oliveira 
1352bce29ac9SDaniel Bristot de Oliveira 	/*
1353bce29ac9SDaniel Bristot de Oliveira 	 * "previous" loop.
1354bce29ac9SDaniel Bristot de Oliveira 	 */
1355bce29ac9SDaniel Bristot de Oliveira 	last_int_count = set_int_safe_time(osn_var, &last_sample);
1356bce29ac9SDaniel Bristot de Oliveira 
1357bce29ac9SDaniel Bristot de Oliveira 	do {
1358bce29ac9SDaniel Bristot de Oliveira 		/*
1359bce29ac9SDaniel Bristot de Oliveira 		 * Get sample!
1360bce29ac9SDaniel Bristot de Oliveira 		 */
1361bce29ac9SDaniel Bristot de Oliveira 		int_count = set_int_safe_time(osn_var, &sample);
1362bce29ac9SDaniel Bristot de Oliveira 
1363bce29ac9SDaniel Bristot de Oliveira 		noise = time_sub(sample, last_sample);
1364bce29ac9SDaniel Bristot de Oliveira 
1365bce29ac9SDaniel Bristot de Oliveira 		/*
1366bce29ac9SDaniel Bristot de Oliveira 		 * This shouldn't happen.
1367bce29ac9SDaniel Bristot de Oliveira 		 */
1368bce29ac9SDaniel Bristot de Oliveira 		if (noise < 0) {
1369bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("negative noise!");
1370bce29ac9SDaniel Bristot de Oliveira 			goto out;
1371bce29ac9SDaniel Bristot de Oliveira 		}
1372bce29ac9SDaniel Bristot de Oliveira 
1373bce29ac9SDaniel Bristot de Oliveira 		/*
1374bce29ac9SDaniel Bristot de Oliveira 		 * Sample runtime.
1375bce29ac9SDaniel Bristot de Oliveira 		 */
1376bce29ac9SDaniel Bristot de Oliveira 		total = time_sub(sample, start);
1377bce29ac9SDaniel Bristot de Oliveira 
1378bce29ac9SDaniel Bristot de Oliveira 		/*
1379bce29ac9SDaniel Bristot de Oliveira 		 * Check for possible overflows.
1380bce29ac9SDaniel Bristot de Oliveira 		 */
1381bce29ac9SDaniel Bristot de Oliveira 		if (total < last_total) {
1382bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("total overflow!");
1383bce29ac9SDaniel Bristot de Oliveira 			break;
1384bce29ac9SDaniel Bristot de Oliveira 		}
1385bce29ac9SDaniel Bristot de Oliveira 
1386bce29ac9SDaniel Bristot de Oliveira 		last_total = total;
1387bce29ac9SDaniel Bristot de Oliveira 
1388bce29ac9SDaniel Bristot de Oliveira 		if (noise >= threshold) {
1389bce29ac9SDaniel Bristot de Oliveira 			int interference = int_count - last_int_count;
1390bce29ac9SDaniel Bristot de Oliveira 
1391bce29ac9SDaniel Bristot de Oliveira 			if (noise > max_noise)
1392bce29ac9SDaniel Bristot de Oliveira 				max_noise = noise;
1393bce29ac9SDaniel Bristot de Oliveira 
1394bce29ac9SDaniel Bristot de Oliveira 			if (!interference)
1395bce29ac9SDaniel Bristot de Oliveira 				hw_count++;
1396bce29ac9SDaniel Bristot de Oliveira 
1397bce29ac9SDaniel Bristot de Oliveira 			sum_noise += noise;
1398bce29ac9SDaniel Bristot de Oliveira 
1399bce29ac9SDaniel Bristot de Oliveira 			trace_sample_threshold(last_sample, noise, interference);
1400bce29ac9SDaniel Bristot de Oliveira 
1401bce29ac9SDaniel Bristot de Oliveira 			if (osnoise_data.stop_tracing)
1402bce29ac9SDaniel Bristot de Oliveira 				if (noise > stop_in)
1403bce29ac9SDaniel Bristot de Oliveira 					osnoise_stop_tracing();
1404bce29ac9SDaniel Bristot de Oliveira 		}
1405bce29ac9SDaniel Bristot de Oliveira 
1406bce29ac9SDaniel Bristot de Oliveira 		/*
1407caf4c86bSNicolas Saenz Julienne 		 * In some cases, notably when running on a nohz_full CPU with
1408caf4c86bSNicolas Saenz Julienne 		 * a stopped tick PREEMPT_RCU has no way to account for QSs.
1409caf4c86bSNicolas Saenz Julienne 		 * This will eventually cause unwarranted noise as PREEMPT_RCU
1410caf4c86bSNicolas Saenz Julienne 		 * will force preemption as the means of ending the current
1411caf4c86bSNicolas Saenz Julienne 		 * grace period. We avoid this problem by calling
1412caf4c86bSNicolas Saenz Julienne 		 * rcu_momentary_dyntick_idle(), which performs a zero duration
1413caf4c86bSNicolas Saenz Julienne 		 * EQS allowing PREEMPT_RCU to end the current grace period.
1414caf4c86bSNicolas Saenz Julienne 		 * This call shouldn't be wrapped inside an RCU critical
1415caf4c86bSNicolas Saenz Julienne 		 * section.
1416caf4c86bSNicolas Saenz Julienne 		 *
1417caf4c86bSNicolas Saenz Julienne 		 * Note that in non PREEMPT_RCU kernels QSs are handled through
1418caf4c86bSNicolas Saenz Julienne 		 * cond_resched()
1419caf4c86bSNicolas Saenz Julienne 		 */
1420caf4c86bSNicolas Saenz Julienne 		if (IS_ENABLED(CONFIG_PREEMPT_RCU)) {
1421caf4c86bSNicolas Saenz Julienne 			local_irq_disable();
1422caf4c86bSNicolas Saenz Julienne 			rcu_momentary_dyntick_idle();
1423caf4c86bSNicolas Saenz Julienne 			local_irq_enable();
1424caf4c86bSNicolas Saenz Julienne 		}
1425caf4c86bSNicolas Saenz Julienne 
1426caf4c86bSNicolas Saenz Julienne 		/*
1427bce29ac9SDaniel Bristot de Oliveira 		 * For the non-preemptive kernel config: let threads runs, if
1428bce29ac9SDaniel Bristot de Oliveira 		 * they so wish.
1429bce29ac9SDaniel Bristot de Oliveira 		 */
1430bce29ac9SDaniel Bristot de Oliveira 		cond_resched();
1431bce29ac9SDaniel Bristot de Oliveira 
1432bce29ac9SDaniel Bristot de Oliveira 		last_sample = sample;
1433bce29ac9SDaniel Bristot de Oliveira 		last_int_count = int_count;
1434bce29ac9SDaniel Bristot de Oliveira 
1435bce29ac9SDaniel Bristot de Oliveira 	} while (total < runtime && !kthread_should_stop());
1436bce29ac9SDaniel Bristot de Oliveira 
1437bce29ac9SDaniel Bristot de Oliveira 	/*
1438bce29ac9SDaniel Bristot de Oliveira 	 * Finish the above in the view for interrupts.
1439bce29ac9SDaniel Bristot de Oliveira 	 */
1440bce29ac9SDaniel Bristot de Oliveira 	barrier();
1441bce29ac9SDaniel Bristot de Oliveira 
1442bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = false;
1443bce29ac9SDaniel Bristot de Oliveira 
1444bce29ac9SDaniel Bristot de Oliveira 	/*
1445bce29ac9SDaniel Bristot de Oliveira 	 * Make sure sampling data is no longer updated.
1446bce29ac9SDaniel Bristot de Oliveira 	 */
1447bce29ac9SDaniel Bristot de Oliveira 	barrier();
1448bce29ac9SDaniel Bristot de Oliveira 
1449bce29ac9SDaniel Bristot de Oliveira 	/*
1450bce29ac9SDaniel Bristot de Oliveira 	 * Save noise info.
1451bce29ac9SDaniel Bristot de Oliveira 	 */
1452bce29ac9SDaniel Bristot de Oliveira 	s.noise = time_to_us(sum_noise);
1453bce29ac9SDaniel Bristot de Oliveira 	s.runtime = time_to_us(total);
1454bce29ac9SDaniel Bristot de Oliveira 	s.max_sample = time_to_us(max_noise);
1455bce29ac9SDaniel Bristot de Oliveira 	s.hw_count = hw_count;
1456bce29ac9SDaniel Bristot de Oliveira 
1457bce29ac9SDaniel Bristot de Oliveira 	/* Save interference stats info */
1458bce29ac9SDaniel Bristot de Oliveira 	diff_osn_sample_stats(osn_var, &s);
1459bce29ac9SDaniel Bristot de Oliveira 
1460bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_sample(&s);
1461bce29ac9SDaniel Bristot de Oliveira 
1462dae18134SDaniel Bristot de Oliveira 	notify_new_max_latency(max_noise);
1463bce29ac9SDaniel Bristot de Oliveira 
1464bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing_total)
1465bce29ac9SDaniel Bristot de Oliveira 		if (s.noise > osnoise_data.stop_tracing_total)
1466bce29ac9SDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1467bce29ac9SDaniel Bristot de Oliveira 
1468bce29ac9SDaniel Bristot de Oliveira 	return 0;
1469bce29ac9SDaniel Bristot de Oliveira out:
1470bce29ac9SDaniel Bristot de Oliveira 	return ret;
1471bce29ac9SDaniel Bristot de Oliveira }
1472bce29ac9SDaniel Bristot de Oliveira 
1473bce29ac9SDaniel Bristot de Oliveira static struct cpumask osnoise_cpumask;
1474bce29ac9SDaniel Bristot de Oliveira static struct cpumask save_cpumask;
1475bce29ac9SDaniel Bristot de Oliveira 
1476bce29ac9SDaniel Bristot de Oliveira /*
1477dd990352SDaniel Bristot de Oliveira  * osnoise_sleep - sleep until the next period
1478dd990352SDaniel Bristot de Oliveira  */
1479dd990352SDaniel Bristot de Oliveira static void osnoise_sleep(void)
1480dd990352SDaniel Bristot de Oliveira {
1481dd990352SDaniel Bristot de Oliveira 	u64 interval;
1482dd990352SDaniel Bristot de Oliveira 	ktime_t wake_time;
1483dd990352SDaniel Bristot de Oliveira 
1484dd990352SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
1485dd990352SDaniel Bristot de Oliveira 	interval = osnoise_data.sample_period - osnoise_data.sample_runtime;
1486dd990352SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1487dd990352SDaniel Bristot de Oliveira 
1488dd990352SDaniel Bristot de Oliveira 	/*
1489dd990352SDaniel Bristot de Oliveira 	 * differently from hwlat_detector, the osnoise tracer can run
1490dd990352SDaniel Bristot de Oliveira 	 * without a pause because preemption is on.
1491dd990352SDaniel Bristot de Oliveira 	 */
1492dd990352SDaniel Bristot de Oliveira 	if (!interval) {
1493dd990352SDaniel Bristot de Oliveira 		/* Let synchronize_rcu_tasks() make progress */
1494dd990352SDaniel Bristot de Oliveira 		cond_resched_tasks_rcu_qs();
1495dd990352SDaniel Bristot de Oliveira 		return;
1496dd990352SDaniel Bristot de Oliveira 	}
1497dd990352SDaniel Bristot de Oliveira 
1498dd990352SDaniel Bristot de Oliveira 	wake_time = ktime_add_us(ktime_get(), interval);
1499dd990352SDaniel Bristot de Oliveira 	__set_current_state(TASK_INTERRUPTIBLE);
1500dd990352SDaniel Bristot de Oliveira 
1501dd990352SDaniel Bristot de Oliveira 	while (schedule_hrtimeout_range(&wake_time, 0, HRTIMER_MODE_ABS)) {
1502dd990352SDaniel Bristot de Oliveira 		if (kthread_should_stop())
1503dd990352SDaniel Bristot de Oliveira 			break;
1504dd990352SDaniel Bristot de Oliveira 	}
1505dd990352SDaniel Bristot de Oliveira }
1506dd990352SDaniel Bristot de Oliveira 
1507dd990352SDaniel Bristot de Oliveira /*
1508bce29ac9SDaniel Bristot de Oliveira  * osnoise_main - The osnoise detection kernel thread
1509bce29ac9SDaniel Bristot de Oliveira  *
1510bce29ac9SDaniel Bristot de Oliveira  * Calls run_osnoise() function to measure the osnoise for the configured runtime,
1511bce29ac9SDaniel Bristot de Oliveira  * every period.
1512bce29ac9SDaniel Bristot de Oliveira  */
1513bce29ac9SDaniel Bristot de Oliveira static int osnoise_main(void *data)
1514bce29ac9SDaniel Bristot de Oliveira {
1515bce29ac9SDaniel Bristot de Oliveira 
1516bce29ac9SDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
1517bce29ac9SDaniel Bristot de Oliveira 		run_osnoise();
1518dd990352SDaniel Bristot de Oliveira 		osnoise_sleep();
1519bce29ac9SDaniel Bristot de Oliveira 	}
1520bce29ac9SDaniel Bristot de Oliveira 
1521bce29ac9SDaniel Bristot de Oliveira 	return 0;
1522bce29ac9SDaniel Bristot de Oliveira }
1523bce29ac9SDaniel Bristot de Oliveira 
1524a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1525a955d7eaSDaniel Bristot de Oliveira /*
1526a955d7eaSDaniel Bristot de Oliveira  * timerlat_irq - hrtimer handler for timerlat.
1527a955d7eaSDaniel Bristot de Oliveira  */
1528a955d7eaSDaniel Bristot de Oliveira static enum hrtimer_restart timerlat_irq(struct hrtimer *timer)
1529a955d7eaSDaniel Bristot de Oliveira {
1530a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1531a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat;
1532a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1533a955d7eaSDaniel Bristot de Oliveira 	u64 now;
1534a955d7eaSDaniel Bristot de Oliveira 	u64 diff;
1535a955d7eaSDaniel Bristot de Oliveira 
1536a955d7eaSDaniel Bristot de Oliveira 	/*
1537a955d7eaSDaniel Bristot de Oliveira 	 * I am not sure if the timer was armed for this CPU. So, get
1538a955d7eaSDaniel Bristot de Oliveira 	 * the timerlat struct from the timer itself, not from this
1539a955d7eaSDaniel Bristot de Oliveira 	 * CPU.
1540a955d7eaSDaniel Bristot de Oliveira 	 */
1541a955d7eaSDaniel Bristot de Oliveira 	tlat = container_of(timer, struct timerlat_variables, timer);
1542a955d7eaSDaniel Bristot de Oliveira 
1543a955d7eaSDaniel Bristot de Oliveira 	now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1544a955d7eaSDaniel Bristot de Oliveira 
1545a955d7eaSDaniel Bristot de Oliveira 	/*
1546a955d7eaSDaniel Bristot de Oliveira 	 * Enable the osnoise: events for thread an softirq.
1547a955d7eaSDaniel Bristot de Oliveira 	 */
1548a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = true;
1549a955d7eaSDaniel Bristot de Oliveira 
1550a955d7eaSDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
1551a955d7eaSDaniel Bristot de Oliveira 
1552a955d7eaSDaniel Bristot de Oliveira 	/*
1553a955d7eaSDaniel Bristot de Oliveira 	 * A hardirq is running: the timer IRQ. It is for sure preempting
1554a955d7eaSDaniel Bristot de Oliveira 	 * a thread, and potentially preempting a softirq.
1555a955d7eaSDaniel Bristot de Oliveira 	 *
1556a955d7eaSDaniel Bristot de Oliveira 	 * At this point, it is not interesting to know the duration of the
1557a955d7eaSDaniel Bristot de Oliveira 	 * preempted thread (and maybe softirq), but how much time they will
1558a955d7eaSDaniel Bristot de Oliveira 	 * delay the beginning of the execution of the timer thread.
1559a955d7eaSDaniel Bristot de Oliveira 	 *
1560a955d7eaSDaniel Bristot de Oliveira 	 * To get the correct (net) delay added by the softirq, its delta_start
1561a955d7eaSDaniel Bristot de Oliveira 	 * is set as the IRQ one. In this way, at the return of the IRQ, the delta
1562a955d7eaSDaniel Bristot de Oliveira 	 * start of the sofitrq will be zeroed, accounting then only the time
1563a955d7eaSDaniel Bristot de Oliveira 	 * after that.
1564a955d7eaSDaniel Bristot de Oliveira 	 *
1565a955d7eaSDaniel Bristot de Oliveira 	 * The thread follows the same principle. However, if a softirq is
1566a955d7eaSDaniel Bristot de Oliveira 	 * running, the thread needs to receive the softirq delta_start. The
1567a955d7eaSDaniel Bristot de Oliveira 	 * reason being is that the softirq will be the last to be unfolded,
1568a955d7eaSDaniel Bristot de Oliveira 	 * resseting the thread delay to zero.
156901e181c7SDaniel Bristot de Oliveira 	 *
157001e181c7SDaniel Bristot de Oliveira 	 * The PREEMPT_RT is a special case, though. As softirqs run as threads
157101e181c7SDaniel Bristot de Oliveira 	 * on RT, moving the thread is enough.
1572a955d7eaSDaniel Bristot de Oliveira 	 */
157301e181c7SDaniel Bristot de Oliveira 	if (!IS_ENABLED(CONFIG_PREEMPT_RT) && osn_var->softirq.delta_start) {
1574a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1575a955d7eaSDaniel Bristot de Oliveira 				   &osn_var->softirq.delta_start);
1576a955d7eaSDaniel Bristot de Oliveira 
1577a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->softirq.delta_start,
1578a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1579a955d7eaSDaniel Bristot de Oliveira 	} else {
1580a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1581a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1582a955d7eaSDaniel Bristot de Oliveira 	}
1583a955d7eaSDaniel Bristot de Oliveira 
1584a955d7eaSDaniel Bristot de Oliveira 	/*
1585a955d7eaSDaniel Bristot de Oliveira 	 * Compute the current time with the expected time.
1586a955d7eaSDaniel Bristot de Oliveira 	 */
1587a955d7eaSDaniel Bristot de Oliveira 	diff = now - tlat->abs_period;
1588a955d7eaSDaniel Bristot de Oliveira 
1589a955d7eaSDaniel Bristot de Oliveira 	tlat->count++;
1590a955d7eaSDaniel Bristot de Oliveira 	s.seqnum = tlat->count;
1591a955d7eaSDaniel Bristot de Oliveira 	s.timer_latency = diff;
1592a955d7eaSDaniel Bristot de Oliveira 	s.context = IRQ_CONTEXT;
1593a955d7eaSDaniel Bristot de Oliveira 
1594a955d7eaSDaniel Bristot de Oliveira 	trace_timerlat_sample(&s);
1595a955d7eaSDaniel Bristot de Oliveira 
1596aa748949SDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing) {
1597aa748949SDaniel Bristot de Oliveira 		if (time_to_us(diff) >= osnoise_data.stop_tracing) {
15984dd2aea2SDaniel Bristot de Oliveira 
15994dd2aea2SDaniel Bristot de Oliveira 			/*
16004dd2aea2SDaniel Bristot de Oliveira 			 * At this point, if stop_tracing is set and <= print_stack,
16014dd2aea2SDaniel Bristot de Oliveira 			 * print_stack is set and would be printed in the thread handler.
16024dd2aea2SDaniel Bristot de Oliveira 			 *
16034dd2aea2SDaniel Bristot de Oliveira 			 * Thus, print the stack trace as it is helpful to define the
16044dd2aea2SDaniel Bristot de Oliveira 			 * root cause of an IRQ latency.
16054dd2aea2SDaniel Bristot de Oliveira 			 */
16064dd2aea2SDaniel Bristot de Oliveira 			if (osnoise_data.stop_tracing <= osnoise_data.print_stack) {
16074dd2aea2SDaniel Bristot de Oliveira 				timerlat_save_stack(0);
16084dd2aea2SDaniel Bristot de Oliveira 				timerlat_dump_stack(time_to_us(diff));
16094dd2aea2SDaniel Bristot de Oliveira 			}
16104dd2aea2SDaniel Bristot de Oliveira 
1611a955d7eaSDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1612a955d7eaSDaniel Bristot de Oliveira 			notify_new_max_latency(diff);
1613a955d7eaSDaniel Bristot de Oliveira 
16149c556e5aSDaniel Bristot de Oliveira 			return HRTIMER_NORESTART;
1615aa748949SDaniel Bristot de Oliveira 		}
1616aa748949SDaniel Bristot de Oliveira 	}
1617a955d7eaSDaniel Bristot de Oliveira 
1618a955d7eaSDaniel Bristot de Oliveira 	wake_up_process(tlat->kthread);
1619a955d7eaSDaniel Bristot de Oliveira 
1620a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.print_stack)
1621a955d7eaSDaniel Bristot de Oliveira 		timerlat_save_stack(0);
1622a955d7eaSDaniel Bristot de Oliveira 
1623a955d7eaSDaniel Bristot de Oliveira 	return HRTIMER_NORESTART;
1624a955d7eaSDaniel Bristot de Oliveira }
1625a955d7eaSDaniel Bristot de Oliveira 
1626a955d7eaSDaniel Bristot de Oliveira /*
1627a955d7eaSDaniel Bristot de Oliveira  * wait_next_period - Wait for the next period for timerlat
1628a955d7eaSDaniel Bristot de Oliveira  */
1629a955d7eaSDaniel Bristot de Oliveira static int wait_next_period(struct timerlat_variables *tlat)
1630a955d7eaSDaniel Bristot de Oliveira {
1631a955d7eaSDaniel Bristot de Oliveira 	ktime_t next_abs_period, now;
1632a955d7eaSDaniel Bristot de Oliveira 	u64 rel_period = osnoise_data.timerlat_period * 1000;
1633a955d7eaSDaniel Bristot de Oliveira 
1634a955d7eaSDaniel Bristot de Oliveira 	now = hrtimer_cb_get_time(&tlat->timer);
1635a955d7eaSDaniel Bristot de Oliveira 	next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1636a955d7eaSDaniel Bristot de Oliveira 
1637a955d7eaSDaniel Bristot de Oliveira 	/*
1638a955d7eaSDaniel Bristot de Oliveira 	 * Save the next abs_period.
1639a955d7eaSDaniel Bristot de Oliveira 	 */
1640a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1641a955d7eaSDaniel Bristot de Oliveira 
1642a955d7eaSDaniel Bristot de Oliveira 	/*
1643a955d7eaSDaniel Bristot de Oliveira 	 * If the new abs_period is in the past, skip the activation.
1644a955d7eaSDaniel Bristot de Oliveira 	 */
1645a955d7eaSDaniel Bristot de Oliveira 	while (ktime_compare(now, next_abs_period) > 0) {
1646a955d7eaSDaniel Bristot de Oliveira 		next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1647a955d7eaSDaniel Bristot de Oliveira 		tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1648a955d7eaSDaniel Bristot de Oliveira 	}
1649a955d7eaSDaniel Bristot de Oliveira 
1650a955d7eaSDaniel Bristot de Oliveira 	set_current_state(TASK_INTERRUPTIBLE);
1651a955d7eaSDaniel Bristot de Oliveira 
1652a955d7eaSDaniel Bristot de Oliveira 	hrtimer_start(&tlat->timer, next_abs_period, HRTIMER_MODE_ABS_PINNED_HARD);
1653a955d7eaSDaniel Bristot de Oliveira 	schedule();
1654a955d7eaSDaniel Bristot de Oliveira 	return 1;
1655a955d7eaSDaniel Bristot de Oliveira }
1656a955d7eaSDaniel Bristot de Oliveira 
1657a955d7eaSDaniel Bristot de Oliveira /*
1658a955d7eaSDaniel Bristot de Oliveira  * timerlat_main- Timerlat main
1659a955d7eaSDaniel Bristot de Oliveira  */
1660a955d7eaSDaniel Bristot de Oliveira static int timerlat_main(void *data)
1661a955d7eaSDaniel Bristot de Oliveira {
1662a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1663a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat = this_cpu_tmr_var();
1664a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1665a955d7eaSDaniel Bristot de Oliveira 	struct sched_param sp;
1666a955d7eaSDaniel Bristot de Oliveira 	u64 now, diff;
1667a955d7eaSDaniel Bristot de Oliveira 
1668a955d7eaSDaniel Bristot de Oliveira 	/*
1669a955d7eaSDaniel Bristot de Oliveira 	 * Make the thread RT, that is how cyclictest is usually used.
1670a955d7eaSDaniel Bristot de Oliveira 	 */
1671a955d7eaSDaniel Bristot de Oliveira 	sp.sched_priority = DEFAULT_TIMERLAT_PRIO;
1672a955d7eaSDaniel Bristot de Oliveira 	sched_setscheduler_nocheck(current, SCHED_FIFO, &sp);
1673a955d7eaSDaniel Bristot de Oliveira 
1674a955d7eaSDaniel Bristot de Oliveira 	tlat->count = 0;
1675a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = false;
1676a955d7eaSDaniel Bristot de Oliveira 
1677a955d7eaSDaniel Bristot de Oliveira 	hrtimer_init(&tlat->timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS_PINNED_HARD);
1678a955d7eaSDaniel Bristot de Oliveira 	tlat->timer.function = timerlat_irq;
1679a955d7eaSDaniel Bristot de Oliveira 	tlat->kthread = current;
1680a955d7eaSDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1681a955d7eaSDaniel Bristot de Oliveira 	/*
1682a955d7eaSDaniel Bristot de Oliveira 	 * Anotate the arrival time.
1683a955d7eaSDaniel Bristot de Oliveira 	 */
1684a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = hrtimer_cb_get_time(&tlat->timer);
1685a955d7eaSDaniel Bristot de Oliveira 
1686a955d7eaSDaniel Bristot de Oliveira 	wait_next_period(tlat);
1687a955d7eaSDaniel Bristot de Oliveira 
1688a955d7eaSDaniel Bristot de Oliveira 	osn_var->sampling = 1;
1689a955d7eaSDaniel Bristot de Oliveira 
1690a955d7eaSDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
1691a955d7eaSDaniel Bristot de Oliveira 		now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1692a955d7eaSDaniel Bristot de Oliveira 		diff = now - tlat->abs_period;
1693a955d7eaSDaniel Bristot de Oliveira 
1694a955d7eaSDaniel Bristot de Oliveira 		s.seqnum = tlat->count;
1695a955d7eaSDaniel Bristot de Oliveira 		s.timer_latency = diff;
1696a955d7eaSDaniel Bristot de Oliveira 		s.context = THREAD_CONTEXT;
1697a955d7eaSDaniel Bristot de Oliveira 
1698a955d7eaSDaniel Bristot de Oliveira 		trace_timerlat_sample(&s);
1699a955d7eaSDaniel Bristot de Oliveira 
1700b14f4568SDaniel Bristot de Oliveira 		timerlat_dump_stack(time_to_us(diff));
1701a955d7eaSDaniel Bristot de Oliveira 
1702a955d7eaSDaniel Bristot de Oliveira 		tlat->tracing_thread = false;
1703a955d7eaSDaniel Bristot de Oliveira 		if (osnoise_data.stop_tracing_total)
1704a955d7eaSDaniel Bristot de Oliveira 			if (time_to_us(diff) >= osnoise_data.stop_tracing_total)
1705a955d7eaSDaniel Bristot de Oliveira 				osnoise_stop_tracing();
1706a955d7eaSDaniel Bristot de Oliveira 
1707a955d7eaSDaniel Bristot de Oliveira 		wait_next_period(tlat);
1708a955d7eaSDaniel Bristot de Oliveira 	}
1709a955d7eaSDaniel Bristot de Oliveira 
1710a955d7eaSDaniel Bristot de Oliveira 	hrtimer_cancel(&tlat->timer);
1711a955d7eaSDaniel Bristot de Oliveira 	return 0;
1712a955d7eaSDaniel Bristot de Oliveira }
1713ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
1714ccb67544SDaniel Bristot de Oliveira static int timerlat_main(void *data)
1715ccb67544SDaniel Bristot de Oliveira {
1716ccb67544SDaniel Bristot de Oliveira 	return 0;
1717ccb67544SDaniel Bristot de Oliveira }
1718a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
1719a955d7eaSDaniel Bristot de Oliveira 
1720bce29ac9SDaniel Bristot de Oliveira /*
1721c8895e27SDaniel Bristot de Oliveira  * stop_kthread - stop a workload thread
1722c8895e27SDaniel Bristot de Oliveira  */
1723c8895e27SDaniel Bristot de Oliveira static void stop_kthread(unsigned int cpu)
1724c8895e27SDaniel Bristot de Oliveira {
1725c8895e27SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1726c8895e27SDaniel Bristot de Oliveira 
1727c8895e27SDaniel Bristot de Oliveira 	kthread = per_cpu(per_cpu_osnoise_var, cpu).kthread;
172830838fcdSDaniel Bristot de Oliveira 	if (kthread) {
1729c8895e27SDaniel Bristot de Oliveira 		kthread_stop(kthread);
1730c8895e27SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
173130838fcdSDaniel Bristot de Oliveira 	} else {
173230838fcdSDaniel Bristot de Oliveira 		if (!test_bit(OSN_WORKLOAD, &osnoise_options)) {
173330838fcdSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = false;
173430838fcdSDaniel Bristot de Oliveira 			barrier();
173530838fcdSDaniel Bristot de Oliveira 			return;
173630838fcdSDaniel Bristot de Oliveira 		}
173730838fcdSDaniel Bristot de Oliveira 	}
1738c8895e27SDaniel Bristot de Oliveira }
1739c8895e27SDaniel Bristot de Oliveira 
1740c8895e27SDaniel Bristot de Oliveira /*
1741c8895e27SDaniel Bristot de Oliveira  * stop_per_cpu_kthread - Stop per-cpu threads
1742bce29ac9SDaniel Bristot de Oliveira  *
1743bce29ac9SDaniel Bristot de Oliveira  * Stop the osnoise sampling htread. Use this on unload and at system
1744bce29ac9SDaniel Bristot de Oliveira  * shutdown.
1745bce29ac9SDaniel Bristot de Oliveira  */
1746bce29ac9SDaniel Bristot de Oliveira static void stop_per_cpu_kthreads(void)
1747bce29ac9SDaniel Bristot de Oliveira {
1748bce29ac9SDaniel Bristot de Oliveira 	int cpu;
1749bce29ac9SDaniel Bristot de Oliveira 
175099c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1751bce29ac9SDaniel Bristot de Oliveira 
1752bce29ac9SDaniel Bristot de Oliveira 	for_each_online_cpu(cpu)
1753c8895e27SDaniel Bristot de Oliveira 		stop_kthread(cpu);
1754bce29ac9SDaniel Bristot de Oliveira 
175599c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1756c8895e27SDaniel Bristot de Oliveira }
1757c8895e27SDaniel Bristot de Oliveira 
1758c8895e27SDaniel Bristot de Oliveira /*
1759c8895e27SDaniel Bristot de Oliveira  * start_kthread - Start a workload tread
1760c8895e27SDaniel Bristot de Oliveira  */
1761c8895e27SDaniel Bristot de Oliveira static int start_kthread(unsigned int cpu)
1762c8895e27SDaniel Bristot de Oliveira {
1763c8895e27SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1764c8895e27SDaniel Bristot de Oliveira 	void *main = osnoise_main;
1765c8895e27SDaniel Bristot de Oliveira 	char comm[24];
1766c8895e27SDaniel Bristot de Oliveira 
1767ccb67544SDaniel Bristot de Oliveira 	if (timerlat_enabled()) {
1768a955d7eaSDaniel Bristot de Oliveira 		snprintf(comm, 24, "timerlat/%d", cpu);
1769a955d7eaSDaniel Bristot de Oliveira 		main = timerlat_main;
1770a955d7eaSDaniel Bristot de Oliveira 	} else {
177130838fcdSDaniel Bristot de Oliveira 		/* if no workload, just return */
177230838fcdSDaniel Bristot de Oliveira 		if (!test_bit(OSN_WORKLOAD, &osnoise_options)) {
177330838fcdSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = true;
177430838fcdSDaniel Bristot de Oliveira 			barrier();
177530838fcdSDaniel Bristot de Oliveira 			return 0;
177630838fcdSDaniel Bristot de Oliveira 		}
177730838fcdSDaniel Bristot de Oliveira 
1778bce29ac9SDaniel Bristot de Oliveira 		snprintf(comm, 24, "osnoise/%d", cpu);
1779a955d7eaSDaniel Bristot de Oliveira 	}
1780ccb67544SDaniel Bristot de Oliveira 
178111e4e352SCai Huoqing 	kthread = kthread_run_on_cpu(main, NULL, cpu, comm);
1782bce29ac9SDaniel Bristot de Oliveira 
1783bce29ac9SDaniel Bristot de Oliveira 	if (IS_ERR(kthread)) {
1784bce29ac9SDaniel Bristot de Oliveira 		pr_err(BANNER "could not start sampling thread\n");
1785bce29ac9SDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
1786bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
1787bce29ac9SDaniel Bristot de Oliveira 	}
1788bce29ac9SDaniel Bristot de Oliveira 
1789bce29ac9SDaniel Bristot de Oliveira 	per_cpu(per_cpu_osnoise_var, cpu).kthread = kthread;
1790bce29ac9SDaniel Bristot de Oliveira 
1791bce29ac9SDaniel Bristot de Oliveira 	return 0;
1792bce29ac9SDaniel Bristot de Oliveira }
1793bce29ac9SDaniel Bristot de Oliveira 
1794bce29ac9SDaniel Bristot de Oliveira /*
1795c8895e27SDaniel Bristot de Oliveira  * start_per_cpu_kthread - Kick off per-cpu osnoise sampling kthreads
1796c8895e27SDaniel Bristot de Oliveira  *
1797c8895e27SDaniel Bristot de Oliveira  * This starts the kernel thread that will look for osnoise on many
1798c8895e27SDaniel Bristot de Oliveira  * cpus.
1799c8895e27SDaniel Bristot de Oliveira  */
180015ca4bdbSDaniel Bristot de Oliveira static int start_per_cpu_kthreads(void)
1801c8895e27SDaniel Bristot de Oliveira {
1802c8895e27SDaniel Bristot de Oliveira 	struct cpumask *current_mask = &save_cpumask;
18034b6b08f2SQiang.Zhang 	int retval = 0;
1804c8895e27SDaniel Bristot de Oliveira 	int cpu;
1805c8895e27SDaniel Bristot de Oliveira 
180699c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1807c8895e27SDaniel Bristot de Oliveira 	/*
180866df27f1SDaniel Bristot de Oliveira 	 * Run only on online CPUs in which osnoise is allowed to run.
1809c8895e27SDaniel Bristot de Oliveira 	 */
181066df27f1SDaniel Bristot de Oliveira 	cpumask_and(current_mask, cpu_online_mask, &osnoise_cpumask);
1811c8895e27SDaniel Bristot de Oliveira 
1812c8895e27SDaniel Bristot de Oliveira 	for_each_possible_cpu(cpu)
1813c8895e27SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
1814c8895e27SDaniel Bristot de Oliveira 
1815c8895e27SDaniel Bristot de Oliveira 	for_each_cpu(cpu, current_mask) {
1816c8895e27SDaniel Bristot de Oliveira 		retval = start_kthread(cpu);
1817c8895e27SDaniel Bristot de Oliveira 		if (retval) {
181899ee9317SNico Pache 			cpus_read_unlock();
1819c8895e27SDaniel Bristot de Oliveira 			stop_per_cpu_kthreads();
182099ee9317SNico Pache 			return retval;
1821c8895e27SDaniel Bristot de Oliveira 		}
1822c8895e27SDaniel Bristot de Oliveira 	}
1823c8895e27SDaniel Bristot de Oliveira 
182499c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1825c8895e27SDaniel Bristot de Oliveira 
18264b6b08f2SQiang.Zhang 	return retval;
1827c8895e27SDaniel Bristot de Oliveira }
1828c8895e27SDaniel Bristot de Oliveira 
1829c8895e27SDaniel Bristot de Oliveira #ifdef CONFIG_HOTPLUG_CPU
1830c8895e27SDaniel Bristot de Oliveira static void osnoise_hotplug_workfn(struct work_struct *dummy)
1831c8895e27SDaniel Bristot de Oliveira {
1832c8895e27SDaniel Bristot de Oliveira 	unsigned int cpu = smp_processor_id();
1833c8895e27SDaniel Bristot de Oliveira 
1834c8895e27SDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
1835c8895e27SDaniel Bristot de Oliveira 
1836dae18134SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
1837c8895e27SDaniel Bristot de Oliveira 		goto out_unlock_trace;
1838c8895e27SDaniel Bristot de Oliveira 
1839c8895e27SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
184099c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1841c8895e27SDaniel Bristot de Oliveira 
1842c8895e27SDaniel Bristot de Oliveira 	if (!cpumask_test_cpu(cpu, &osnoise_cpumask))
1843c8895e27SDaniel Bristot de Oliveira 		goto out_unlock;
1844c8895e27SDaniel Bristot de Oliveira 
1845c8895e27SDaniel Bristot de Oliveira 	start_kthread(cpu);
1846c8895e27SDaniel Bristot de Oliveira 
1847c8895e27SDaniel Bristot de Oliveira out_unlock:
184899c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1849c8895e27SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1850c8895e27SDaniel Bristot de Oliveira out_unlock_trace:
1851c8895e27SDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
1852c8895e27SDaniel Bristot de Oliveira }
1853c8895e27SDaniel Bristot de Oliveira 
1854c8895e27SDaniel Bristot de Oliveira static DECLARE_WORK(osnoise_hotplug_work, osnoise_hotplug_workfn);
1855c8895e27SDaniel Bristot de Oliveira 
1856c8895e27SDaniel Bristot de Oliveira /*
1857c8895e27SDaniel Bristot de Oliveira  * osnoise_cpu_init - CPU hotplug online callback function
1858c8895e27SDaniel Bristot de Oliveira  */
1859c8895e27SDaniel Bristot de Oliveira static int osnoise_cpu_init(unsigned int cpu)
1860c8895e27SDaniel Bristot de Oliveira {
1861c8895e27SDaniel Bristot de Oliveira 	schedule_work_on(cpu, &osnoise_hotplug_work);
1862c8895e27SDaniel Bristot de Oliveira 	return 0;
1863c8895e27SDaniel Bristot de Oliveira }
1864c8895e27SDaniel Bristot de Oliveira 
1865c8895e27SDaniel Bristot de Oliveira /*
1866c8895e27SDaniel Bristot de Oliveira  * osnoise_cpu_die - CPU hotplug offline callback function
1867c8895e27SDaniel Bristot de Oliveira  */
1868c8895e27SDaniel Bristot de Oliveira static int osnoise_cpu_die(unsigned int cpu)
1869c8895e27SDaniel Bristot de Oliveira {
1870c8895e27SDaniel Bristot de Oliveira 	stop_kthread(cpu);
1871c8895e27SDaniel Bristot de Oliveira 	return 0;
1872c8895e27SDaniel Bristot de Oliveira }
1873c8895e27SDaniel Bristot de Oliveira 
1874c8895e27SDaniel Bristot de Oliveira static void osnoise_init_hotplug_support(void)
1875c8895e27SDaniel Bristot de Oliveira {
1876c8895e27SDaniel Bristot de Oliveira 	int ret;
1877c8895e27SDaniel Bristot de Oliveira 
1878c8895e27SDaniel Bristot de Oliveira 	ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "trace/osnoise:online",
1879c8895e27SDaniel Bristot de Oliveira 				osnoise_cpu_init, osnoise_cpu_die);
1880c8895e27SDaniel Bristot de Oliveira 	if (ret < 0)
1881c8895e27SDaniel Bristot de Oliveira 		pr_warn(BANNER "Error to init cpu hotplug support\n");
1882c8895e27SDaniel Bristot de Oliveira 
1883c8895e27SDaniel Bristot de Oliveira 	return;
1884c8895e27SDaniel Bristot de Oliveira }
1885c8895e27SDaniel Bristot de Oliveira #else /* CONFIG_HOTPLUG_CPU */
1886c8895e27SDaniel Bristot de Oliveira static void osnoise_init_hotplug_support(void)
1887c8895e27SDaniel Bristot de Oliveira {
1888498627b4SDaniel Bristot de Oliveira 	return;
1889c8895e27SDaniel Bristot de Oliveira }
1890c8895e27SDaniel Bristot de Oliveira #endif /* CONFIG_HOTPLUG_CPU */
1891c8895e27SDaniel Bristot de Oliveira 
1892c8895e27SDaniel Bristot de Oliveira /*
1893b179d48bSDaniel Bristot de Oliveira  * seq file functions for the osnoise/options file.
1894b179d48bSDaniel Bristot de Oliveira  */
1895b179d48bSDaniel Bristot de Oliveira static void *s_options_start(struct seq_file *s, loff_t *pos)
1896b179d48bSDaniel Bristot de Oliveira {
1897b179d48bSDaniel Bristot de Oliveira 	int option = *pos;
1898b179d48bSDaniel Bristot de Oliveira 
1899b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
1900b179d48bSDaniel Bristot de Oliveira 
1901b179d48bSDaniel Bristot de Oliveira 	if (option >= OSN_MAX)
1902b179d48bSDaniel Bristot de Oliveira 		return NULL;
1903b179d48bSDaniel Bristot de Oliveira 
1904b179d48bSDaniel Bristot de Oliveira 	return pos;
1905b179d48bSDaniel Bristot de Oliveira }
1906b179d48bSDaniel Bristot de Oliveira 
1907b179d48bSDaniel Bristot de Oliveira static void *s_options_next(struct seq_file *s, void *v, loff_t *pos)
1908b179d48bSDaniel Bristot de Oliveira {
1909b179d48bSDaniel Bristot de Oliveira 	int option = ++(*pos);
1910b179d48bSDaniel Bristot de Oliveira 
1911b179d48bSDaniel Bristot de Oliveira 	if (option >= OSN_MAX)
1912b179d48bSDaniel Bristot de Oliveira 		return NULL;
1913b179d48bSDaniel Bristot de Oliveira 
1914b179d48bSDaniel Bristot de Oliveira 	return pos;
1915b179d48bSDaniel Bristot de Oliveira }
1916b179d48bSDaniel Bristot de Oliveira 
1917b179d48bSDaniel Bristot de Oliveira static int s_options_show(struct seq_file *s, void *v)
1918b179d48bSDaniel Bristot de Oliveira {
1919b179d48bSDaniel Bristot de Oliveira 	loff_t *pos = v;
1920b179d48bSDaniel Bristot de Oliveira 	int option = *pos;
1921b179d48bSDaniel Bristot de Oliveira 
1922b179d48bSDaniel Bristot de Oliveira 	if (option == OSN_DEFAULTS) {
1923b179d48bSDaniel Bristot de Oliveira 		if (osnoise_options == OSN_DEFAULT_OPTIONS)
1924b179d48bSDaniel Bristot de Oliveira 			seq_printf(s, "%s", osnoise_options_str[option]);
1925b179d48bSDaniel Bristot de Oliveira 		else
1926b179d48bSDaniel Bristot de Oliveira 			seq_printf(s, "NO_%s", osnoise_options_str[option]);
1927b179d48bSDaniel Bristot de Oliveira 		goto out;
1928b179d48bSDaniel Bristot de Oliveira 	}
1929b179d48bSDaniel Bristot de Oliveira 
1930b179d48bSDaniel Bristot de Oliveira 	if (test_bit(option, &osnoise_options))
1931b179d48bSDaniel Bristot de Oliveira 		seq_printf(s, "%s", osnoise_options_str[option]);
1932b179d48bSDaniel Bristot de Oliveira 	else
1933b179d48bSDaniel Bristot de Oliveira 		seq_printf(s, "NO_%s", osnoise_options_str[option]);
1934b179d48bSDaniel Bristot de Oliveira 
1935b179d48bSDaniel Bristot de Oliveira out:
1936b179d48bSDaniel Bristot de Oliveira 	if (option != OSN_MAX)
1937b179d48bSDaniel Bristot de Oliveira 		seq_puts(s, " ");
1938b179d48bSDaniel Bristot de Oliveira 
1939b179d48bSDaniel Bristot de Oliveira 	return 0;
1940b179d48bSDaniel Bristot de Oliveira }
1941b179d48bSDaniel Bristot de Oliveira 
1942b179d48bSDaniel Bristot de Oliveira static void s_options_stop(struct seq_file *s, void *v)
1943b179d48bSDaniel Bristot de Oliveira {
1944b179d48bSDaniel Bristot de Oliveira 	seq_puts(s, "\n");
1945b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1946b179d48bSDaniel Bristot de Oliveira }
1947b179d48bSDaniel Bristot de Oliveira 
1948b179d48bSDaniel Bristot de Oliveira static const struct seq_operations osnoise_options_seq_ops = {
1949b179d48bSDaniel Bristot de Oliveira 	.start		= s_options_start,
1950b179d48bSDaniel Bristot de Oliveira 	.next		= s_options_next,
1951b179d48bSDaniel Bristot de Oliveira 	.show		= s_options_show,
1952b179d48bSDaniel Bristot de Oliveira 	.stop		= s_options_stop
1953b179d48bSDaniel Bristot de Oliveira };
1954b179d48bSDaniel Bristot de Oliveira 
1955b179d48bSDaniel Bristot de Oliveira static int osnoise_options_open(struct inode *inode, struct file *file)
1956b179d48bSDaniel Bristot de Oliveira {
1957b179d48bSDaniel Bristot de Oliveira 	return seq_open(file, &osnoise_options_seq_ops);
1958b179d48bSDaniel Bristot de Oliveira };
1959b179d48bSDaniel Bristot de Oliveira 
1960b179d48bSDaniel Bristot de Oliveira /**
1961b179d48bSDaniel Bristot de Oliveira  * osnoise_options_write - Write function for "options" entry
1962b179d48bSDaniel Bristot de Oliveira  * @filp: The active open file structure
1963b179d48bSDaniel Bristot de Oliveira  * @ubuf: The user buffer that contains the value to write
1964b179d48bSDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to write to "file"
1965b179d48bSDaniel Bristot de Oliveira  * @ppos: The current position in @file
1966b179d48bSDaniel Bristot de Oliveira  *
1967b179d48bSDaniel Bristot de Oliveira  * Writing the option name sets the option, writing the "NO_"
1968b179d48bSDaniel Bristot de Oliveira  * prefix in front of the option name disables it.
1969b179d48bSDaniel Bristot de Oliveira  *
1970b179d48bSDaniel Bristot de Oliveira  * Writing "DEFAULTS" resets the option values to the default ones.
1971b179d48bSDaniel Bristot de Oliveira  */
1972b179d48bSDaniel Bristot de Oliveira static ssize_t osnoise_options_write(struct file *filp, const char __user *ubuf,
1973b179d48bSDaniel Bristot de Oliveira 				     size_t cnt, loff_t *ppos)
1974b179d48bSDaniel Bristot de Oliveira {
1975b179d48bSDaniel Bristot de Oliveira 	int running, option, enable, retval;
1976b179d48bSDaniel Bristot de Oliveira 	char buf[256], *option_str;
1977b179d48bSDaniel Bristot de Oliveira 
1978b179d48bSDaniel Bristot de Oliveira 	if (cnt >= 256)
1979b179d48bSDaniel Bristot de Oliveira 		return -EINVAL;
1980b179d48bSDaniel Bristot de Oliveira 
1981b179d48bSDaniel Bristot de Oliveira 	if (copy_from_user(buf, ubuf, cnt))
1982b179d48bSDaniel Bristot de Oliveira 		return -EFAULT;
1983b179d48bSDaniel Bristot de Oliveira 
1984b179d48bSDaniel Bristot de Oliveira 	buf[cnt] = 0;
1985b179d48bSDaniel Bristot de Oliveira 
1986b179d48bSDaniel Bristot de Oliveira 	if (strncmp(buf, "NO_", 3)) {
1987b179d48bSDaniel Bristot de Oliveira 		option_str = strstrip(buf);
1988b179d48bSDaniel Bristot de Oliveira 		enable = true;
1989b179d48bSDaniel Bristot de Oliveira 	} else {
1990b179d48bSDaniel Bristot de Oliveira 		option_str = strstrip(&buf[3]);
1991b179d48bSDaniel Bristot de Oliveira 		enable = false;
1992b179d48bSDaniel Bristot de Oliveira 	}
1993b179d48bSDaniel Bristot de Oliveira 
1994b179d48bSDaniel Bristot de Oliveira 	option = match_string(osnoise_options_str, OSN_MAX, option_str);
1995b179d48bSDaniel Bristot de Oliveira 	if (option < 0)
1996b179d48bSDaniel Bristot de Oliveira 		return -EINVAL;
1997b179d48bSDaniel Bristot de Oliveira 
1998b179d48bSDaniel Bristot de Oliveira 	/*
1999b179d48bSDaniel Bristot de Oliveira 	 * trace_types_lock is taken to avoid concurrency on start/stop.
2000b179d48bSDaniel Bristot de Oliveira 	 */
2001b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
2002b179d48bSDaniel Bristot de Oliveira 	running = osnoise_has_registered_instances();
2003b179d48bSDaniel Bristot de Oliveira 	if (running)
2004b179d48bSDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
2005b179d48bSDaniel Bristot de Oliveira 
2006b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2007b179d48bSDaniel Bristot de Oliveira 	/*
2008b179d48bSDaniel Bristot de Oliveira 	 * avoid CPU hotplug operations that might read options.
2009b179d48bSDaniel Bristot de Oliveira 	 */
2010b179d48bSDaniel Bristot de Oliveira 	cpus_read_lock();
2011b179d48bSDaniel Bristot de Oliveira 
2012b179d48bSDaniel Bristot de Oliveira 	retval = cnt;
2013b179d48bSDaniel Bristot de Oliveira 
2014b179d48bSDaniel Bristot de Oliveira 	if (enable) {
2015b179d48bSDaniel Bristot de Oliveira 		if (option == OSN_DEFAULTS)
2016b179d48bSDaniel Bristot de Oliveira 			osnoise_options = OSN_DEFAULT_OPTIONS;
2017b179d48bSDaniel Bristot de Oliveira 		else
2018b179d48bSDaniel Bristot de Oliveira 			set_bit(option, &osnoise_options);
2019b179d48bSDaniel Bristot de Oliveira 	} else {
2020b179d48bSDaniel Bristot de Oliveira 		if (option == OSN_DEFAULTS)
2021b179d48bSDaniel Bristot de Oliveira 			retval = -EINVAL;
2022b179d48bSDaniel Bristot de Oliveira 		else
2023b179d48bSDaniel Bristot de Oliveira 			clear_bit(option, &osnoise_options);
2024b179d48bSDaniel Bristot de Oliveira 	}
2025b179d48bSDaniel Bristot de Oliveira 
2026b179d48bSDaniel Bristot de Oliveira 	cpus_read_unlock();
2027b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2028b179d48bSDaniel Bristot de Oliveira 
2029b179d48bSDaniel Bristot de Oliveira 	if (running)
2030b179d48bSDaniel Bristot de Oliveira 		start_per_cpu_kthreads();
2031b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
2032b179d48bSDaniel Bristot de Oliveira 
2033b179d48bSDaniel Bristot de Oliveira 	return retval;
2034b179d48bSDaniel Bristot de Oliveira }
2035b179d48bSDaniel Bristot de Oliveira 
2036b179d48bSDaniel Bristot de Oliveira /*
2037bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_read - Read function for reading the "cpus" file
2038bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
2039bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The userspace provided buffer to read value into
2040bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to read
2041bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current "file" position
2042bce29ac9SDaniel Bristot de Oliveira  *
2043bce29ac9SDaniel Bristot de Oliveira  * Prints the "cpus" output into the user-provided buffer.
2044bce29ac9SDaniel Bristot de Oliveira  */
2045bce29ac9SDaniel Bristot de Oliveira static ssize_t
2046bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_read(struct file *filp, char __user *ubuf, size_t count,
2047bce29ac9SDaniel Bristot de Oliveira 		  loff_t *ppos)
2048bce29ac9SDaniel Bristot de Oliveira {
2049bce29ac9SDaniel Bristot de Oliveira 	char *mask_str;
2050bce29ac9SDaniel Bristot de Oliveira 	int len;
2051bce29ac9SDaniel Bristot de Oliveira 
2052bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2053bce29ac9SDaniel Bristot de Oliveira 
2054bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(NULL, 0, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask)) + 1;
2055bce29ac9SDaniel Bristot de Oliveira 	mask_str = kmalloc(len, GFP_KERNEL);
2056bce29ac9SDaniel Bristot de Oliveira 	if (!mask_str) {
2057bce29ac9SDaniel Bristot de Oliveira 		count = -ENOMEM;
2058bce29ac9SDaniel Bristot de Oliveira 		goto out_unlock;
2059bce29ac9SDaniel Bristot de Oliveira 	}
2060bce29ac9SDaniel Bristot de Oliveira 
2061bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(mask_str, len, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask));
2062bce29ac9SDaniel Bristot de Oliveira 	if (len >= count) {
2063bce29ac9SDaniel Bristot de Oliveira 		count = -EINVAL;
2064bce29ac9SDaniel Bristot de Oliveira 		goto out_free;
2065bce29ac9SDaniel Bristot de Oliveira 	}
2066bce29ac9SDaniel Bristot de Oliveira 
2067bce29ac9SDaniel Bristot de Oliveira 	count = simple_read_from_buffer(ubuf, count, ppos, mask_str, len);
2068bce29ac9SDaniel Bristot de Oliveira 
2069bce29ac9SDaniel Bristot de Oliveira out_free:
2070bce29ac9SDaniel Bristot de Oliveira 	kfree(mask_str);
2071bce29ac9SDaniel Bristot de Oliveira out_unlock:
2072bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2073bce29ac9SDaniel Bristot de Oliveira 
2074bce29ac9SDaniel Bristot de Oliveira 	return count;
2075bce29ac9SDaniel Bristot de Oliveira }
2076bce29ac9SDaniel Bristot de Oliveira 
2077bce29ac9SDaniel Bristot de Oliveira /*
2078bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_write - Write function for "cpus" entry
2079bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
2080bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The user buffer that contains the value to write
2081bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to write to "file"
2082bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current position in @file
2083bce29ac9SDaniel Bristot de Oliveira  *
2084bce29ac9SDaniel Bristot de Oliveira  * This function provides a write implementation for the "cpus"
2085bce29ac9SDaniel Bristot de Oliveira  * interface to the osnoise trace. By default, it lists all  CPUs,
2086bce29ac9SDaniel Bristot de Oliveira  * in this way, allowing osnoise threads to run on any online CPU
2087bce29ac9SDaniel Bristot de Oliveira  * of the system. It serves to restrict the execution of osnoise to the
208866df27f1SDaniel Bristot de Oliveira  * set of CPUs writing via this interface. Why not use "tracing_cpumask"?
208966df27f1SDaniel Bristot de Oliveira  * Because the user might be interested in tracing what is running on
209066df27f1SDaniel Bristot de Oliveira  * other CPUs. For instance, one might run osnoise in one HT CPU
209166df27f1SDaniel Bristot de Oliveira  * while observing what is running on the sibling HT CPU.
2092bce29ac9SDaniel Bristot de Oliveira  */
2093bce29ac9SDaniel Bristot de Oliveira static ssize_t
2094bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_write(struct file *filp, const char __user *ubuf, size_t count,
2095bce29ac9SDaniel Bristot de Oliveira 		   loff_t *ppos)
2096bce29ac9SDaniel Bristot de Oliveira {
2097bce29ac9SDaniel Bristot de Oliveira 	cpumask_var_t osnoise_cpumask_new;
2098bce29ac9SDaniel Bristot de Oliveira 	int running, err;
2099bce29ac9SDaniel Bristot de Oliveira 	char buf[256];
2100bce29ac9SDaniel Bristot de Oliveira 
2101bce29ac9SDaniel Bristot de Oliveira 	if (count >= 256)
2102bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
2103bce29ac9SDaniel Bristot de Oliveira 
2104bce29ac9SDaniel Bristot de Oliveira 	if (copy_from_user(buf, ubuf, count))
2105bce29ac9SDaniel Bristot de Oliveira 		return -EFAULT;
2106bce29ac9SDaniel Bristot de Oliveira 
2107bce29ac9SDaniel Bristot de Oliveira 	if (!zalloc_cpumask_var(&osnoise_cpumask_new, GFP_KERNEL))
2108bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
2109bce29ac9SDaniel Bristot de Oliveira 
2110bce29ac9SDaniel Bristot de Oliveira 	err = cpulist_parse(buf, osnoise_cpumask_new);
2111bce29ac9SDaniel Bristot de Oliveira 	if (err)
2112bce29ac9SDaniel Bristot de Oliveira 		goto err_free;
2113bce29ac9SDaniel Bristot de Oliveira 
2114bce29ac9SDaniel Bristot de Oliveira 	/*
2115dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock is taken to avoid concurrency on start/stop.
2116bce29ac9SDaniel Bristot de Oliveira 	 */
2117bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
2118dae18134SDaniel Bristot de Oliveira 	running = osnoise_has_registered_instances();
2119bce29ac9SDaniel Bristot de Oliveira 	if (running)
21202bd1bdf0SDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
2121bce29ac9SDaniel Bristot de Oliveira 
2122bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2123c8895e27SDaniel Bristot de Oliveira 	/*
2124c8895e27SDaniel Bristot de Oliveira 	 * osnoise_cpumask is read by CPU hotplug operations.
2125c8895e27SDaniel Bristot de Oliveira 	 */
212699c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
2127c8895e27SDaniel Bristot de Oliveira 
2128bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, osnoise_cpumask_new);
2129c8895e27SDaniel Bristot de Oliveira 
213099c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
2131bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2132bce29ac9SDaniel Bristot de Oliveira 
2133bce29ac9SDaniel Bristot de Oliveira 	if (running)
21342bd1bdf0SDaniel Bristot de Oliveira 		start_per_cpu_kthreads();
2135bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
2136bce29ac9SDaniel Bristot de Oliveira 
2137bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
2138bce29ac9SDaniel Bristot de Oliveira 	return count;
2139bce29ac9SDaniel Bristot de Oliveira 
2140bce29ac9SDaniel Bristot de Oliveira err_free:
2141bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
2142bce29ac9SDaniel Bristot de Oliveira 
2143bce29ac9SDaniel Bristot de Oliveira 	return err;
2144bce29ac9SDaniel Bristot de Oliveira }
2145bce29ac9SDaniel Bristot de Oliveira 
2146bce29ac9SDaniel Bristot de Oliveira /*
2147bce29ac9SDaniel Bristot de Oliveira  * osnoise/runtime_us: cannot be greater than the period.
2148bce29ac9SDaniel Bristot de Oliveira  */
2149bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_runtime = {
2150bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2151bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_runtime,
2152bce29ac9SDaniel Bristot de Oliveira 	.max	= &osnoise_data.sample_period,
2153bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2154bce29ac9SDaniel Bristot de Oliveira };
2155bce29ac9SDaniel Bristot de Oliveira 
2156bce29ac9SDaniel Bristot de Oliveira /*
2157bce29ac9SDaniel Bristot de Oliveira  * osnoise/period_us: cannot be smaller than the runtime.
2158bce29ac9SDaniel Bristot de Oliveira  */
2159bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_period = {
2160bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2161bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_period,
2162bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2163bce29ac9SDaniel Bristot de Oliveira 	.min	= &osnoise_data.sample_runtime,
2164bce29ac9SDaniel Bristot de Oliveira };
2165bce29ac9SDaniel Bristot de Oliveira 
2166bce29ac9SDaniel Bristot de Oliveira /*
2167bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_us: no limit.
2168bce29ac9SDaniel Bristot de Oliveira  */
2169bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_in = {
2170bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2171bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing,
2172bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2173bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2174bce29ac9SDaniel Bristot de Oliveira };
2175bce29ac9SDaniel Bristot de Oliveira 
2176bce29ac9SDaniel Bristot de Oliveira /*
2177bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_total_us: no limit.
2178bce29ac9SDaniel Bristot de Oliveira  */
2179bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_total = {
2180bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2181bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing_total,
2182bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2183bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2184bce29ac9SDaniel Bristot de Oliveira };
2185bce29ac9SDaniel Bristot de Oliveira 
2186a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2187a955d7eaSDaniel Bristot de Oliveira /*
2188a955d7eaSDaniel Bristot de Oliveira  * osnoise/print_stack: print the stacktrace of the IRQ handler if the total
2189a955d7eaSDaniel Bristot de Oliveira  * latency is higher than val.
2190a955d7eaSDaniel Bristot de Oliveira  */
2191a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_print_stack = {
2192a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2193a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.print_stack,
2194a955d7eaSDaniel Bristot de Oliveira 	.max	= NULL,
2195a955d7eaSDaniel Bristot de Oliveira 	.min	= NULL,
2196a955d7eaSDaniel Bristot de Oliveira };
2197a955d7eaSDaniel Bristot de Oliveira 
2198a955d7eaSDaniel Bristot de Oliveira /*
2199a955d7eaSDaniel Bristot de Oliveira  * osnoise/timerlat_period: min 100 us, max 1 s
2200a955d7eaSDaniel Bristot de Oliveira  */
2201a955d7eaSDaniel Bristot de Oliveira u64 timerlat_min_period = 100;
2202a955d7eaSDaniel Bristot de Oliveira u64 timerlat_max_period = 1000000;
2203a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param timerlat_period = {
2204a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2205a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.timerlat_period,
2206a955d7eaSDaniel Bristot de Oliveira 	.max	= &timerlat_max_period,
2207a955d7eaSDaniel Bristot de Oliveira 	.min	= &timerlat_min_period,
2208a955d7eaSDaniel Bristot de Oliveira };
2209a955d7eaSDaniel Bristot de Oliveira #endif
2210a955d7eaSDaniel Bristot de Oliveira 
2211bce29ac9SDaniel Bristot de Oliveira static const struct file_operations cpus_fops = {
2212bce29ac9SDaniel Bristot de Oliveira 	.open		= tracing_open_generic,
2213bce29ac9SDaniel Bristot de Oliveira 	.read		= osnoise_cpus_read,
2214bce29ac9SDaniel Bristot de Oliveira 	.write		= osnoise_cpus_write,
2215bce29ac9SDaniel Bristot de Oliveira 	.llseek		= generic_file_llseek,
2216bce29ac9SDaniel Bristot de Oliveira };
2217bce29ac9SDaniel Bristot de Oliveira 
2218b179d48bSDaniel Bristot de Oliveira static const struct file_operations osnoise_options_fops = {
2219b179d48bSDaniel Bristot de Oliveira 	.open		= osnoise_options_open,
2220b179d48bSDaniel Bristot de Oliveira 	.read		= seq_read,
2221b179d48bSDaniel Bristot de Oliveira 	.llseek		= seq_lseek,
2222b179d48bSDaniel Bristot de Oliveira 	.release	= seq_release,
2223b179d48bSDaniel Bristot de Oliveira 	.write		= osnoise_options_write
2224b179d48bSDaniel Bristot de Oliveira };
2225b179d48bSDaniel Bristot de Oliveira 
2226ccb67544SDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2227b14f4568SDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
2228b14f4568SDaniel Bristot de Oliveira static int init_timerlat_stack_tracefs(struct dentry *top_dir)
2229b14f4568SDaniel Bristot de Oliveira {
2230b14f4568SDaniel Bristot de Oliveira 	struct dentry *tmp;
2231b14f4568SDaniel Bristot de Oliveira 
2232b14f4568SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("print_stack", TRACE_MODE_WRITE, top_dir,
2233b14f4568SDaniel Bristot de Oliveira 				  &osnoise_print_stack, &trace_min_max_fops);
2234b14f4568SDaniel Bristot de Oliveira 	if (!tmp)
2235b14f4568SDaniel Bristot de Oliveira 		return -ENOMEM;
2236b14f4568SDaniel Bristot de Oliveira 
2237b14f4568SDaniel Bristot de Oliveira 	return 0;
2238b14f4568SDaniel Bristot de Oliveira }
2239b14f4568SDaniel Bristot de Oliveira #else /* CONFIG_STACKTRACE */
2240b14f4568SDaniel Bristot de Oliveira static int init_timerlat_stack_tracefs(struct dentry *top_dir)
2241b14f4568SDaniel Bristot de Oliveira {
2242b14f4568SDaniel Bristot de Oliveira 	return 0;
2243b14f4568SDaniel Bristot de Oliveira }
2244b14f4568SDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
2245b14f4568SDaniel Bristot de Oliveira 
2246ccb67544SDaniel Bristot de Oliveira /*
2247ccb67544SDaniel Bristot de Oliveira  * init_timerlat_tracefs - A function to initialize the timerlat interface files
2248ccb67544SDaniel Bristot de Oliveira  */
2249ccb67544SDaniel Bristot de Oliveira static int init_timerlat_tracefs(struct dentry *top_dir)
2250ccb67544SDaniel Bristot de Oliveira {
2251ccb67544SDaniel Bristot de Oliveira 	struct dentry *tmp;
2252ccb67544SDaniel Bristot de Oliveira 
2253ccb67544SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("timerlat_period_us", TRACE_MODE_WRITE, top_dir,
2254ccb67544SDaniel Bristot de Oliveira 				  &timerlat_period, &trace_min_max_fops);
2255ccb67544SDaniel Bristot de Oliveira 	if (!tmp)
2256ccb67544SDaniel Bristot de Oliveira 		return -ENOMEM;
2257ccb67544SDaniel Bristot de Oliveira 
2258b14f4568SDaniel Bristot de Oliveira 	return init_timerlat_stack_tracefs(top_dir);
2259ccb67544SDaniel Bristot de Oliveira }
2260ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
2261ccb67544SDaniel Bristot de Oliveira static int init_timerlat_tracefs(struct dentry *top_dir)
2262ccb67544SDaniel Bristot de Oliveira {
2263ccb67544SDaniel Bristot de Oliveira 	return 0;
2264ccb67544SDaniel Bristot de Oliveira }
2265ccb67544SDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
2266ccb67544SDaniel Bristot de Oliveira 
2267bce29ac9SDaniel Bristot de Oliveira /*
2268bce29ac9SDaniel Bristot de Oliveira  * init_tracefs - A function to initialize the tracefs interface files
2269bce29ac9SDaniel Bristot de Oliveira  *
2270a955d7eaSDaniel Bristot de Oliveira  * This function creates entries in tracefs for "osnoise" and "timerlat".
2271a955d7eaSDaniel Bristot de Oliveira  * It creates these directories in the tracing directory, and within that
2272a955d7eaSDaniel Bristot de Oliveira  * directory the use can change and view the configs.
2273bce29ac9SDaniel Bristot de Oliveira  */
2274bce29ac9SDaniel Bristot de Oliveira static int init_tracefs(void)
2275bce29ac9SDaniel Bristot de Oliveira {
2276bce29ac9SDaniel Bristot de Oliveira 	struct dentry *top_dir;
2277bce29ac9SDaniel Bristot de Oliveira 	struct dentry *tmp;
2278bce29ac9SDaniel Bristot de Oliveira 	int ret;
2279bce29ac9SDaniel Bristot de Oliveira 
2280bce29ac9SDaniel Bristot de Oliveira 	ret = tracing_init_dentry();
2281bce29ac9SDaniel Bristot de Oliveira 	if (ret)
2282bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
2283bce29ac9SDaniel Bristot de Oliveira 
2284bce29ac9SDaniel Bristot de Oliveira 	top_dir = tracefs_create_dir("osnoise", NULL);
2285bce29ac9SDaniel Bristot de Oliveira 	if (!top_dir)
2286a955d7eaSDaniel Bristot de Oliveira 		return 0;
2287bce29ac9SDaniel Bristot de Oliveira 
228821ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("period_us", TRACE_MODE_WRITE, top_dir,
2289bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_period, &trace_min_max_fops);
2290bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2291bce29ac9SDaniel Bristot de Oliveira 		goto err;
2292bce29ac9SDaniel Bristot de Oliveira 
229321ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("runtime_us", TRACE_MODE_WRITE, top_dir,
2294bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_runtime, &trace_min_max_fops);
2295bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2296bce29ac9SDaniel Bristot de Oliveira 		goto err;
2297bce29ac9SDaniel Bristot de Oliveira 
229821ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("stop_tracing_us", TRACE_MODE_WRITE, top_dir,
2299bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_in, &trace_min_max_fops);
2300bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2301bce29ac9SDaniel Bristot de Oliveira 		goto err;
2302bce29ac9SDaniel Bristot de Oliveira 
230321ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("stop_tracing_total_us", TRACE_MODE_WRITE, top_dir,
2304bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_total, &trace_min_max_fops);
2305bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2306bce29ac9SDaniel Bristot de Oliveira 		goto err;
2307bce29ac9SDaniel Bristot de Oliveira 
230821ccc9cdSSteven Rostedt (VMware) 	tmp = trace_create_file("cpus", TRACE_MODE_WRITE, top_dir, NULL, &cpus_fops);
2309bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2310bce29ac9SDaniel Bristot de Oliveira 		goto err;
2311a955d7eaSDaniel Bristot de Oliveira 
2312b179d48bSDaniel Bristot de Oliveira 	tmp = trace_create_file("options", TRACE_MODE_WRITE, top_dir, NULL,
2313b179d48bSDaniel Bristot de Oliveira 				&osnoise_options_fops);
2314b179d48bSDaniel Bristot de Oliveira 	if (!tmp)
2315b179d48bSDaniel Bristot de Oliveira 		goto err;
2316b179d48bSDaniel Bristot de Oliveira 
2317ccb67544SDaniel Bristot de Oliveira 	ret = init_timerlat_tracefs(top_dir);
2318ccb67544SDaniel Bristot de Oliveira 	if (ret)
2319a955d7eaSDaniel Bristot de Oliveira 		goto err;
2320bce29ac9SDaniel Bristot de Oliveira 
2321bce29ac9SDaniel Bristot de Oliveira 	return 0;
2322bce29ac9SDaniel Bristot de Oliveira 
2323bce29ac9SDaniel Bristot de Oliveira err:
2324bce29ac9SDaniel Bristot de Oliveira 	tracefs_remove(top_dir);
2325bce29ac9SDaniel Bristot de Oliveira 	return -ENOMEM;
2326bce29ac9SDaniel Bristot de Oliveira }
2327bce29ac9SDaniel Bristot de Oliveira 
2328bce29ac9SDaniel Bristot de Oliveira static int osnoise_hook_events(void)
2329bce29ac9SDaniel Bristot de Oliveira {
2330bce29ac9SDaniel Bristot de Oliveira 	int retval;
2331bce29ac9SDaniel Bristot de Oliveira 
2332bce29ac9SDaniel Bristot de Oliveira 	/*
2333bce29ac9SDaniel Bristot de Oliveira 	 * Trace is already hooked, we are re-enabling from
2334bce29ac9SDaniel Bristot de Oliveira 	 * a stop_tracing_*.
2335bce29ac9SDaniel Bristot de Oliveira 	 */
2336bce29ac9SDaniel Bristot de Oliveira 	if (trace_osnoise_callback_enabled)
2337bce29ac9SDaniel Bristot de Oliveira 		return 0;
2338bce29ac9SDaniel Bristot de Oliveira 
2339bce29ac9SDaniel Bristot de Oliveira 	retval = hook_irq_events();
2340bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2341bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
2342bce29ac9SDaniel Bristot de Oliveira 
2343bce29ac9SDaniel Bristot de Oliveira 	retval = hook_softirq_events();
2344bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2345bce29ac9SDaniel Bristot de Oliveira 		goto out_unhook_irq;
2346bce29ac9SDaniel Bristot de Oliveira 
2347bce29ac9SDaniel Bristot de Oliveira 	retval = hook_thread_events();
2348bce29ac9SDaniel Bristot de Oliveira 	/*
2349bce29ac9SDaniel Bristot de Oliveira 	 * All fine!
2350bce29ac9SDaniel Bristot de Oliveira 	 */
2351bce29ac9SDaniel Bristot de Oliveira 	if (!retval)
2352bce29ac9SDaniel Bristot de Oliveira 		return 0;
2353bce29ac9SDaniel Bristot de Oliveira 
2354bce29ac9SDaniel Bristot de Oliveira 	unhook_softirq_events();
2355bce29ac9SDaniel Bristot de Oliveira out_unhook_irq:
2356bce29ac9SDaniel Bristot de Oliveira 	unhook_irq_events();
2357bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
2358bce29ac9SDaniel Bristot de Oliveira }
2359bce29ac9SDaniel Bristot de Oliveira 
23600878355bSNikita Yushchenko static void osnoise_unhook_events(void)
23610878355bSNikita Yushchenko {
23620878355bSNikita Yushchenko 	unhook_thread_events();
23630878355bSNikita Yushchenko 	unhook_softirq_events();
23640878355bSNikita Yushchenko 	unhook_irq_events();
23650878355bSNikita Yushchenko }
23660878355bSNikita Yushchenko 
236715ca4bdbSDaniel Bristot de Oliveira /*
236815ca4bdbSDaniel Bristot de Oliveira  * osnoise_workload_start - start the workload and hook to events
236915ca4bdbSDaniel Bristot de Oliveira  */
237015ca4bdbSDaniel Bristot de Oliveira static int osnoise_workload_start(void)
2371bce29ac9SDaniel Bristot de Oliveira {
2372bce29ac9SDaniel Bristot de Oliveira 	int retval;
2373bce29ac9SDaniel Bristot de Oliveira 
23742fac8d64SDaniel Bristot de Oliveira 	/*
23752fac8d64SDaniel Bristot de Oliveira 	 * Instances need to be registered after calling workload
23762fac8d64SDaniel Bristot de Oliveira 	 * start. Hence, if there is already an instance, the
23772fac8d64SDaniel Bristot de Oliveira 	 * workload was already registered. Otherwise, this
23782fac8d64SDaniel Bristot de Oliveira 	 * code is on the way to register the first instance,
23792fac8d64SDaniel Bristot de Oliveira 	 * and the workload will start.
23802fac8d64SDaniel Bristot de Oliveira 	 */
23812fac8d64SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances())
23822fac8d64SDaniel Bristot de Oliveira 		return 0;
23832fac8d64SDaniel Bristot de Oliveira 
2384bce29ac9SDaniel Bristot de Oliveira 	osn_var_reset_all();
2385bce29ac9SDaniel Bristot de Oliveira 
2386bce29ac9SDaniel Bristot de Oliveira 	retval = osnoise_hook_events();
2387bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2388a955d7eaSDaniel Bristot de Oliveira 		return retval;
2389c3b6343cSDaniel Bristot de Oliveira 
2390bce29ac9SDaniel Bristot de Oliveira 	/*
2391c3b6343cSDaniel Bristot de Oliveira 	 * Make sure that ftrace_nmi_enter/exit() see reset values
2392c3b6343cSDaniel Bristot de Oliveira 	 * before enabling trace_osnoise_callback_enabled.
2393bce29ac9SDaniel Bristot de Oliveira 	 */
2394bce29ac9SDaniel Bristot de Oliveira 	barrier();
2395bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = true;
2396bce29ac9SDaniel Bristot de Oliveira 
239715ca4bdbSDaniel Bristot de Oliveira 	retval = start_per_cpu_kthreads();
2398a955d7eaSDaniel Bristot de Oliveira 	if (retval) {
23990878355bSNikita Yushchenko 		trace_osnoise_callback_enabled = false;
24000878355bSNikita Yushchenko 		/*
24010878355bSNikita Yushchenko 		 * Make sure that ftrace_nmi_enter/exit() see
24020878355bSNikita Yushchenko 		 * trace_osnoise_callback_enabled as false before continuing.
24030878355bSNikita Yushchenko 		 */
24040878355bSNikita Yushchenko 		barrier();
24050878355bSNikita Yushchenko 
24060878355bSNikita Yushchenko 		osnoise_unhook_events();
2407a955d7eaSDaniel Bristot de Oliveira 		return retval;
2408a955d7eaSDaniel Bristot de Oliveira 	}
2409a955d7eaSDaniel Bristot de Oliveira 
2410a955d7eaSDaniel Bristot de Oliveira 	return 0;
2411a955d7eaSDaniel Bristot de Oliveira }
2412a955d7eaSDaniel Bristot de Oliveira 
241315ca4bdbSDaniel Bristot de Oliveira /*
241415ca4bdbSDaniel Bristot de Oliveira  * osnoise_workload_stop - stop the workload and unhook the events
241515ca4bdbSDaniel Bristot de Oliveira  */
241615ca4bdbSDaniel Bristot de Oliveira static void osnoise_workload_stop(void)
2417bce29ac9SDaniel Bristot de Oliveira {
24182fac8d64SDaniel Bristot de Oliveira 	/*
24192fac8d64SDaniel Bristot de Oliveira 	 * Instances need to be unregistered before calling
24202fac8d64SDaniel Bristot de Oliveira 	 * stop. Hence, if there is a registered instance, more
24212fac8d64SDaniel Bristot de Oliveira 	 * than one instance is running, and the workload will not
24222fac8d64SDaniel Bristot de Oliveira 	 * yet stop. Otherwise, this code is on the way to disable
24232fac8d64SDaniel Bristot de Oliveira 	 * the last instance, and the workload can stop.
24242fac8d64SDaniel Bristot de Oliveira 	 */
2425dae18134SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances())
2426bce29ac9SDaniel Bristot de Oliveira 		return;
2427bce29ac9SDaniel Bristot de Oliveira 
2428f0cfe17bSDaniel Bristot de Oliveira 	/*
2429f0cfe17bSDaniel Bristot de Oliveira 	 * If callbacks were already disabled in a previous stop
2430f0cfe17bSDaniel Bristot de Oliveira 	 * call, there is no need to disable then again.
2431f0cfe17bSDaniel Bristot de Oliveira 	 *
2432f0cfe17bSDaniel Bristot de Oliveira 	 * For instance, this happens when tracing is stopped via:
2433f0cfe17bSDaniel Bristot de Oliveira 	 * echo 0 > tracing_on
2434f0cfe17bSDaniel Bristot de Oliveira 	 * echo nop > current_tracer.
2435f0cfe17bSDaniel Bristot de Oliveira 	 */
2436f0cfe17bSDaniel Bristot de Oliveira 	if (!trace_osnoise_callback_enabled)
2437f0cfe17bSDaniel Bristot de Oliveira 		return;
2438f0cfe17bSDaniel Bristot de Oliveira 
2439bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = false;
2440c3b6343cSDaniel Bristot de Oliveira 	/*
2441c3b6343cSDaniel Bristot de Oliveira 	 * Make sure that ftrace_nmi_enter/exit() see
2442c3b6343cSDaniel Bristot de Oliveira 	 * trace_osnoise_callback_enabled as false before continuing.
2443c3b6343cSDaniel Bristot de Oliveira 	 */
2444bce29ac9SDaniel Bristot de Oliveira 	barrier();
2445bce29ac9SDaniel Bristot de Oliveira 
2446bce29ac9SDaniel Bristot de Oliveira 	stop_per_cpu_kthreads();
2447bce29ac9SDaniel Bristot de Oliveira 
24480878355bSNikita Yushchenko 	osnoise_unhook_events();
2449bce29ac9SDaniel Bristot de Oliveira }
2450bce29ac9SDaniel Bristot de Oliveira 
245115ca4bdbSDaniel Bristot de Oliveira static void osnoise_tracer_start(struct trace_array *tr)
245215ca4bdbSDaniel Bristot de Oliveira {
245315ca4bdbSDaniel Bristot de Oliveira 	int retval;
245415ca4bdbSDaniel Bristot de Oliveira 
24552fac8d64SDaniel Bristot de Oliveira 	/*
24562fac8d64SDaniel Bristot de Oliveira 	 * If the instance is already registered, there is no need to
24572fac8d64SDaniel Bristot de Oliveira 	 * register it again.
24582fac8d64SDaniel Bristot de Oliveira 	 */
24592fac8d64SDaniel Bristot de Oliveira 	if (osnoise_instance_registered(tr))
246015ca4bdbSDaniel Bristot de Oliveira 		return;
246115ca4bdbSDaniel Bristot de Oliveira 
246215ca4bdbSDaniel Bristot de Oliveira 	retval = osnoise_workload_start();
246315ca4bdbSDaniel Bristot de Oliveira 	if (retval)
246415ca4bdbSDaniel Bristot de Oliveira 		pr_err(BANNER "Error starting osnoise tracer\n");
246515ca4bdbSDaniel Bristot de Oliveira 
2466dae18134SDaniel Bristot de Oliveira 	osnoise_register_instance(tr);
246715ca4bdbSDaniel Bristot de Oliveira }
246815ca4bdbSDaniel Bristot de Oliveira 
246915ca4bdbSDaniel Bristot de Oliveira static void osnoise_tracer_stop(struct trace_array *tr)
247015ca4bdbSDaniel Bristot de Oliveira {
2471dae18134SDaniel Bristot de Oliveira 	osnoise_unregister_instance(tr);
247215ca4bdbSDaniel Bristot de Oliveira 	osnoise_workload_stop();
247315ca4bdbSDaniel Bristot de Oliveira }
247415ca4bdbSDaniel Bristot de Oliveira 
2475bce29ac9SDaniel Bristot de Oliveira static int osnoise_tracer_init(struct trace_array *tr)
2476bce29ac9SDaniel Bristot de Oliveira {
24772fac8d64SDaniel Bristot de Oliveira 	/*
24782fac8d64SDaniel Bristot de Oliveira 	 * Only allow osnoise tracer if timerlat tracer is not running
24792fac8d64SDaniel Bristot de Oliveira 	 * already.
24802fac8d64SDaniel Bristot de Oliveira 	 */
24812fac8d64SDaniel Bristot de Oliveira 	if (timerlat_enabled())
2482bce29ac9SDaniel Bristot de Oliveira 		return -EBUSY;
2483bce29ac9SDaniel Bristot de Oliveira 
2484bce29ac9SDaniel Bristot de Oliveira 	tr->max_latency = 0;
2485bce29ac9SDaniel Bristot de Oliveira 
2486bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_start(tr);
2487bce29ac9SDaniel Bristot de Oliveira 	return 0;
2488bce29ac9SDaniel Bristot de Oliveira }
2489bce29ac9SDaniel Bristot de Oliveira 
2490bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_reset(struct trace_array *tr)
2491bce29ac9SDaniel Bristot de Oliveira {
2492bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_stop(tr);
2493bce29ac9SDaniel Bristot de Oliveira }
2494bce29ac9SDaniel Bristot de Oliveira 
2495bce29ac9SDaniel Bristot de Oliveira static struct tracer osnoise_tracer __read_mostly = {
2496bce29ac9SDaniel Bristot de Oliveira 	.name		= "osnoise",
2497bce29ac9SDaniel Bristot de Oliveira 	.init		= osnoise_tracer_init,
2498bce29ac9SDaniel Bristot de Oliveira 	.reset		= osnoise_tracer_reset,
2499bce29ac9SDaniel Bristot de Oliveira 	.start		= osnoise_tracer_start,
2500bce29ac9SDaniel Bristot de Oliveira 	.stop		= osnoise_tracer_stop,
2501bce29ac9SDaniel Bristot de Oliveira 	.print_header	= print_osnoise_headers,
2502bce29ac9SDaniel Bristot de Oliveira 	.allow_instances = true,
2503bce29ac9SDaniel Bristot de Oliveira };
2504bce29ac9SDaniel Bristot de Oliveira 
2505a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2506a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_start(struct trace_array *tr)
2507a955d7eaSDaniel Bristot de Oliveira {
2508a955d7eaSDaniel Bristot de Oliveira 	int retval;
2509a955d7eaSDaniel Bristot de Oliveira 
25102fac8d64SDaniel Bristot de Oliveira 	/*
25112fac8d64SDaniel Bristot de Oliveira 	 * If the instance is already registered, there is no need to
25122fac8d64SDaniel Bristot de Oliveira 	 * register it again.
25132fac8d64SDaniel Bristot de Oliveira 	 */
25142fac8d64SDaniel Bristot de Oliveira 	if (osnoise_instance_registered(tr))
2515a955d7eaSDaniel Bristot de Oliveira 		return;
2516a955d7eaSDaniel Bristot de Oliveira 
251715ca4bdbSDaniel Bristot de Oliveira 	retval = osnoise_workload_start();
2518a955d7eaSDaniel Bristot de Oliveira 	if (retval)
25192fac8d64SDaniel Bristot de Oliveira 		pr_err(BANNER "Error starting timerlat tracer\n");
2520a955d7eaSDaniel Bristot de Oliveira 
2521dae18134SDaniel Bristot de Oliveira 	osnoise_register_instance(tr);
2522dae18134SDaniel Bristot de Oliveira 
2523a955d7eaSDaniel Bristot de Oliveira 	return;
2524a955d7eaSDaniel Bristot de Oliveira }
2525a955d7eaSDaniel Bristot de Oliveira 
2526a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_stop(struct trace_array *tr)
2527a955d7eaSDaniel Bristot de Oliveira {
2528a955d7eaSDaniel Bristot de Oliveira 	int cpu;
2529a955d7eaSDaniel Bristot de Oliveira 
25302fac8d64SDaniel Bristot de Oliveira 	osnoise_unregister_instance(tr);
2531a955d7eaSDaniel Bristot de Oliveira 
25322fac8d64SDaniel Bristot de Oliveira 	/*
25332fac8d64SDaniel Bristot de Oliveira 	 * Instruct the threads to stop only if this is the last instance.
25342fac8d64SDaniel Bristot de Oliveira 	 */
25352fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances()) {
2536a955d7eaSDaniel Bristot de Oliveira 		for_each_online_cpu(cpu)
2537a955d7eaSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = 0;
25382fac8d64SDaniel Bristot de Oliveira 	}
2539a955d7eaSDaniel Bristot de Oliveira 
25402fac8d64SDaniel Bristot de Oliveira 	osnoise_workload_stop();
2541a955d7eaSDaniel Bristot de Oliveira }
2542a955d7eaSDaniel Bristot de Oliveira 
2543a955d7eaSDaniel Bristot de Oliveira static int timerlat_tracer_init(struct trace_array *tr)
2544a955d7eaSDaniel Bristot de Oliveira {
25452fac8d64SDaniel Bristot de Oliveira 	/*
25462fac8d64SDaniel Bristot de Oliveira 	 * Only allow timerlat tracer if osnoise tracer is not running already.
25472fac8d64SDaniel Bristot de Oliveira 	 */
25482fac8d64SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances() && !osnoise_data.timerlat_tracer)
2549a955d7eaSDaniel Bristot de Oliveira 		return -EBUSY;
2550a955d7eaSDaniel Bristot de Oliveira 
25512fac8d64SDaniel Bristot de Oliveira 	/*
25522fac8d64SDaniel Bristot de Oliveira 	 * If this is the first instance, set timerlat_tracer to block
25532fac8d64SDaniel Bristot de Oliveira 	 * osnoise tracer start.
25542fac8d64SDaniel Bristot de Oliveira 	 */
25552fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
25562fac8d64SDaniel Bristot de Oliveira 		osnoise_data.timerlat_tracer = 1;
2557a955d7eaSDaniel Bristot de Oliveira 
25582fac8d64SDaniel Bristot de Oliveira 	tr->max_latency = 0;
2559a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_start(tr);
2560a955d7eaSDaniel Bristot de Oliveira 
2561a955d7eaSDaniel Bristot de Oliveira 	return 0;
2562a955d7eaSDaniel Bristot de Oliveira }
2563a955d7eaSDaniel Bristot de Oliveira 
2564a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_reset(struct trace_array *tr)
2565a955d7eaSDaniel Bristot de Oliveira {
2566a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_stop(tr);
25672fac8d64SDaniel Bristot de Oliveira 
25682fac8d64SDaniel Bristot de Oliveira 	/*
25692fac8d64SDaniel Bristot de Oliveira 	 * If this is the last instance, reset timerlat_tracer allowing
25702fac8d64SDaniel Bristot de Oliveira 	 * osnoise to be started.
25712fac8d64SDaniel Bristot de Oliveira 	 */
25722fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
25732fac8d64SDaniel Bristot de Oliveira 		osnoise_data.timerlat_tracer = 0;
2574a955d7eaSDaniel Bristot de Oliveira }
2575a955d7eaSDaniel Bristot de Oliveira 
2576a955d7eaSDaniel Bristot de Oliveira static struct tracer timerlat_tracer __read_mostly = {
2577a955d7eaSDaniel Bristot de Oliveira 	.name		= "timerlat",
2578a955d7eaSDaniel Bristot de Oliveira 	.init		= timerlat_tracer_init,
2579a955d7eaSDaniel Bristot de Oliveira 	.reset		= timerlat_tracer_reset,
2580a955d7eaSDaniel Bristot de Oliveira 	.start		= timerlat_tracer_start,
2581a955d7eaSDaniel Bristot de Oliveira 	.stop		= timerlat_tracer_stop,
2582a955d7eaSDaniel Bristot de Oliveira 	.print_header	= print_timerlat_headers,
2583a955d7eaSDaniel Bristot de Oliveira 	.allow_instances = true,
2584a955d7eaSDaniel Bristot de Oliveira };
2585ccb67544SDaniel Bristot de Oliveira 
2586ccb67544SDaniel Bristot de Oliveira __init static int init_timerlat_tracer(void)
2587ccb67544SDaniel Bristot de Oliveira {
2588ccb67544SDaniel Bristot de Oliveira 	return register_tracer(&timerlat_tracer);
2589ccb67544SDaniel Bristot de Oliveira }
2590ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
2591ccb67544SDaniel Bristot de Oliveira __init static int init_timerlat_tracer(void)
2592ccb67544SDaniel Bristot de Oliveira {
2593ccb67544SDaniel Bristot de Oliveira 	return 0;
2594ccb67544SDaniel Bristot de Oliveira }
2595a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
2596a955d7eaSDaniel Bristot de Oliveira 
2597bce29ac9SDaniel Bristot de Oliveira __init static int init_osnoise_tracer(void)
2598bce29ac9SDaniel Bristot de Oliveira {
2599bce29ac9SDaniel Bristot de Oliveira 	int ret;
2600bce29ac9SDaniel Bristot de Oliveira 
2601bce29ac9SDaniel Bristot de Oliveira 	mutex_init(&interface_lock);
2602bce29ac9SDaniel Bristot de Oliveira 
2603bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, cpu_all_mask);
2604bce29ac9SDaniel Bristot de Oliveira 
2605bce29ac9SDaniel Bristot de Oliveira 	ret = register_tracer(&osnoise_tracer);
2606a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
2607a955d7eaSDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering osnoise!\n");
2608bce29ac9SDaniel Bristot de Oliveira 		return ret;
2609a955d7eaSDaniel Bristot de Oliveira 	}
2610a955d7eaSDaniel Bristot de Oliveira 
2611ccb67544SDaniel Bristot de Oliveira 	ret = init_timerlat_tracer();
2612a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
2613ccb67544SDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering timerlat!\n");
2614a955d7eaSDaniel Bristot de Oliveira 		return ret;
2615a955d7eaSDaniel Bristot de Oliveira 	}
2616ccb67544SDaniel Bristot de Oliveira 
2617c8895e27SDaniel Bristot de Oliveira 	osnoise_init_hotplug_support();
2618bce29ac9SDaniel Bristot de Oliveira 
2619dae18134SDaniel Bristot de Oliveira 	INIT_LIST_HEAD_RCU(&osnoise_instances);
2620dae18134SDaniel Bristot de Oliveira 
2621bce29ac9SDaniel Bristot de Oliveira 	init_tracefs();
2622bce29ac9SDaniel Bristot de Oliveira 
2623bce29ac9SDaniel Bristot de Oliveira 	return 0;
2624bce29ac9SDaniel Bristot de Oliveira }
2625bce29ac9SDaniel Bristot de Oliveira late_initcall(init_osnoise_tracer);
2626