xref: /openbmc/linux/kernel/trace/trace_osnoise.c (revision cb7ca871c883eed5132e106cda44b2b060e6f52e)
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,
571603dda4SDaniel Bristot de Oliveira 	OSN_PANIC_ON_STOP,
58b5dce200SDaniel Bristot de Oliveira 	OSN_PREEMPT_DISABLE,
59b5dce200SDaniel Bristot de Oliveira 	OSN_IRQ_DISABLE,
60b179d48bSDaniel Bristot de Oliveira 	OSN_MAX
61b179d48bSDaniel Bristot de Oliveira };
62b179d48bSDaniel Bristot de Oliveira 
63b5dce200SDaniel Bristot de Oliveira static const char * const osnoise_options_str[OSN_MAX] = {
64b5dce200SDaniel Bristot de Oliveira 							"DEFAULTS",
65b5dce200SDaniel Bristot de Oliveira 							"OSNOISE_WORKLOAD",
66b5dce200SDaniel Bristot de Oliveira 							"PANIC_ON_STOP",
67b5dce200SDaniel Bristot de Oliveira 							"OSNOISE_PREEMPT_DISABLE",
68b5dce200SDaniel Bristot de Oliveira 							"OSNOISE_IRQ_DISABLE" };
69b179d48bSDaniel Bristot de Oliveira 
7030838fcdSDaniel Bristot de Oliveira #define OSN_DEFAULT_OPTIONS		0x2
71ec370890SDaniel Bristot de Oliveira static unsigned long osnoise_options	= OSN_DEFAULT_OPTIONS;
72b179d48bSDaniel Bristot de Oliveira 
73b179d48bSDaniel Bristot de Oliveira /*
74dae18134SDaniel Bristot de Oliveira  * trace_array of the enabled osnoise/timerlat instances.
75dae18134SDaniel Bristot de Oliveira  */
76dae18134SDaniel Bristot de Oliveira struct osnoise_instance {
77dae18134SDaniel Bristot de Oliveira 	struct list_head	list;
78dae18134SDaniel Bristot de Oliveira 	struct trace_array	*tr;
79dae18134SDaniel Bristot de Oliveira };
80d7458bc0SDaniel Bristot de Oliveira 
81d7458bc0SDaniel Bristot de Oliveira static struct list_head osnoise_instances;
82dae18134SDaniel Bristot de Oliveira 
83dae18134SDaniel Bristot de Oliveira static bool osnoise_has_registered_instances(void)
84dae18134SDaniel Bristot de Oliveira {
85dae18134SDaniel Bristot de Oliveira 	return !!list_first_or_null_rcu(&osnoise_instances,
86dae18134SDaniel Bristot de Oliveira 					struct osnoise_instance,
87dae18134SDaniel Bristot de Oliveira 					list);
88dae18134SDaniel Bristot de Oliveira }
89dae18134SDaniel Bristot de Oliveira 
90dae18134SDaniel Bristot de Oliveira /*
912fac8d64SDaniel Bristot de Oliveira  * osnoise_instance_registered - check if a tr is already registered
922fac8d64SDaniel Bristot de Oliveira  */
932fac8d64SDaniel Bristot de Oliveira static int osnoise_instance_registered(struct trace_array *tr)
942fac8d64SDaniel Bristot de Oliveira {
952fac8d64SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
962fac8d64SDaniel Bristot de Oliveira 	int found = 0;
972fac8d64SDaniel Bristot de Oliveira 
982fac8d64SDaniel Bristot de Oliveira 	rcu_read_lock();
992fac8d64SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
1002fac8d64SDaniel Bristot de Oliveira 		if (inst->tr == tr)
1012fac8d64SDaniel Bristot de Oliveira 			found = 1;
1022fac8d64SDaniel Bristot de Oliveira 	}
1032fac8d64SDaniel Bristot de Oliveira 	rcu_read_unlock();
1042fac8d64SDaniel Bristot de Oliveira 
1052fac8d64SDaniel Bristot de Oliveira 	return found;
1062fac8d64SDaniel Bristot de Oliveira }
1072fac8d64SDaniel Bristot de Oliveira 
1082fac8d64SDaniel Bristot de Oliveira /*
109dae18134SDaniel Bristot de Oliveira  * osnoise_register_instance - register a new trace instance
110dae18134SDaniel Bristot de Oliveira  *
111dae18134SDaniel Bristot de Oliveira  * Register a trace_array *tr in the list of instances running
112dae18134SDaniel Bristot de Oliveira  * osnoise/timerlat tracers.
113dae18134SDaniel Bristot de Oliveira  */
114dae18134SDaniel Bristot de Oliveira static int osnoise_register_instance(struct trace_array *tr)
115dae18134SDaniel Bristot de Oliveira {
116dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
117dae18134SDaniel Bristot de Oliveira 
118dae18134SDaniel Bristot de Oliveira 	/*
119dae18134SDaniel Bristot de Oliveira 	 * register/unregister serialization is provided by trace's
120dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock.
121dae18134SDaniel Bristot de Oliveira 	 */
122dae18134SDaniel Bristot de Oliveira 	lockdep_assert_held(&trace_types_lock);
123dae18134SDaniel Bristot de Oliveira 
124dae18134SDaniel Bristot de Oliveira 	inst = kmalloc(sizeof(*inst), GFP_KERNEL);
125dae18134SDaniel Bristot de Oliveira 	if (!inst)
126dae18134SDaniel Bristot de Oliveira 		return -ENOMEM;
127dae18134SDaniel Bristot de Oliveira 
128dae18134SDaniel Bristot de Oliveira 	INIT_LIST_HEAD_RCU(&inst->list);
129dae18134SDaniel Bristot de Oliveira 	inst->tr = tr;
130dae18134SDaniel Bristot de Oliveira 	list_add_tail_rcu(&inst->list, &osnoise_instances);
131dae18134SDaniel Bristot de Oliveira 
132dae18134SDaniel Bristot de Oliveira 	return 0;
133dae18134SDaniel Bristot de Oliveira }
134dae18134SDaniel Bristot de Oliveira 
135dae18134SDaniel Bristot de Oliveira /*
136dae18134SDaniel Bristot de Oliveira  *  osnoise_unregister_instance - unregister a registered trace instance
137dae18134SDaniel Bristot de Oliveira  *
138dae18134SDaniel Bristot de Oliveira  * Remove the trace_array *tr from the list of instances running
139dae18134SDaniel Bristot de Oliveira  * osnoise/timerlat tracers.
140dae18134SDaniel Bristot de Oliveira  */
141dae18134SDaniel Bristot de Oliveira static void osnoise_unregister_instance(struct trace_array *tr)
142dae18134SDaniel Bristot de Oliveira {
143dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
144dae18134SDaniel Bristot de Oliveira 	int found = 0;
145dae18134SDaniel Bristot de Oliveira 
146dae18134SDaniel Bristot de Oliveira 	/*
147dae18134SDaniel Bristot de Oliveira 	 * register/unregister serialization is provided by trace's
148dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock.
149dae18134SDaniel Bristot de Oliveira 	 */
150685b64e4SChuang Wang 	list_for_each_entry_rcu(inst, &osnoise_instances, list,
151685b64e4SChuang Wang 				lockdep_is_held(&trace_types_lock)) {
152dae18134SDaniel Bristot de Oliveira 		if (inst->tr == tr) {
153dae18134SDaniel Bristot de Oliveira 			list_del_rcu(&inst->list);
154dae18134SDaniel Bristot de Oliveira 			found = 1;
155dae18134SDaniel Bristot de Oliveira 			break;
156dae18134SDaniel Bristot de Oliveira 		}
157dae18134SDaniel Bristot de Oliveira 	}
158dae18134SDaniel Bristot de Oliveira 
159dae18134SDaniel Bristot de Oliveira 	if (!found)
160dae18134SDaniel Bristot de Oliveira 		return;
161dae18134SDaniel Bristot de Oliveira 
162cae16f2cSUladzislau Rezki (Sony) 	kvfree_rcu_mightsleep(inst);
163dae18134SDaniel Bristot de Oliveira }
164dae18134SDaniel Bristot de Oliveira 
165dae18134SDaniel Bristot de Oliveira /*
166bce29ac9SDaniel Bristot de Oliveira  * NMI runtime info.
167bce29ac9SDaniel Bristot de Oliveira  */
168bce29ac9SDaniel Bristot de Oliveira struct osn_nmi {
169bce29ac9SDaniel Bristot de Oliveira 	u64	count;
170bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
171bce29ac9SDaniel Bristot de Oliveira };
172bce29ac9SDaniel Bristot de Oliveira 
173bce29ac9SDaniel Bristot de Oliveira /*
174bce29ac9SDaniel Bristot de Oliveira  * IRQ runtime info.
175bce29ac9SDaniel Bristot de Oliveira  */
176bce29ac9SDaniel Bristot de Oliveira struct osn_irq {
177bce29ac9SDaniel Bristot de Oliveira 	u64	count;
178bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
179bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
180bce29ac9SDaniel Bristot de Oliveira };
181bce29ac9SDaniel Bristot de Oliveira 
182a955d7eaSDaniel Bristot de Oliveira #define IRQ_CONTEXT	0
183a955d7eaSDaniel Bristot de Oliveira #define THREAD_CONTEXT	1
184bce29ac9SDaniel Bristot de Oliveira /*
185bce29ac9SDaniel Bristot de Oliveira  * sofirq runtime info.
186bce29ac9SDaniel Bristot de Oliveira  */
187bce29ac9SDaniel Bristot de Oliveira struct osn_softirq {
188bce29ac9SDaniel Bristot de Oliveira 	u64	count;
189bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
190bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
191bce29ac9SDaniel Bristot de Oliveira };
192bce29ac9SDaniel Bristot de Oliveira 
193bce29ac9SDaniel Bristot de Oliveira /*
194bce29ac9SDaniel Bristot de Oliveira  * thread runtime info.
195bce29ac9SDaniel Bristot de Oliveira  */
196bce29ac9SDaniel Bristot de Oliveira struct osn_thread {
197bce29ac9SDaniel Bristot de Oliveira 	u64	count;
198bce29ac9SDaniel Bristot de Oliveira 	u64	arrival_time;
199bce29ac9SDaniel Bristot de Oliveira 	u64	delta_start;
200bce29ac9SDaniel Bristot de Oliveira };
201bce29ac9SDaniel Bristot de Oliveira 
202bce29ac9SDaniel Bristot de Oliveira /*
203bce29ac9SDaniel Bristot de Oliveira  * Runtime information: this structure saves the runtime information used by
204bce29ac9SDaniel Bristot de Oliveira  * one sampling thread.
205bce29ac9SDaniel Bristot de Oliveira  */
206bce29ac9SDaniel Bristot de Oliveira struct osnoise_variables {
207bce29ac9SDaniel Bristot de Oliveira 	struct task_struct	*kthread;
208bce29ac9SDaniel Bristot de Oliveira 	bool			sampling;
209bce29ac9SDaniel Bristot de Oliveira 	pid_t			pid;
210bce29ac9SDaniel Bristot de Oliveira 	struct osn_nmi		nmi;
211bce29ac9SDaniel Bristot de Oliveira 	struct osn_irq		irq;
212bce29ac9SDaniel Bristot de Oliveira 	struct osn_softirq	softirq;
213bce29ac9SDaniel Bristot de Oliveira 	struct osn_thread	thread;
214bce29ac9SDaniel Bristot de Oliveira 	local_t			int_counter;
215bce29ac9SDaniel Bristot de Oliveira };
216bce29ac9SDaniel Bristot de Oliveira 
217bce29ac9SDaniel Bristot de Oliveira /*
218bce29ac9SDaniel Bristot de Oliveira  * Per-cpu runtime information.
219bce29ac9SDaniel Bristot de Oliveira  */
2207a025e06STom Rix static DEFINE_PER_CPU(struct osnoise_variables, per_cpu_osnoise_var);
221bce29ac9SDaniel Bristot de Oliveira 
222bce29ac9SDaniel Bristot de Oliveira /*
223bce29ac9SDaniel Bristot de Oliveira  * this_cpu_osn_var - Return the per-cpu osnoise_variables on its relative CPU
224bce29ac9SDaniel Bristot de Oliveira  */
225bce29ac9SDaniel Bristot de Oliveira static inline struct osnoise_variables *this_cpu_osn_var(void)
226bce29ac9SDaniel Bristot de Oliveira {
227bce29ac9SDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_osnoise_var);
228bce29ac9SDaniel Bristot de Oliveira }
229bce29ac9SDaniel Bristot de Oliveira 
230a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
231bce29ac9SDaniel Bristot de Oliveira /*
232a955d7eaSDaniel Bristot de Oliveira  * Runtime information for the timer mode.
233bce29ac9SDaniel Bristot de Oliveira  */
234a955d7eaSDaniel Bristot de Oliveira struct timerlat_variables {
235a955d7eaSDaniel Bristot de Oliveira 	struct task_struct	*kthread;
236a955d7eaSDaniel Bristot de Oliveira 	struct hrtimer		timer;
237a955d7eaSDaniel Bristot de Oliveira 	u64			rel_period;
238a955d7eaSDaniel Bristot de Oliveira 	u64			abs_period;
239a955d7eaSDaniel Bristot de Oliveira 	bool			tracing_thread;
240a955d7eaSDaniel Bristot de Oliveira 	u64			count;
241a955d7eaSDaniel Bristot de Oliveira };
242a955d7eaSDaniel Bristot de Oliveira 
2437a025e06STom Rix static DEFINE_PER_CPU(struct timerlat_variables, per_cpu_timerlat_var);
244a955d7eaSDaniel Bristot de Oliveira 
245a955d7eaSDaniel Bristot de Oliveira /*
246a955d7eaSDaniel Bristot de Oliveira  * this_cpu_tmr_var - Return the per-cpu timerlat_variables on its relative CPU
247a955d7eaSDaniel Bristot de Oliveira  */
248a955d7eaSDaniel Bristot de Oliveira static inline struct timerlat_variables *this_cpu_tmr_var(void)
249bce29ac9SDaniel Bristot de Oliveira {
250a955d7eaSDaniel Bristot de Oliveira 	return this_cpu_ptr(&per_cpu_timerlat_var);
251a955d7eaSDaniel Bristot de Oliveira }
252a955d7eaSDaniel Bristot de Oliveira 
253a955d7eaSDaniel Bristot de Oliveira /*
254a955d7eaSDaniel Bristot de Oliveira  * tlat_var_reset - Reset the values of the given timerlat_variables
255a955d7eaSDaniel Bristot de Oliveira  */
256a955d7eaSDaniel Bristot de Oliveira static inline void tlat_var_reset(void)
257a955d7eaSDaniel Bristot de Oliveira {
258a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var;
259a955d7eaSDaniel Bristot de Oliveira 	int cpu;
260bce29ac9SDaniel Bristot de Oliveira 	/*
261bce29ac9SDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
262bce29ac9SDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
263bce29ac9SDaniel Bristot de Oliveira 	 */
264a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
265a955d7eaSDaniel Bristot de Oliveira 		tlat_var = per_cpu_ptr(&per_cpu_timerlat_var, cpu);
266a955d7eaSDaniel Bristot de Oliveira 		memset(tlat_var, 0, sizeof(*tlat_var));
267a955d7eaSDaniel Bristot de Oliveira 	}
268a955d7eaSDaniel Bristot de Oliveira }
269a955d7eaSDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
270a955d7eaSDaniel Bristot de Oliveira #define tlat_var_reset()	do {} while (0)
271a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
272a955d7eaSDaniel Bristot de Oliveira 
273a955d7eaSDaniel Bristot de Oliveira /*
274a955d7eaSDaniel Bristot de Oliveira  * osn_var_reset - Reset the values of the given osnoise_variables
275a955d7eaSDaniel Bristot de Oliveira  */
276a955d7eaSDaniel Bristot de Oliveira static inline void osn_var_reset(void)
277a955d7eaSDaniel Bristot de Oliveira {
278a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var;
279a955d7eaSDaniel Bristot de Oliveira 	int cpu;
280a955d7eaSDaniel Bristot de Oliveira 
281a955d7eaSDaniel Bristot de Oliveira 	/*
282a955d7eaSDaniel Bristot de Oliveira 	 * So far, all the values are initialized as 0, so
283a955d7eaSDaniel Bristot de Oliveira 	 * zeroing the structure is perfect.
284a955d7eaSDaniel Bristot de Oliveira 	 */
285a955d7eaSDaniel Bristot de Oliveira 	for_each_cpu(cpu, cpu_online_mask) {
286a955d7eaSDaniel Bristot de Oliveira 		osn_var = per_cpu_ptr(&per_cpu_osnoise_var, cpu);
287bce29ac9SDaniel Bristot de Oliveira 		memset(osn_var, 0, sizeof(*osn_var));
288bce29ac9SDaniel Bristot de Oliveira 	}
289a955d7eaSDaniel Bristot de Oliveira }
290bce29ac9SDaniel Bristot de Oliveira 
291bce29ac9SDaniel Bristot de Oliveira /*
292bce29ac9SDaniel Bristot de Oliveira  * osn_var_reset_all - Reset the value of all per-cpu osnoise_variables
293bce29ac9SDaniel Bristot de Oliveira  */
294bce29ac9SDaniel Bristot de Oliveira static inline void osn_var_reset_all(void)
295bce29ac9SDaniel Bristot de Oliveira {
296a955d7eaSDaniel Bristot de Oliveira 	osn_var_reset();
297a955d7eaSDaniel Bristot de Oliveira 	tlat_var_reset();
298bce29ac9SDaniel Bristot de Oliveira }
299bce29ac9SDaniel Bristot de Oliveira 
300bce29ac9SDaniel Bristot de Oliveira /*
301bce29ac9SDaniel Bristot de Oliveira  * Tells NMIs to call back to the osnoise tracer to record timestamps.
302bce29ac9SDaniel Bristot de Oliveira  */
303bce29ac9SDaniel Bristot de Oliveira bool trace_osnoise_callback_enabled;
304bce29ac9SDaniel Bristot de Oliveira 
305bce29ac9SDaniel Bristot de Oliveira /*
306bce29ac9SDaniel Bristot de Oliveira  * osnoise sample structure definition. Used to store the statistics of a
307bce29ac9SDaniel Bristot de Oliveira  * sample run.
308bce29ac9SDaniel Bristot de Oliveira  */
309bce29ac9SDaniel Bristot de Oliveira struct osnoise_sample {
310bce29ac9SDaniel Bristot de Oliveira 	u64			runtime;	/* runtime */
311bce29ac9SDaniel Bristot de Oliveira 	u64			noise;		/* noise */
312bce29ac9SDaniel Bristot de Oliveira 	u64			max_sample;	/* max single noise sample */
313bce29ac9SDaniel Bristot de Oliveira 	int			hw_count;	/* # HW (incl. hypervisor) interference */
314bce29ac9SDaniel Bristot de Oliveira 	int			nmi_count;	/* # NMIs during this sample */
315bce29ac9SDaniel Bristot de Oliveira 	int			irq_count;	/* # IRQs during this sample */
316bce29ac9SDaniel Bristot de Oliveira 	int			softirq_count;	/* # softirqs during this sample */
317bce29ac9SDaniel Bristot de Oliveira 	int			thread_count;	/* # threads during this sample */
318bce29ac9SDaniel Bristot de Oliveira };
319bce29ac9SDaniel Bristot de Oliveira 
320a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
321a955d7eaSDaniel Bristot de Oliveira /*
322a955d7eaSDaniel Bristot de Oliveira  * timerlat sample structure definition. Used to store the statistics of
323a955d7eaSDaniel Bristot de Oliveira  * a sample run.
324a955d7eaSDaniel Bristot de Oliveira  */
325a955d7eaSDaniel Bristot de Oliveira struct timerlat_sample {
326a955d7eaSDaniel Bristot de Oliveira 	u64			timer_latency;	/* timer_latency */
327a955d7eaSDaniel Bristot de Oliveira 	unsigned int		seqnum;		/* unique sequence */
328a955d7eaSDaniel Bristot de Oliveira 	int			context;	/* timer context */
329a955d7eaSDaniel Bristot de Oliveira };
330a955d7eaSDaniel Bristot de Oliveira #endif
331a955d7eaSDaniel Bristot de Oliveira 
332bce29ac9SDaniel Bristot de Oliveira /*
333bce29ac9SDaniel Bristot de Oliveira  * Protect the interface.
334bce29ac9SDaniel Bristot de Oliveira  */
3357a025e06STom Rix static struct mutex interface_lock;
336bce29ac9SDaniel Bristot de Oliveira 
337bce29ac9SDaniel Bristot de Oliveira /*
338bce29ac9SDaniel Bristot de Oliveira  * Tracer data.
339bce29ac9SDaniel Bristot de Oliveira  */
340bce29ac9SDaniel Bristot de Oliveira static struct osnoise_data {
341bce29ac9SDaniel Bristot de Oliveira 	u64	sample_period;		/* total sampling period */
342bce29ac9SDaniel Bristot de Oliveira 	u64	sample_runtime;		/* active sampling portion of period */
343a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing;		/* stop trace in the internal operation (loop/irq) */
344a955d7eaSDaniel Bristot de Oliveira 	u64	stop_tracing_total;	/* stop trace in the final operation (report/thread) */
345a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
346a955d7eaSDaniel Bristot de Oliveira 	u64	timerlat_period;	/* timerlat period */
347a955d7eaSDaniel Bristot de Oliveira 	u64	print_stack;		/* print IRQ stack if total > */
348a955d7eaSDaniel Bristot de Oliveira 	int	timerlat_tracer;	/* timerlat tracer */
349a955d7eaSDaniel Bristot de Oliveira #endif
350bce29ac9SDaniel Bristot de Oliveira 	bool	tainted;		/* infor users and developers about a problem */
351bce29ac9SDaniel Bristot de Oliveira } osnoise_data = {
352bce29ac9SDaniel Bristot de Oliveira 	.sample_period			= DEFAULT_SAMPLE_PERIOD,
353bce29ac9SDaniel Bristot de Oliveira 	.sample_runtime			= DEFAULT_SAMPLE_RUNTIME,
354bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing			= 0,
355bce29ac9SDaniel Bristot de Oliveira 	.stop_tracing_total		= 0,
356a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
357a955d7eaSDaniel Bristot de Oliveira 	.print_stack			= 0,
358a955d7eaSDaniel Bristot de Oliveira 	.timerlat_period		= DEFAULT_TIMERLAT_PERIOD,
359a955d7eaSDaniel Bristot de Oliveira 	.timerlat_tracer		= 0,
360a955d7eaSDaniel Bristot de Oliveira #endif
361bce29ac9SDaniel Bristot de Oliveira };
362bce29ac9SDaniel Bristot de Oliveira 
363ccb67544SDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
364ccb67544SDaniel Bristot de Oliveira static inline bool timerlat_enabled(void)
365ccb67544SDaniel Bristot de Oliveira {
366ccb67544SDaniel Bristot de Oliveira 	return osnoise_data.timerlat_tracer;
367ccb67544SDaniel Bristot de Oliveira }
368ccb67544SDaniel Bristot de Oliveira 
369ccb67544SDaniel Bristot de Oliveira static inline int timerlat_softirq_exit(struct osnoise_variables *osn_var)
370ccb67544SDaniel Bristot de Oliveira {
371ccb67544SDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var = this_cpu_tmr_var();
372ccb67544SDaniel Bristot de Oliveira 	/*
373ccb67544SDaniel Bristot de Oliveira 	 * If the timerlat is enabled, but the irq handler did
374ccb67544SDaniel Bristot de Oliveira 	 * not run yet enabling timerlat_tracer, do not trace.
375ccb67544SDaniel Bristot de Oliveira 	 */
376ccb67544SDaniel Bristot de Oliveira 	if (!tlat_var->tracing_thread) {
377ccb67544SDaniel Bristot de Oliveira 		osn_var->softirq.arrival_time = 0;
378ccb67544SDaniel Bristot de Oliveira 		osn_var->softirq.delta_start = 0;
379ccb67544SDaniel Bristot de Oliveira 		return 0;
380ccb67544SDaniel Bristot de Oliveira 	}
381ccb67544SDaniel Bristot de Oliveira 	return 1;
382ccb67544SDaniel Bristot de Oliveira }
383ccb67544SDaniel Bristot de Oliveira 
384ccb67544SDaniel Bristot de Oliveira static inline int timerlat_thread_exit(struct osnoise_variables *osn_var)
385ccb67544SDaniel Bristot de Oliveira {
386ccb67544SDaniel Bristot de Oliveira 	struct timerlat_variables *tlat_var = this_cpu_tmr_var();
387ccb67544SDaniel Bristot de Oliveira 	/*
388ccb67544SDaniel Bristot de Oliveira 	 * If the timerlat is enabled, but the irq handler did
389ccb67544SDaniel Bristot de Oliveira 	 * not run yet enabling timerlat_tracer, do not trace.
390ccb67544SDaniel Bristot de Oliveira 	 */
391ccb67544SDaniel Bristot de Oliveira 	if (!tlat_var->tracing_thread) {
392ccb67544SDaniel Bristot de Oliveira 		osn_var->thread.delta_start = 0;
393ccb67544SDaniel Bristot de Oliveira 		osn_var->thread.arrival_time = 0;
394ccb67544SDaniel Bristot de Oliveira 		return 0;
395ccb67544SDaniel Bristot de Oliveira 	}
396ccb67544SDaniel Bristot de Oliveira 	return 1;
397ccb67544SDaniel Bristot de Oliveira }
398ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
399ccb67544SDaniel Bristot de Oliveira static inline bool timerlat_enabled(void)
400ccb67544SDaniel Bristot de Oliveira {
401ccb67544SDaniel Bristot de Oliveira 	return false;
402ccb67544SDaniel Bristot de Oliveira }
403ccb67544SDaniel Bristot de Oliveira 
404ccb67544SDaniel Bristot de Oliveira static inline int timerlat_softirq_exit(struct osnoise_variables *osn_var)
405ccb67544SDaniel Bristot de Oliveira {
406ccb67544SDaniel Bristot de Oliveira 	return 1;
407ccb67544SDaniel Bristot de Oliveira }
408ccb67544SDaniel Bristot de Oliveira static inline int timerlat_thread_exit(struct osnoise_variables *osn_var)
409ccb67544SDaniel Bristot de Oliveira {
410ccb67544SDaniel Bristot de Oliveira 	return 1;
411ccb67544SDaniel Bristot de Oliveira }
412ccb67544SDaniel Bristot de Oliveira #endif
413ccb67544SDaniel Bristot de Oliveira 
414d03721a6SDaniel Bristot de Oliveira #ifdef CONFIG_PREEMPT_RT
415bce29ac9SDaniel Bristot de Oliveira /*
416bce29ac9SDaniel Bristot de Oliveira  * Print the osnoise header info.
417bce29ac9SDaniel Bristot de Oliveira  */
418bce29ac9SDaniel Bristot de Oliveira static void print_osnoise_headers(struct seq_file *s)
419bce29ac9SDaniel Bristot de Oliveira {
420bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.tainted)
421bce29ac9SDaniel Bristot de Oliveira 		seq_puts(s, "# osnoise is tainted!\n");
422bce29ac9SDaniel Bristot de Oliveira 
423d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-------=> irqs-off\n");
424d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _------=> need-resched\n");
425d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _-----=> need-resched-lazy\n");
426d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _----=> hardirq/softirq\n");
427d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _---=> preempt-depth\n");
428d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| / _--=> preempt-lazy-depth\n");
429d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| / _-=> migrate-disable\n");
430d03721a6SDaniel Bristot de Oliveira 
431d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||| /          ");
432d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "                                     MAX\n");
433d03721a6SDaniel Bristot de Oliveira 
434d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| /                         ");
435d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "                    SINGLE      Interference counters:\n");
436d03721a6SDaniel Bristot de Oliveira 
437d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||||               RUNTIME   ");
438d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "   NOISE  %% OF CPU  NOISE    +-----------------------------+\n");
439d03721a6SDaniel Bristot de Oliveira 
440d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||||   TIMESTAMP    IN US    ");
441d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "   IN US  AVAILABLE  IN US     HW    NMI    IRQ   SIRQ THREAD\n");
442d03721a6SDaniel Bristot de Oliveira 
443d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||||      |           |      ");
444d03721a6SDaniel Bristot de Oliveira 	seq_puts(s, "       |    |            |      |      |      |      |      |\n");
445d03721a6SDaniel Bristot de Oliveira }
446d03721a6SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
447d03721a6SDaniel Bristot de Oliveira static void print_osnoise_headers(struct seq_file *s)
448d03721a6SDaniel Bristot de Oliveira {
449d03721a6SDaniel Bristot de Oliveira 	if (osnoise_data.tainted)
450d03721a6SDaniel Bristot de Oliveira 		seq_puts(s, "# osnoise is tainted!\n");
451d03721a6SDaniel Bristot de Oliveira 
452bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
453bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
454bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
455e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth\n");
456e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _-=> migrate-disable     ");
457bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                    MAX\n");
458e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| /     delay               ");
459bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "                    SINGLE      Interference counters:\n");
460bce29ac9SDaniel Bristot de Oliveira 
461e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||               RUNTIME   ");
462bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   NOISE  %% OF CPU  NOISE    +-----------------------------+\n");
463bce29ac9SDaniel Bristot de Oliveira 
464e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||   TIMESTAMP    IN US    ");
465bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "   IN US  AVAILABLE  IN US     HW    NMI    IRQ   SIRQ THREAD\n");
466bce29ac9SDaniel Bristot de Oliveira 
467e0f3b18bSDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||      |           |      ");
468bce29ac9SDaniel Bristot de Oliveira 	seq_puts(s, "       |    |            |      |      |      |      |      |\n");
469bce29ac9SDaniel Bristot de Oliveira }
470d03721a6SDaniel Bristot de Oliveira #endif /* CONFIG_PREEMPT_RT */
471bce29ac9SDaniel Bristot de Oliveira 
472bce29ac9SDaniel Bristot de Oliveira /*
473bce29ac9SDaniel Bristot de Oliveira  * osnoise_taint - report an osnoise error.
474bce29ac9SDaniel Bristot de Oliveira  */
475bce29ac9SDaniel Bristot de Oliveira #define osnoise_taint(msg) ({							\
476dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;						\
477dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;						\
478bce29ac9SDaniel Bristot de Oliveira 										\
479dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();							\
480dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {		\
481dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;				\
482dae18134SDaniel Bristot de Oliveira 		trace_array_printk_buf(buffer, _THIS_IP_, msg);			\
483dae18134SDaniel Bristot de Oliveira 	}									\
484dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();							\
485bce29ac9SDaniel Bristot de Oliveira 	osnoise_data.tainted = true;						\
486bce29ac9SDaniel Bristot de Oliveira })
487bce29ac9SDaniel Bristot de Oliveira 
488bce29ac9SDaniel Bristot de Oliveira /*
489bce29ac9SDaniel Bristot de Oliveira  * Record an osnoise_sample into the tracer buffer.
490bce29ac9SDaniel Bristot de Oliveira  */
491dae18134SDaniel Bristot de Oliveira static void
492dae18134SDaniel Bristot de Oliveira __trace_osnoise_sample(struct osnoise_sample *sample, struct trace_buffer *buffer)
493bce29ac9SDaniel Bristot de Oliveira {
494bce29ac9SDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
495bce29ac9SDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
496bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_entry *entry;
497bce29ac9SDaniel Bristot de Oliveira 
498bce29ac9SDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_OSNOISE, sizeof(*entry),
499bce29ac9SDaniel Bristot de Oliveira 					  tracing_gen_ctx());
500bce29ac9SDaniel Bristot de Oliveira 	if (!event)
501bce29ac9SDaniel Bristot de Oliveira 		return;
502bce29ac9SDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
503bce29ac9SDaniel Bristot de Oliveira 	entry->runtime		= sample->runtime;
504bce29ac9SDaniel Bristot de Oliveira 	entry->noise		= sample->noise;
505bce29ac9SDaniel Bristot de Oliveira 	entry->max_sample	= sample->max_sample;
506bce29ac9SDaniel Bristot de Oliveira 	entry->hw_count		= sample->hw_count;
507bce29ac9SDaniel Bristot de Oliveira 	entry->nmi_count	= sample->nmi_count;
508bce29ac9SDaniel Bristot de Oliveira 	entry->irq_count	= sample->irq_count;
509bce29ac9SDaniel Bristot de Oliveira 	entry->softirq_count	= sample->softirq_count;
510bce29ac9SDaniel Bristot de Oliveira 	entry->thread_count	= sample->thread_count;
511bce29ac9SDaniel Bristot de Oliveira 
512bce29ac9SDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
513bce29ac9SDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
514bce29ac9SDaniel Bristot de Oliveira }
515bce29ac9SDaniel Bristot de Oliveira 
516dae18134SDaniel Bristot de Oliveira /*
517dae18134SDaniel Bristot de Oliveira  * Record an osnoise_sample on all osnoise instances.
518dae18134SDaniel Bristot de Oliveira  */
519dae18134SDaniel Bristot de Oliveira static void trace_osnoise_sample(struct osnoise_sample *sample)
520dae18134SDaniel Bristot de Oliveira {
521dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
522dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
523dae18134SDaniel Bristot de Oliveira 
524dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
525dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
526dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
527dae18134SDaniel Bristot de Oliveira 		__trace_osnoise_sample(sample, buffer);
528dae18134SDaniel Bristot de Oliveira 	}
529dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
530dae18134SDaniel Bristot de Oliveira }
531dae18134SDaniel Bristot de Oliveira 
532a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
533a955d7eaSDaniel Bristot de Oliveira /*
534a955d7eaSDaniel Bristot de Oliveira  * Print the timerlat header info.
535a955d7eaSDaniel Bristot de Oliveira  */
536e1c4ad4aSDaniel Bristot de Oliveira #ifdef CONFIG_PREEMPT_RT
537e1c4ad4aSDaniel Bristot de Oliveira static void print_timerlat_headers(struct seq_file *s)
538e1c4ad4aSDaniel Bristot de Oliveira {
539e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-------=> irqs-off\n");
540e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _------=> need-resched\n");
541e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _-----=> need-resched-lazy\n");
542e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _----=> hardirq/softirq\n");
543e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _---=> preempt-depth\n");
544e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| / _--=> preempt-lazy-depth\n");
545e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||||| / _-=> migrate-disable\n");
546e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||| /\n");
547e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||||             ACTIVATION\n");
548e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||||   TIMESTAMP    ID     ");
549e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "       CONTEXT                LATENCY\n");
550e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||||      |         |      ");
551e1c4ad4aSDaniel Bristot de Oliveira 	seq_puts(s, "            |                       |\n");
552e1c4ad4aSDaniel Bristot de Oliveira }
553e1c4ad4aSDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
554a955d7eaSDaniel Bristot de Oliveira static void print_timerlat_headers(struct seq_file *s)
555a955d7eaSDaniel Bristot de Oliveira {
556a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                                _-----=> irqs-off\n");
557a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                               / _----=> need-resched\n");
558a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              | / _---=> hardirq/softirq\n");
559a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "#                              || / _--=> preempt-depth\n");
560aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              ||| / _-=> migrate-disable\n");
561aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||| /     delay\n");
562aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#                              |||||            ACTIVATION\n");
563aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#           TASK-PID      CPU# |||||   TIMESTAMP   ID      ");
564a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "      CONTEXT                 LATENCY\n");
565aeafcb82SDaniel Bristot de Oliveira 	seq_puts(s, "#              | |         |   |||||      |         |      ");
566a955d7eaSDaniel Bristot de Oliveira 	seq_puts(s, "            |                       |\n");
567a955d7eaSDaniel Bristot de Oliveira }
568e1c4ad4aSDaniel Bristot de Oliveira #endif /* CONFIG_PREEMPT_RT */
569a955d7eaSDaniel Bristot de Oliveira 
570dae18134SDaniel Bristot de Oliveira static void
571dae18134SDaniel Bristot de Oliveira __trace_timerlat_sample(struct timerlat_sample *sample, struct trace_buffer *buffer)
572a955d7eaSDaniel Bristot de Oliveira {
573a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
574a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
575a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_entry *entry;
576a955d7eaSDaniel Bristot de Oliveira 
577a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_TIMERLAT, sizeof(*entry),
578a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
579a955d7eaSDaniel Bristot de Oliveira 	if (!event)
580a955d7eaSDaniel Bristot de Oliveira 		return;
581a955d7eaSDaniel Bristot de Oliveira 	entry	= ring_buffer_event_data(event);
582a955d7eaSDaniel Bristot de Oliveira 	entry->seqnum			= sample->seqnum;
583a955d7eaSDaniel Bristot de Oliveira 	entry->context			= sample->context;
584a955d7eaSDaniel Bristot de Oliveira 	entry->timer_latency		= sample->timer_latency;
585a955d7eaSDaniel Bristot de Oliveira 
586a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
587a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
588a955d7eaSDaniel Bristot de Oliveira }
589a955d7eaSDaniel Bristot de Oliveira 
590dae18134SDaniel Bristot de Oliveira /*
591dae18134SDaniel Bristot de Oliveira  * Record an timerlat_sample into the tracer buffer.
592dae18134SDaniel Bristot de Oliveira  */
593dae18134SDaniel Bristot de Oliveira static void trace_timerlat_sample(struct timerlat_sample *sample)
594dae18134SDaniel Bristot de Oliveira {
595dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
596dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
597dae18134SDaniel Bristot de Oliveira 
598dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
599dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
600dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
601dae18134SDaniel Bristot de Oliveira 		__trace_timerlat_sample(sample, buffer);
602dae18134SDaniel Bristot de Oliveira 	}
603dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
604dae18134SDaniel Bristot de Oliveira }
605dae18134SDaniel Bristot de Oliveira 
606a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
607a955d7eaSDaniel Bristot de Oliveira 
608a955d7eaSDaniel Bristot de Oliveira #define	MAX_CALLS	256
609a955d7eaSDaniel Bristot de Oliveira 
610a955d7eaSDaniel Bristot de Oliveira /*
611a955d7eaSDaniel Bristot de Oliveira  * Stack trace will take place only at IRQ level, so, no need
612a955d7eaSDaniel Bristot de Oliveira  * to control nesting here.
613a955d7eaSDaniel Bristot de Oliveira  */
614a955d7eaSDaniel Bristot de Oliveira struct trace_stack {
615a955d7eaSDaniel Bristot de Oliveira 	int		stack_size;
616a955d7eaSDaniel Bristot de Oliveira 	int		nr_entries;
617a955d7eaSDaniel Bristot de Oliveira 	unsigned long	calls[MAX_CALLS];
618a955d7eaSDaniel Bristot de Oliveira };
619a955d7eaSDaniel Bristot de Oliveira 
620a955d7eaSDaniel Bristot de Oliveira static DEFINE_PER_CPU(struct trace_stack, trace_stack);
621a955d7eaSDaniel Bristot de Oliveira 
622a955d7eaSDaniel Bristot de Oliveira /*
623a955d7eaSDaniel Bristot de Oliveira  * timerlat_save_stack - save a stack trace without printing
624a955d7eaSDaniel Bristot de Oliveira  *
625a955d7eaSDaniel Bristot de Oliveira  * Save the current stack trace without printing. The
626a955d7eaSDaniel Bristot de Oliveira  * stack will be printed later, after the end of the measurement.
627a955d7eaSDaniel Bristot de Oliveira  */
628a955d7eaSDaniel Bristot de Oliveira static void timerlat_save_stack(int skip)
629a955d7eaSDaniel Bristot de Oliveira {
630a955d7eaSDaniel Bristot de Oliveira 	unsigned int size, nr_entries;
631a955d7eaSDaniel Bristot de Oliveira 	struct trace_stack *fstack;
632a955d7eaSDaniel Bristot de Oliveira 
633a955d7eaSDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
634a955d7eaSDaniel Bristot de Oliveira 
635a955d7eaSDaniel Bristot de Oliveira 	size = ARRAY_SIZE(fstack->calls);
636a955d7eaSDaniel Bristot de Oliveira 
637a955d7eaSDaniel Bristot de Oliveira 	nr_entries = stack_trace_save(fstack->calls, size, skip);
638a955d7eaSDaniel Bristot de Oliveira 
639a955d7eaSDaniel Bristot de Oliveira 	fstack->stack_size = nr_entries * sizeof(unsigned long);
640a955d7eaSDaniel Bristot de Oliveira 	fstack->nr_entries = nr_entries;
641a955d7eaSDaniel Bristot de Oliveira 
642a955d7eaSDaniel Bristot de Oliveira 	return;
643a955d7eaSDaniel Bristot de Oliveira 
644a955d7eaSDaniel Bristot de Oliveira }
645dae18134SDaniel Bristot de Oliveira 
646dae18134SDaniel Bristot de Oliveira static void
647dae18134SDaniel Bristot de Oliveira __timerlat_dump_stack(struct trace_buffer *buffer, struct trace_stack *fstack, unsigned int size)
648a955d7eaSDaniel Bristot de Oliveira {
649a955d7eaSDaniel Bristot de Oliveira 	struct trace_event_call *call = &event_osnoise;
650a955d7eaSDaniel Bristot de Oliveira 	struct ring_buffer_event *event;
651a955d7eaSDaniel Bristot de Oliveira 	struct stack_entry *entry;
652a955d7eaSDaniel Bristot de Oliveira 
653a955d7eaSDaniel Bristot de Oliveira 	event = trace_buffer_lock_reserve(buffer, TRACE_STACK, sizeof(*entry) + size,
654a955d7eaSDaniel Bristot de Oliveira 					  tracing_gen_ctx());
655a955d7eaSDaniel Bristot de Oliveira 	if (!event)
656dae18134SDaniel Bristot de Oliveira 		return;
657a955d7eaSDaniel Bristot de Oliveira 
658a955d7eaSDaniel Bristot de Oliveira 	entry = ring_buffer_event_data(event);
659a955d7eaSDaniel Bristot de Oliveira 
660a955d7eaSDaniel Bristot de Oliveira 	memcpy(&entry->caller, fstack->calls, size);
661a955d7eaSDaniel Bristot de Oliveira 	entry->size = fstack->nr_entries;
662a955d7eaSDaniel Bristot de Oliveira 
663a955d7eaSDaniel Bristot de Oliveira 	if (!call_filter_check_discard(call, entry, buffer, event))
664a955d7eaSDaniel Bristot de Oliveira 		trace_buffer_unlock_commit_nostack(buffer, event);
665dae18134SDaniel Bristot de Oliveira }
666a955d7eaSDaniel Bristot de Oliveira 
667dae18134SDaniel Bristot de Oliveira /*
668dae18134SDaniel Bristot de Oliveira  * timerlat_dump_stack - dump a stack trace previously saved
669dae18134SDaniel Bristot de Oliveira  */
670b14f4568SDaniel Bristot de Oliveira static void timerlat_dump_stack(u64 latency)
671dae18134SDaniel Bristot de Oliveira {
672dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
673dae18134SDaniel Bristot de Oliveira 	struct trace_buffer *buffer;
674dae18134SDaniel Bristot de Oliveira 	struct trace_stack *fstack;
675dae18134SDaniel Bristot de Oliveira 	unsigned int size;
676dae18134SDaniel Bristot de Oliveira 
677b14f4568SDaniel Bristot de Oliveira 	/*
678b14f4568SDaniel Bristot de Oliveira 	 * trace only if latency > print_stack config, if enabled.
679b14f4568SDaniel Bristot de Oliveira 	 */
680b14f4568SDaniel Bristot de Oliveira 	if (!osnoise_data.print_stack || osnoise_data.print_stack > latency)
681b14f4568SDaniel Bristot de Oliveira 		return;
682b14f4568SDaniel Bristot de Oliveira 
683dae18134SDaniel Bristot de Oliveira 	preempt_disable_notrace();
684dae18134SDaniel Bristot de Oliveira 	fstack = this_cpu_ptr(&trace_stack);
685dae18134SDaniel Bristot de Oliveira 	size = fstack->stack_size;
686dae18134SDaniel Bristot de Oliveira 
687dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
688dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
689dae18134SDaniel Bristot de Oliveira 		buffer = inst->tr->array_buffer.buffer;
690dae18134SDaniel Bristot de Oliveira 		__timerlat_dump_stack(buffer, fstack, size);
691dae18134SDaniel Bristot de Oliveira 
692dae18134SDaniel Bristot de Oliveira 	}
693dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
694a955d7eaSDaniel Bristot de Oliveira 	preempt_enable_notrace();
695a955d7eaSDaniel Bristot de Oliveira }
696b14f4568SDaniel Bristot de Oliveira #else /* CONFIG_STACKTRACE */
697b14f4568SDaniel Bristot de Oliveira #define timerlat_dump_stack(u64 latency) do {} while (0)
698a955d7eaSDaniel Bristot de Oliveira #define timerlat_save_stack(a) do {} while (0)
699a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
700a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
701a955d7eaSDaniel Bristot de Oliveira 
702bce29ac9SDaniel Bristot de Oliveira /*
703bce29ac9SDaniel Bristot de Oliveira  * Macros to encapsulate the time capturing infrastructure.
704bce29ac9SDaniel Bristot de Oliveira  */
705bce29ac9SDaniel Bristot de Oliveira #define time_get()	trace_clock_local()
706bce29ac9SDaniel Bristot de Oliveira #define time_to_us(x)	div_u64(x, 1000)
707bce29ac9SDaniel Bristot de Oliveira #define time_sub(a, b)	((a) - (b))
708bce29ac9SDaniel Bristot de Oliveira 
709bce29ac9SDaniel Bristot de Oliveira /*
710bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start - Forward the delta_start of a running IRQ
711bce29ac9SDaniel Bristot de Oliveira  *
712bce29ac9SDaniel Bristot de Oliveira  * If an IRQ is preempted by an NMI, its delta_start is pushed forward
713bce29ac9SDaniel Bristot de Oliveira  * to discount the NMI interference.
714bce29ac9SDaniel Bristot de Oliveira  *
715bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
716bce29ac9SDaniel Bristot de Oliveira  */
717bce29ac9SDaniel Bristot de Oliveira static inline void
718bce29ac9SDaniel Bristot de Oliveira cond_move_irq_delta_start(struct osnoise_variables *osn_var, u64 duration)
719bce29ac9SDaniel Bristot de Oliveira {
720bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->irq.delta_start)
721bce29ac9SDaniel Bristot de Oliveira 		osn_var->irq.delta_start += duration;
722bce29ac9SDaniel Bristot de Oliveira }
723bce29ac9SDaniel Bristot de Oliveira 
724bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
725bce29ac9SDaniel Bristot de Oliveira /*
726bce29ac9SDaniel Bristot de Oliveira  * cond_move_softirq_delta_start - Forward the delta_start of a running softirq.
727bce29ac9SDaniel Bristot de Oliveira  *
728bce29ac9SDaniel Bristot de Oliveira  * If a softirq is preempted by an IRQ or NMI, its delta_start is pushed
729bce29ac9SDaniel Bristot de Oliveira  * forward to discount the interference.
730bce29ac9SDaniel Bristot de Oliveira  *
731bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
732bce29ac9SDaniel Bristot de Oliveira  */
733bce29ac9SDaniel Bristot de Oliveira static inline void
734bce29ac9SDaniel Bristot de Oliveira cond_move_softirq_delta_start(struct osnoise_variables *osn_var, u64 duration)
735bce29ac9SDaniel Bristot de Oliveira {
736bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->softirq.delta_start)
737bce29ac9SDaniel Bristot de Oliveira 		osn_var->softirq.delta_start += duration;
738bce29ac9SDaniel Bristot de Oliveira }
739bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
740bce29ac9SDaniel Bristot de Oliveira #define cond_move_softirq_delta_start(osn_var, duration) do {} while (0)
741bce29ac9SDaniel Bristot de Oliveira #endif
742bce29ac9SDaniel Bristot de Oliveira 
743bce29ac9SDaniel Bristot de Oliveira /*
744bce29ac9SDaniel Bristot de Oliveira  * cond_move_thread_delta_start - Forward the delta_start of a running thread
745bce29ac9SDaniel Bristot de Oliveira  *
746bce29ac9SDaniel Bristot de Oliveira  * If a noisy thread is preempted by an softirq, IRQ or NMI, its delta_start
747bce29ac9SDaniel Bristot de Oliveira  * is pushed forward to discount the interference.
748bce29ac9SDaniel Bristot de Oliveira  *
749bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration().
750bce29ac9SDaniel Bristot de Oliveira  */
751bce29ac9SDaniel Bristot de Oliveira static inline void
752bce29ac9SDaniel Bristot de Oliveira cond_move_thread_delta_start(struct osnoise_variables *osn_var, u64 duration)
753bce29ac9SDaniel Bristot de Oliveira {
754bce29ac9SDaniel Bristot de Oliveira 	if (osn_var->thread.delta_start)
755bce29ac9SDaniel Bristot de Oliveira 		osn_var->thread.delta_start += duration;
756bce29ac9SDaniel Bristot de Oliveira }
757bce29ac9SDaniel Bristot de Oliveira 
758bce29ac9SDaniel Bristot de Oliveira /*
759bce29ac9SDaniel Bristot de Oliveira  * get_int_safe_duration - Get the duration of a window
760bce29ac9SDaniel Bristot de Oliveira  *
761bce29ac9SDaniel Bristot de Oliveira  * The irq, softirq and thread varaibles need to have its duration without
762bce29ac9SDaniel Bristot de Oliveira  * the interference from higher priority interrupts. Instead of keeping a
763bce29ac9SDaniel Bristot de Oliveira  * variable to discount the interrupt interference from these variables, the
764bce29ac9SDaniel Bristot de Oliveira  * starting time of these variables are pushed forward with the interrupt's
765bce29ac9SDaniel Bristot de Oliveira  * duration. In this way, a single variable is used to:
766bce29ac9SDaniel Bristot de Oliveira  *
767bce29ac9SDaniel Bristot de Oliveira  *   - Know if a given window is being measured.
768bce29ac9SDaniel Bristot de Oliveira  *   - Account its duration.
769bce29ac9SDaniel Bristot de Oliveira  *   - Discount the interference.
770bce29ac9SDaniel Bristot de Oliveira  *
771bce29ac9SDaniel Bristot de Oliveira  * To avoid getting inconsistent values, e.g.,:
772bce29ac9SDaniel Bristot de Oliveira  *
773bce29ac9SDaniel Bristot de Oliveira  *	now = time_get()
774bce29ac9SDaniel Bristot de Oliveira  *		--->	interrupt!
775bce29ac9SDaniel Bristot de Oliveira  *			delta_start -= int duration;
776bce29ac9SDaniel Bristot de Oliveira  *		<---
777bce29ac9SDaniel Bristot de Oliveira  *	duration = now - delta_start;
778bce29ac9SDaniel Bristot de Oliveira  *
779bce29ac9SDaniel Bristot de Oliveira  *	result: negative duration if the variable duration before the
780bce29ac9SDaniel Bristot de Oliveira  *	interrupt was smaller than the interrupt execution.
781bce29ac9SDaniel Bristot de Oliveira  *
782bce29ac9SDaniel Bristot de Oliveira  * A counter of interrupts is used. If the counter increased, try
783bce29ac9SDaniel Bristot de Oliveira  * to capture an interference safe duration.
784bce29ac9SDaniel Bristot de Oliveira  */
785bce29ac9SDaniel Bristot de Oliveira static inline s64
786bce29ac9SDaniel Bristot de Oliveira get_int_safe_duration(struct osnoise_variables *osn_var, u64 *delta_start)
787bce29ac9SDaniel Bristot de Oliveira {
788bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter, now;
789bce29ac9SDaniel Bristot de Oliveira 	s64 duration;
790bce29ac9SDaniel Bristot de Oliveira 
791bce29ac9SDaniel Bristot de Oliveira 	do {
792bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
793bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
794bce29ac9SDaniel Bristot de Oliveira 		barrier();
795bce29ac9SDaniel Bristot de Oliveira 
796bce29ac9SDaniel Bristot de Oliveira 		now = time_get();
797bce29ac9SDaniel Bristot de Oliveira 		duration = (now - *delta_start);
798bce29ac9SDaniel Bristot de Oliveira 
799bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
800bce29ac9SDaniel Bristot de Oliveira 		barrier();
801bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
802bce29ac9SDaniel Bristot de Oliveira 
803bce29ac9SDaniel Bristot de Oliveira 	/*
804bce29ac9SDaniel Bristot de Oliveira 	 * This is an evidence of race conditions that cause
805bce29ac9SDaniel Bristot de Oliveira 	 * a value to be "discounted" too much.
806bce29ac9SDaniel Bristot de Oliveira 	 */
807bce29ac9SDaniel Bristot de Oliveira 	if (duration < 0)
808bce29ac9SDaniel Bristot de Oliveira 		osnoise_taint("Negative duration!\n");
809bce29ac9SDaniel Bristot de Oliveira 
810bce29ac9SDaniel Bristot de Oliveira 	*delta_start = 0;
811bce29ac9SDaniel Bristot de Oliveira 
812bce29ac9SDaniel Bristot de Oliveira 	return duration;
813bce29ac9SDaniel Bristot de Oliveira }
814bce29ac9SDaniel Bristot de Oliveira 
815bce29ac9SDaniel Bristot de Oliveira /*
816bce29ac9SDaniel Bristot de Oliveira  *
817bce29ac9SDaniel Bristot de Oliveira  * set_int_safe_time - Save the current time on *time, aware of interference
818bce29ac9SDaniel Bristot de Oliveira  *
819bce29ac9SDaniel Bristot de Oliveira  * Get the time, taking into consideration a possible interference from
820bce29ac9SDaniel Bristot de Oliveira  * higher priority interrupts.
821bce29ac9SDaniel Bristot de Oliveira  *
822bce29ac9SDaniel Bristot de Oliveira  * See get_int_safe_duration() for an explanation.
823bce29ac9SDaniel Bristot de Oliveira  */
824bce29ac9SDaniel Bristot de Oliveira static u64
825bce29ac9SDaniel Bristot de Oliveira set_int_safe_time(struct osnoise_variables *osn_var, u64 *time)
826bce29ac9SDaniel Bristot de Oliveira {
827bce29ac9SDaniel Bristot de Oliveira 	u64 int_counter;
828bce29ac9SDaniel Bristot de Oliveira 
829bce29ac9SDaniel Bristot de Oliveira 	do {
830bce29ac9SDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
831bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
832bce29ac9SDaniel Bristot de Oliveira 		barrier();
833bce29ac9SDaniel Bristot de Oliveira 
834bce29ac9SDaniel Bristot de Oliveira 		*time = time_get();
835bce29ac9SDaniel Bristot de Oliveira 
836bce29ac9SDaniel Bristot de Oliveira 		/* synchronize with interrupts */
837bce29ac9SDaniel Bristot de Oliveira 		barrier();
838bce29ac9SDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
839bce29ac9SDaniel Bristot de Oliveira 
840bce29ac9SDaniel Bristot de Oliveira 	return int_counter;
841bce29ac9SDaniel Bristot de Oliveira }
842bce29ac9SDaniel Bristot de Oliveira 
843a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
844a955d7eaSDaniel Bristot de Oliveira /*
845a955d7eaSDaniel Bristot de Oliveira  * copy_int_safe_time - Copy *src into *desc aware of interference
846a955d7eaSDaniel Bristot de Oliveira  */
847a955d7eaSDaniel Bristot de Oliveira static u64
848a955d7eaSDaniel Bristot de Oliveira copy_int_safe_time(struct osnoise_variables *osn_var, u64 *dst, u64 *src)
849a955d7eaSDaniel Bristot de Oliveira {
850a955d7eaSDaniel Bristot de Oliveira 	u64 int_counter;
851a955d7eaSDaniel Bristot de Oliveira 
852a955d7eaSDaniel Bristot de Oliveira 	do {
853a955d7eaSDaniel Bristot de Oliveira 		int_counter = local_read(&osn_var->int_counter);
854a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
855a955d7eaSDaniel Bristot de Oliveira 		barrier();
856a955d7eaSDaniel Bristot de Oliveira 
857a955d7eaSDaniel Bristot de Oliveira 		*dst = *src;
858a955d7eaSDaniel Bristot de Oliveira 
859a955d7eaSDaniel Bristot de Oliveira 		/* synchronize with interrupts */
860a955d7eaSDaniel Bristot de Oliveira 		barrier();
861a955d7eaSDaniel Bristot de Oliveira 	} while (int_counter != local_read(&osn_var->int_counter));
862a955d7eaSDaniel Bristot de Oliveira 
863a955d7eaSDaniel Bristot de Oliveira 	return int_counter;
864a955d7eaSDaniel Bristot de Oliveira }
865a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
866a955d7eaSDaniel Bristot de Oliveira 
867bce29ac9SDaniel Bristot de Oliveira /*
868bce29ac9SDaniel Bristot de Oliveira  * trace_osnoise_callback - NMI entry/exit callback
869bce29ac9SDaniel Bristot de Oliveira  *
870bce29ac9SDaniel Bristot de Oliveira  * This function is called at the entry and exit NMI code. The bool enter
871bce29ac9SDaniel Bristot de Oliveira  * distinguishes between either case. This function is used to note a NMI
872bce29ac9SDaniel Bristot de Oliveira  * occurrence, compute the noise caused by the NMI, and to remove the noise
873bce29ac9SDaniel Bristot de Oliveira  * it is potentially causing on other interference variables.
874bce29ac9SDaniel Bristot de Oliveira  */
875bce29ac9SDaniel Bristot de Oliveira void trace_osnoise_callback(bool enter)
876bce29ac9SDaniel Bristot de Oliveira {
877bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
878bce29ac9SDaniel Bristot de Oliveira 	u64 duration;
879bce29ac9SDaniel Bristot de Oliveira 
880bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
881bce29ac9SDaniel Bristot de Oliveira 		return;
882bce29ac9SDaniel Bristot de Oliveira 
883bce29ac9SDaniel Bristot de Oliveira 	/*
884bce29ac9SDaniel Bristot de Oliveira 	 * Currently trace_clock_local() calls sched_clock() and the
885bce29ac9SDaniel Bristot de Oliveira 	 * generic version is not NMI safe.
886bce29ac9SDaniel Bristot de Oliveira 	 */
887bce29ac9SDaniel Bristot de Oliveira 	if (!IS_ENABLED(CONFIG_GENERIC_SCHED_CLOCK)) {
888bce29ac9SDaniel Bristot de Oliveira 		if (enter) {
889bce29ac9SDaniel Bristot de Oliveira 			osn_var->nmi.delta_start = time_get();
890bce29ac9SDaniel Bristot de Oliveira 			local_inc(&osn_var->int_counter);
891bce29ac9SDaniel Bristot de Oliveira 		} else {
892bce29ac9SDaniel Bristot de Oliveira 			duration = time_get() - osn_var->nmi.delta_start;
893bce29ac9SDaniel Bristot de Oliveira 
894bce29ac9SDaniel Bristot de Oliveira 			trace_nmi_noise(osn_var->nmi.delta_start, duration);
895bce29ac9SDaniel Bristot de Oliveira 
896bce29ac9SDaniel Bristot de Oliveira 			cond_move_irq_delta_start(osn_var, duration);
897bce29ac9SDaniel Bristot de Oliveira 			cond_move_softirq_delta_start(osn_var, duration);
898bce29ac9SDaniel Bristot de Oliveira 			cond_move_thread_delta_start(osn_var, duration);
899bce29ac9SDaniel Bristot de Oliveira 		}
900bce29ac9SDaniel Bristot de Oliveira 	}
901bce29ac9SDaniel Bristot de Oliveira 
902bce29ac9SDaniel Bristot de Oliveira 	if (enter)
903bce29ac9SDaniel Bristot de Oliveira 		osn_var->nmi.count++;
904bce29ac9SDaniel Bristot de Oliveira }
905bce29ac9SDaniel Bristot de Oliveira 
906bce29ac9SDaniel Bristot de Oliveira /*
907bce29ac9SDaniel Bristot de Oliveira  * osnoise_trace_irq_entry - Note the starting of an IRQ
908bce29ac9SDaniel Bristot de Oliveira  *
909bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of an IRQ. As IRQs are non-preemptive to other IRQs,
910bce29ac9SDaniel Bristot de Oliveira  * it is safe to use a single variable (ons_var->irq) to save the statistics.
911bce29ac9SDaniel Bristot de Oliveira  * The arrival_time is used to report... the arrival time. The delta_start
912bce29ac9SDaniel Bristot de Oliveira  * is used to compute the duration at the IRQ exit handler. See
913bce29ac9SDaniel Bristot de Oliveira  * cond_move_irq_delta_start().
914bce29ac9SDaniel Bristot de Oliveira  */
915bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_entry(int id)
916bce29ac9SDaniel Bristot de Oliveira {
917bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
918bce29ac9SDaniel Bristot de Oliveira 
919bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
920bce29ac9SDaniel Bristot de Oliveira 		return;
921bce29ac9SDaniel Bristot de Oliveira 	/*
922bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
923bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
924bce29ac9SDaniel Bristot de Oliveira 	 */
925bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = time_get();
926bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->irq.delta_start);
927bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.count++;
928bce29ac9SDaniel Bristot de Oliveira 
929bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
930bce29ac9SDaniel Bristot de Oliveira }
931bce29ac9SDaniel Bristot de Oliveira 
932bce29ac9SDaniel Bristot de Oliveira /*
933bce29ac9SDaniel Bristot de Oliveira  * osnoise_irq_exit - Note the end of an IRQ, sava data and trace
934bce29ac9SDaniel Bristot de Oliveira  *
935bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the IRQ noise, and trace it. Also discounts the
936bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
937bce29ac9SDaniel Bristot de Oliveira  */
938bce29ac9SDaniel Bristot de Oliveira void osnoise_trace_irq_exit(int id, const char *desc)
939bce29ac9SDaniel Bristot de Oliveira {
940bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
941022632f6SDaniel Bristot de Oliveira 	s64 duration;
942bce29ac9SDaniel Bristot de Oliveira 
943bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
944bce29ac9SDaniel Bristot de Oliveira 		return;
945bce29ac9SDaniel Bristot de Oliveira 
946bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->irq.delta_start);
947bce29ac9SDaniel Bristot de Oliveira 	trace_irq_noise(id, desc, osn_var->irq.arrival_time, duration);
948bce29ac9SDaniel Bristot de Oliveira 	osn_var->irq.arrival_time = 0;
949bce29ac9SDaniel Bristot de Oliveira 	cond_move_softirq_delta_start(osn_var, duration);
950bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
951bce29ac9SDaniel Bristot de Oliveira }
952bce29ac9SDaniel Bristot de Oliveira 
953bce29ac9SDaniel Bristot de Oliveira /*
954bce29ac9SDaniel Bristot de Oliveira  * trace_irqentry_callback - Callback to the irq:irq_entry traceevent
955bce29ac9SDaniel Bristot de Oliveira  *
956bce29ac9SDaniel Bristot de Oliveira  * Used to note the starting of an IRQ occurece.
957bce29ac9SDaniel Bristot de Oliveira  */
958bce29ac9SDaniel Bristot de Oliveira static void trace_irqentry_callback(void *data, int irq,
959bce29ac9SDaniel Bristot de Oliveira 				    struct irqaction *action)
960bce29ac9SDaniel Bristot de Oliveira {
961bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_entry(irq);
962bce29ac9SDaniel Bristot de Oliveira }
963bce29ac9SDaniel Bristot de Oliveira 
964bce29ac9SDaniel Bristot de Oliveira /*
965bce29ac9SDaniel Bristot de Oliveira  * trace_irqexit_callback - Callback to the irq:irq_exit traceevent
966bce29ac9SDaniel Bristot de Oliveira  *
967bce29ac9SDaniel Bristot de Oliveira  * Used to note the end of an IRQ occurece.
968bce29ac9SDaniel Bristot de Oliveira  */
969bce29ac9SDaniel Bristot de Oliveira static void trace_irqexit_callback(void *data, int irq,
970bce29ac9SDaniel Bristot de Oliveira 				   struct irqaction *action, int ret)
971bce29ac9SDaniel Bristot de Oliveira {
972bce29ac9SDaniel Bristot de Oliveira 	osnoise_trace_irq_exit(irq, action->name);
973bce29ac9SDaniel Bristot de Oliveira }
974bce29ac9SDaniel Bristot de Oliveira 
975bce29ac9SDaniel Bristot de Oliveira /*
976bce29ac9SDaniel Bristot de Oliveira  * arch specific register function.
977bce29ac9SDaniel Bristot de Oliveira  */
978bce29ac9SDaniel Bristot de Oliveira int __weak osnoise_arch_register(void)
979bce29ac9SDaniel Bristot de Oliveira {
980bce29ac9SDaniel Bristot de Oliveira 	return 0;
981bce29ac9SDaniel Bristot de Oliveira }
982bce29ac9SDaniel Bristot de Oliveira 
983bce29ac9SDaniel Bristot de Oliveira /*
984bce29ac9SDaniel Bristot de Oliveira  * arch specific unregister function.
985bce29ac9SDaniel Bristot de Oliveira  */
986bce29ac9SDaniel Bristot de Oliveira void __weak osnoise_arch_unregister(void)
987bce29ac9SDaniel Bristot de Oliveira {
988bce29ac9SDaniel Bristot de Oliveira 	return;
989bce29ac9SDaniel Bristot de Oliveira }
990bce29ac9SDaniel Bristot de Oliveira 
991bce29ac9SDaniel Bristot de Oliveira /*
992bce29ac9SDaniel Bristot de Oliveira  * hook_irq_events - Hook IRQ handling events
993bce29ac9SDaniel Bristot de Oliveira  *
994bce29ac9SDaniel Bristot de Oliveira  * This function hooks the IRQ related callbacks to the respective trace
995bce29ac9SDaniel Bristot de Oliveira  * events.
996bce29ac9SDaniel Bristot de Oliveira  */
997f7d9f637SDaniel Bristot de Oliveira static int hook_irq_events(void)
998bce29ac9SDaniel Bristot de Oliveira {
999bce29ac9SDaniel Bristot de Oliveira 	int ret;
1000bce29ac9SDaniel Bristot de Oliveira 
1001bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_entry(trace_irqentry_callback, NULL);
1002bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1003bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
1004bce29ac9SDaniel Bristot de Oliveira 
1005bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_irq_handler_exit(trace_irqexit_callback, NULL);
1006bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1007bce29ac9SDaniel Bristot de Oliveira 		goto out_unregister_entry;
1008bce29ac9SDaniel Bristot de Oliveira 
1009bce29ac9SDaniel Bristot de Oliveira 	ret = osnoise_arch_register();
1010bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1011bce29ac9SDaniel Bristot de Oliveira 		goto out_irq_exit;
1012bce29ac9SDaniel Bristot de Oliveira 
1013bce29ac9SDaniel Bristot de Oliveira 	return 0;
1014bce29ac9SDaniel Bristot de Oliveira 
1015bce29ac9SDaniel Bristot de Oliveira out_irq_exit:
1016bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
1017bce29ac9SDaniel Bristot de Oliveira out_unregister_entry:
1018bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
1019bce29ac9SDaniel Bristot de Oliveira out_err:
1020bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
1021bce29ac9SDaniel Bristot de Oliveira }
1022bce29ac9SDaniel Bristot de Oliveira 
1023bce29ac9SDaniel Bristot de Oliveira /*
1024bce29ac9SDaniel Bristot de Oliveira  * unhook_irq_events - Unhook IRQ handling events
1025bce29ac9SDaniel Bristot de Oliveira  *
1026bce29ac9SDaniel Bristot de Oliveira  * This function unhooks the IRQ related callbacks to the respective trace
1027bce29ac9SDaniel Bristot de Oliveira  * events.
1028bce29ac9SDaniel Bristot de Oliveira  */
1029f7d9f637SDaniel Bristot de Oliveira static void unhook_irq_events(void)
1030bce29ac9SDaniel Bristot de Oliveira {
1031bce29ac9SDaniel Bristot de Oliveira 	osnoise_arch_unregister();
1032bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_exit(trace_irqexit_callback, NULL);
1033bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_irq_handler_entry(trace_irqentry_callback, NULL);
1034bce29ac9SDaniel Bristot de Oliveira }
1035bce29ac9SDaniel Bristot de Oliveira 
1036bce29ac9SDaniel Bristot de Oliveira #ifndef CONFIG_PREEMPT_RT
1037bce29ac9SDaniel Bristot de Oliveira /*
1038bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_entry_callback - Note the starting of a softirq
1039bce29ac9SDaniel Bristot de Oliveira  *
1040bce29ac9SDaniel Bristot de Oliveira  * Save the starting time of a softirq. As softirqs are non-preemptive to
1041bce29ac9SDaniel Bristot de Oliveira  * other softirqs, it is safe to use a single variable (ons_var->softirq)
1042bce29ac9SDaniel Bristot de Oliveira  * to save the statistics. The arrival_time is used to report... the
1043bce29ac9SDaniel Bristot de Oliveira  * arrival time. The delta_start is used to compute the duration at the
1044bce29ac9SDaniel Bristot de Oliveira  * softirq exit handler. See cond_move_softirq_delta_start().
1045bce29ac9SDaniel Bristot de Oliveira  */
1046f7d9f637SDaniel Bristot de Oliveira static void trace_softirq_entry_callback(void *data, unsigned int vec_nr)
1047bce29ac9SDaniel Bristot de Oliveira {
1048bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1049bce29ac9SDaniel Bristot de Oliveira 
1050bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1051bce29ac9SDaniel Bristot de Oliveira 		return;
1052bce29ac9SDaniel Bristot de Oliveira 	/*
1053bce29ac9SDaniel Bristot de Oliveira 	 * This value will be used in the report, but not to compute
1054bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
1055bce29ac9SDaniel Bristot de Oliveira 	 */
1056bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = time_get();
1057bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->softirq.delta_start);
1058bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.count++;
1059bce29ac9SDaniel Bristot de Oliveira 
1060bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
1061bce29ac9SDaniel Bristot de Oliveira }
1062bce29ac9SDaniel Bristot de Oliveira 
1063bce29ac9SDaniel Bristot de Oliveira /*
1064bce29ac9SDaniel Bristot de Oliveira  * trace_softirq_exit_callback - Note the end of an softirq
1065bce29ac9SDaniel Bristot de Oliveira  *
1066bce29ac9SDaniel Bristot de Oliveira  * Computes the duration of the softirq noise, and trace it. Also discounts the
1067bce29ac9SDaniel Bristot de Oliveira  * interference from other sources of noise could be currently being accounted.
1068bce29ac9SDaniel Bristot de Oliveira  */
1069f7d9f637SDaniel Bristot de Oliveira static void trace_softirq_exit_callback(void *data, unsigned int vec_nr)
1070bce29ac9SDaniel Bristot de Oliveira {
1071bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1072022632f6SDaniel Bristot de Oliveira 	s64 duration;
1073bce29ac9SDaniel Bristot de Oliveira 
1074bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1075bce29ac9SDaniel Bristot de Oliveira 		return;
1076bce29ac9SDaniel Bristot de Oliveira 
1077ccb67544SDaniel Bristot de Oliveira 	if (unlikely(timerlat_enabled()))
1078ccb67544SDaniel Bristot de Oliveira 		if (!timerlat_softirq_exit(osn_var))
1079a955d7eaSDaniel Bristot de Oliveira 			return;
1080a955d7eaSDaniel Bristot de Oliveira 
1081bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->softirq.delta_start);
1082bce29ac9SDaniel Bristot de Oliveira 	trace_softirq_noise(vec_nr, osn_var->softirq.arrival_time, duration);
1083bce29ac9SDaniel Bristot de Oliveira 	cond_move_thread_delta_start(osn_var, duration);
1084bce29ac9SDaniel Bristot de Oliveira 	osn_var->softirq.arrival_time = 0;
1085bce29ac9SDaniel Bristot de Oliveira }
1086bce29ac9SDaniel Bristot de Oliveira 
1087bce29ac9SDaniel Bristot de Oliveira /*
1088bce29ac9SDaniel Bristot de Oliveira  * hook_softirq_events - Hook softirq handling events
1089bce29ac9SDaniel Bristot de Oliveira  *
1090bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
1091bce29ac9SDaniel Bristot de Oliveira  * events.
1092bce29ac9SDaniel Bristot de Oliveira  */
1093bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
1094bce29ac9SDaniel Bristot de Oliveira {
1095bce29ac9SDaniel Bristot de Oliveira 	int ret;
1096bce29ac9SDaniel Bristot de Oliveira 
1097bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1098bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1099bce29ac9SDaniel Bristot de Oliveira 		goto out_err;
1100bce29ac9SDaniel Bristot de Oliveira 
1101bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_softirq_exit(trace_softirq_exit_callback, NULL);
1102bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1103bce29ac9SDaniel Bristot de Oliveira 		goto out_unreg_entry;
1104bce29ac9SDaniel Bristot de Oliveira 
1105bce29ac9SDaniel Bristot de Oliveira 	return 0;
1106bce29ac9SDaniel Bristot de Oliveira 
1107bce29ac9SDaniel Bristot de Oliveira out_unreg_entry:
1108bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1109bce29ac9SDaniel Bristot de Oliveira out_err:
1110bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
1111bce29ac9SDaniel Bristot de Oliveira }
1112bce29ac9SDaniel Bristot de Oliveira 
1113bce29ac9SDaniel Bristot de Oliveira /*
1114bce29ac9SDaniel Bristot de Oliveira  * unhook_softirq_events - Unhook softirq handling events
1115bce29ac9SDaniel Bristot de Oliveira  *
1116bce29ac9SDaniel Bristot de Oliveira  * This function hooks the softirq related callbacks to the respective trace
1117bce29ac9SDaniel Bristot de Oliveira  * events.
1118bce29ac9SDaniel Bristot de Oliveira  */
1119bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
1120bce29ac9SDaniel Bristot de Oliveira {
1121bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_entry(trace_softirq_entry_callback, NULL);
1122bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_softirq_exit(trace_softirq_exit_callback, NULL);
1123bce29ac9SDaniel Bristot de Oliveira }
1124bce29ac9SDaniel Bristot de Oliveira #else /* CONFIG_PREEMPT_RT */
1125bce29ac9SDaniel Bristot de Oliveira /*
1126bce29ac9SDaniel Bristot de Oliveira  * softirq are threads on the PREEMPT_RT mode.
1127bce29ac9SDaniel Bristot de Oliveira  */
1128bce29ac9SDaniel Bristot de Oliveira static int hook_softirq_events(void)
1129bce29ac9SDaniel Bristot de Oliveira {
1130bce29ac9SDaniel Bristot de Oliveira 	return 0;
1131bce29ac9SDaniel Bristot de Oliveira }
1132bce29ac9SDaniel Bristot de Oliveira static void unhook_softirq_events(void)
1133bce29ac9SDaniel Bristot de Oliveira {
1134bce29ac9SDaniel Bristot de Oliveira }
1135bce29ac9SDaniel Bristot de Oliveira #endif
1136bce29ac9SDaniel Bristot de Oliveira 
1137bce29ac9SDaniel Bristot de Oliveira /*
1138bce29ac9SDaniel Bristot de Oliveira  * thread_entry - Record the starting of a thread noise window
1139bce29ac9SDaniel Bristot de Oliveira  *
1140bce29ac9SDaniel Bristot de Oliveira  * It saves the context switch time for a noisy thread, and increments
1141bce29ac9SDaniel Bristot de Oliveira  * the interference counters.
1142bce29ac9SDaniel Bristot de Oliveira  */
1143bce29ac9SDaniel Bristot de Oliveira static void
1144bce29ac9SDaniel Bristot de Oliveira thread_entry(struct osnoise_variables *osn_var, struct task_struct *t)
1145bce29ac9SDaniel Bristot de Oliveira {
1146bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1147bce29ac9SDaniel Bristot de Oliveira 		return;
1148bce29ac9SDaniel Bristot de Oliveira 	/*
1149bce29ac9SDaniel Bristot de Oliveira 	 * The arrival time will be used in the report, but not to compute
1150bce29ac9SDaniel Bristot de Oliveira 	 * the execution time, so it is safe to get it unsafe.
1151bce29ac9SDaniel Bristot de Oliveira 	 */
1152bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
1153bce29ac9SDaniel Bristot de Oliveira 
1154bce29ac9SDaniel Bristot de Oliveira 	set_int_safe_time(osn_var, &osn_var->thread.delta_start);
1155bce29ac9SDaniel Bristot de Oliveira 
1156bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.count++;
1157bce29ac9SDaniel Bristot de Oliveira 	local_inc(&osn_var->int_counter);
1158bce29ac9SDaniel Bristot de Oliveira }
1159bce29ac9SDaniel Bristot de Oliveira 
1160bce29ac9SDaniel Bristot de Oliveira /*
1161bce29ac9SDaniel Bristot de Oliveira  * thread_exit - Report the end of a thread noise window
1162bce29ac9SDaniel Bristot de Oliveira  *
1163bce29ac9SDaniel Bristot de Oliveira  * It computes the total noise from a thread, tracing if needed.
1164bce29ac9SDaniel Bristot de Oliveira  */
1165bce29ac9SDaniel Bristot de Oliveira static void
1166bce29ac9SDaniel Bristot de Oliveira thread_exit(struct osnoise_variables *osn_var, struct task_struct *t)
1167bce29ac9SDaniel Bristot de Oliveira {
1168022632f6SDaniel Bristot de Oliveira 	s64 duration;
1169bce29ac9SDaniel Bristot de Oliveira 
1170bce29ac9SDaniel Bristot de Oliveira 	if (!osn_var->sampling)
1171bce29ac9SDaniel Bristot de Oliveira 		return;
1172bce29ac9SDaniel Bristot de Oliveira 
1173ccb67544SDaniel Bristot de Oliveira 	if (unlikely(timerlat_enabled()))
1174ccb67544SDaniel Bristot de Oliveira 		if (!timerlat_thread_exit(osn_var))
1175a955d7eaSDaniel Bristot de Oliveira 			return;
1176a955d7eaSDaniel Bristot de Oliveira 
1177bce29ac9SDaniel Bristot de Oliveira 	duration = get_int_safe_duration(osn_var, &osn_var->thread.delta_start);
1178bce29ac9SDaniel Bristot de Oliveira 
1179bce29ac9SDaniel Bristot de Oliveira 	trace_thread_noise(t, osn_var->thread.arrival_time, duration);
1180bce29ac9SDaniel Bristot de Oliveira 
1181bce29ac9SDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = 0;
1182bce29ac9SDaniel Bristot de Oliveira }
1183bce29ac9SDaniel Bristot de Oliveira 
1184bce29ac9SDaniel Bristot de Oliveira /*
1185bce29ac9SDaniel Bristot de Oliveira  * trace_sched_switch - sched:sched_switch trace event handler
1186bce29ac9SDaniel Bristot de Oliveira  *
1187bce29ac9SDaniel Bristot de Oliveira  * This function is hooked to the sched:sched_switch trace event, and it is
1188bce29ac9SDaniel Bristot de Oliveira  * used to record the beginning and to report the end of a thread noise window.
1189bce29ac9SDaniel Bristot de Oliveira  */
1190f7d9f637SDaniel Bristot de Oliveira static void
1191fa2c3254SValentin Schneider trace_sched_switch_callback(void *data, bool preempt,
1192fa2c3254SValentin Schneider 			    struct task_struct *p,
11939c2136beSDelyan Kratunov 			    struct task_struct *n,
11949c2136beSDelyan Kratunov 			    unsigned int prev_state)
1195bce29ac9SDaniel Bristot de Oliveira {
1196bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
119730838fcdSDaniel Bristot de Oliveira 	int workload = test_bit(OSN_WORKLOAD, &osnoise_options);
1198bce29ac9SDaniel Bristot de Oliveira 
119930838fcdSDaniel Bristot de Oliveira 	if ((p->pid != osn_var->pid) || !workload)
1200bce29ac9SDaniel Bristot de Oliveira 		thread_exit(osn_var, p);
1201bce29ac9SDaniel Bristot de Oliveira 
120230838fcdSDaniel Bristot de Oliveira 	if ((n->pid != osn_var->pid) || !workload)
1203bce29ac9SDaniel Bristot de Oliveira 		thread_entry(osn_var, n);
1204bce29ac9SDaniel Bristot de Oliveira }
1205bce29ac9SDaniel Bristot de Oliveira 
1206bce29ac9SDaniel Bristot de Oliveira /*
1207bce29ac9SDaniel Bristot de Oliveira  * hook_thread_events - Hook the insturmentation for thread noise
1208bce29ac9SDaniel Bristot de Oliveira  *
1209bce29ac9SDaniel Bristot de Oliveira  * Hook the osnoise tracer callbacks to handle the noise from other
1210bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
1211bce29ac9SDaniel Bristot de Oliveira  */
1212f7d9f637SDaniel Bristot de Oliveira static int hook_thread_events(void)
1213bce29ac9SDaniel Bristot de Oliveira {
1214bce29ac9SDaniel Bristot de Oliveira 	int ret;
1215bce29ac9SDaniel Bristot de Oliveira 
1216bce29ac9SDaniel Bristot de Oliveira 	ret = register_trace_sched_switch(trace_sched_switch_callback, NULL);
1217bce29ac9SDaniel Bristot de Oliveira 	if (ret)
1218bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
1219bce29ac9SDaniel Bristot de Oliveira 
1220bce29ac9SDaniel Bristot de Oliveira 	return 0;
1221bce29ac9SDaniel Bristot de Oliveira }
1222bce29ac9SDaniel Bristot de Oliveira 
1223bce29ac9SDaniel Bristot de Oliveira /*
1224bce29ac9SDaniel Bristot de Oliveira  * unhook_thread_events - *nhook the insturmentation for thread noise
1225bce29ac9SDaniel Bristot de Oliveira  *
1226bce29ac9SDaniel Bristot de Oliveira  * Unook the osnoise tracer callbacks to handle the noise from other
1227bce29ac9SDaniel Bristot de Oliveira  * threads on the necessary kernel events.
1228bce29ac9SDaniel Bristot de Oliveira  */
1229f7d9f637SDaniel Bristot de Oliveira static void unhook_thread_events(void)
1230bce29ac9SDaniel Bristot de Oliveira {
1231bce29ac9SDaniel Bristot de Oliveira 	unregister_trace_sched_switch(trace_sched_switch_callback, NULL);
1232bce29ac9SDaniel Bristot de Oliveira }
1233bce29ac9SDaniel Bristot de Oliveira 
1234bce29ac9SDaniel Bristot de Oliveira /*
1235bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats - Save the osnoise_sample statistics
1236bce29ac9SDaniel Bristot de Oliveira  *
1237bce29ac9SDaniel Bristot de Oliveira  * Save the osnoise_sample statistics before the sampling phase. These
1238bce29ac9SDaniel Bristot de Oliveira  * values will be used later to compute the diff betwneen the statistics
1239bce29ac9SDaniel Bristot de Oliveira  * before and after the osnoise sampling.
1240bce29ac9SDaniel Bristot de Oliveira  */
1241f7d9f637SDaniel Bristot de Oliveira static void
1242f7d9f637SDaniel Bristot de Oliveira save_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1243bce29ac9SDaniel Bristot de Oliveira {
1244bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count;
1245bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count;
1246bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count;
1247bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count;
1248bce29ac9SDaniel Bristot de Oliveira }
1249bce29ac9SDaniel Bristot de Oliveira 
1250bce29ac9SDaniel Bristot de Oliveira /*
1251bce29ac9SDaniel Bristot de Oliveira  * diff_osn_sample_stats - Compute the osnoise_sample statistics
1252bce29ac9SDaniel Bristot de Oliveira  *
1253bce29ac9SDaniel Bristot de Oliveira  * After a sample period, compute the difference on the osnoise_sample
1254bce29ac9SDaniel Bristot de Oliveira  * statistics. The struct osnoise_sample *s contains the statistics saved via
1255bce29ac9SDaniel Bristot de Oliveira  * save_osn_sample_stats() before the osnoise sampling.
1256bce29ac9SDaniel Bristot de Oliveira  */
1257f7d9f637SDaniel Bristot de Oliveira static void
1258f7d9f637SDaniel Bristot de Oliveira diff_osn_sample_stats(struct osnoise_variables *osn_var, struct osnoise_sample *s)
1259bce29ac9SDaniel Bristot de Oliveira {
1260bce29ac9SDaniel Bristot de Oliveira 	s->nmi_count = osn_var->nmi.count - s->nmi_count;
1261bce29ac9SDaniel Bristot de Oliveira 	s->irq_count = osn_var->irq.count - s->irq_count;
1262bce29ac9SDaniel Bristot de Oliveira 	s->softirq_count = osn_var->softirq.count - s->softirq_count;
1263bce29ac9SDaniel Bristot de Oliveira 	s->thread_count = osn_var->thread.count - s->thread_count;
1264bce29ac9SDaniel Bristot de Oliveira }
1265bce29ac9SDaniel Bristot de Oliveira 
1266bce29ac9SDaniel Bristot de Oliveira /*
1267bce29ac9SDaniel Bristot de Oliveira  * osnoise_stop_tracing - Stop tracing and the tracer.
1268bce29ac9SDaniel Bristot de Oliveira  */
12690e05ba49SDaniel Bristot de Oliveira static __always_inline void osnoise_stop_tracing(void)
1270bce29ac9SDaniel Bristot de Oliveira {
1271dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
1272dae18134SDaniel Bristot de Oliveira 	struct trace_array *tr;
12730e05ba49SDaniel Bristot de Oliveira 
1274dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
1275dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
1276dae18134SDaniel Bristot de Oliveira 		tr = inst->tr;
12770e05ba49SDaniel Bristot de Oliveira 		trace_array_printk_buf(tr->array_buffer.buffer, _THIS_IP_,
12780e05ba49SDaniel Bristot de Oliveira 				"stop tracing hit on cpu %d\n", smp_processor_id());
12790e05ba49SDaniel Bristot de Oliveira 
12801603dda4SDaniel Bristot de Oliveira 		if (test_bit(OSN_PANIC_ON_STOP, &osnoise_options))
12811603dda4SDaniel Bristot de Oliveira 			panic("tracer hit stop condition on CPU %d\n", smp_processor_id());
12821603dda4SDaniel Bristot de Oliveira 
1283bce29ac9SDaniel Bristot de Oliveira 		tracer_tracing_off(tr);
1284bce29ac9SDaniel Bristot de Oliveira 	}
1285dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
1286dae18134SDaniel Bristot de Oliveira }
1287dae18134SDaniel Bristot de Oliveira 
1288dae18134SDaniel Bristot de Oliveira /*
1289*cb7ca871SDaniel Bristot de Oliveira  * osnoise_has_tracing_on - Check if there is at least one instance on
1290*cb7ca871SDaniel Bristot de Oliveira  */
1291*cb7ca871SDaniel Bristot de Oliveira static __always_inline int osnoise_has_tracing_on(void)
1292*cb7ca871SDaniel Bristot de Oliveira {
1293*cb7ca871SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
1294*cb7ca871SDaniel Bristot de Oliveira 	int trace_is_on = 0;
1295*cb7ca871SDaniel Bristot de Oliveira 
1296*cb7ca871SDaniel Bristot de Oliveira 	rcu_read_lock();
1297*cb7ca871SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list)
1298*cb7ca871SDaniel Bristot de Oliveira 		trace_is_on += tracer_tracing_is_on(inst->tr);
1299*cb7ca871SDaniel Bristot de Oliveira 	rcu_read_unlock();
1300*cb7ca871SDaniel Bristot de Oliveira 
1301*cb7ca871SDaniel Bristot de Oliveira 	return trace_is_on;
1302*cb7ca871SDaniel Bristot de Oliveira }
1303*cb7ca871SDaniel Bristot de Oliveira 
1304*cb7ca871SDaniel Bristot de Oliveira /*
1305dae18134SDaniel Bristot de Oliveira  * notify_new_max_latency - Notify a new max latency via fsnotify interface.
1306dae18134SDaniel Bristot de Oliveira  */
1307dae18134SDaniel Bristot de Oliveira static void notify_new_max_latency(u64 latency)
1308dae18134SDaniel Bristot de Oliveira {
1309dae18134SDaniel Bristot de Oliveira 	struct osnoise_instance *inst;
1310dae18134SDaniel Bristot de Oliveira 	struct trace_array *tr;
1311dae18134SDaniel Bristot de Oliveira 
1312dae18134SDaniel Bristot de Oliveira 	rcu_read_lock();
1313dae18134SDaniel Bristot de Oliveira 	list_for_each_entry_rcu(inst, &osnoise_instances, list) {
1314dae18134SDaniel Bristot de Oliveira 		tr = inst->tr;
1315d3cba7f0SDaniel Bristot de Oliveira 		if (tracer_tracing_is_on(tr) && tr->max_latency < latency) {
1316dae18134SDaniel Bristot de Oliveira 			tr->max_latency = latency;
1317dae18134SDaniel Bristot de Oliveira 			latency_fsnotify(tr);
1318dae18134SDaniel Bristot de Oliveira 		}
1319dae18134SDaniel Bristot de Oliveira 	}
1320dae18134SDaniel Bristot de Oliveira 	rcu_read_unlock();
1321dae18134SDaniel Bristot de Oliveira }
1322bce29ac9SDaniel Bristot de Oliveira 
1323bce29ac9SDaniel Bristot de Oliveira /*
1324bce29ac9SDaniel Bristot de Oliveira  * run_osnoise - Sample the time and look for osnoise
1325bce29ac9SDaniel Bristot de Oliveira  *
1326bce29ac9SDaniel Bristot de Oliveira  * Used to capture the time, looking for potential osnoise latency repeatedly.
1327bce29ac9SDaniel Bristot de Oliveira  * Different from hwlat_detector, it is called with preemption and interrupts
1328bce29ac9SDaniel Bristot de Oliveira  * enabled. This allows irqs, softirqs and threads to run, interfering on the
1329bce29ac9SDaniel Bristot de Oliveira  * osnoise sampling thread, as they would do with a regular thread.
1330bce29ac9SDaniel Bristot de Oliveira  */
1331bce29ac9SDaniel Bristot de Oliveira static int run_osnoise(void)
1332bce29ac9SDaniel Bristot de Oliveira {
1333b5dce200SDaniel Bristot de Oliveira 	bool disable_irq = test_bit(OSN_IRQ_DISABLE, &osnoise_options);
1334bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1335bce29ac9SDaniel Bristot de Oliveira 	u64 start, sample, last_sample;
1336bce29ac9SDaniel Bristot de Oliveira 	u64 last_int_count, int_count;
133719c3eaa7SDaniel Bristot de Oliveira 	s64 noise = 0, max_noise = 0;
1338bce29ac9SDaniel Bristot de Oliveira 	s64 total, last_total = 0;
1339bce29ac9SDaniel Bristot de Oliveira 	struct osnoise_sample s;
1340b5dce200SDaniel Bristot de Oliveira 	bool disable_preemption;
1341bce29ac9SDaniel Bristot de Oliveira 	unsigned int threshold;
1342bce29ac9SDaniel Bristot de Oliveira 	u64 runtime, stop_in;
134319c3eaa7SDaniel Bristot de Oliveira 	u64 sum_noise = 0;
134419c3eaa7SDaniel Bristot de Oliveira 	int hw_count = 0;
1345bce29ac9SDaniel Bristot de Oliveira 	int ret = -1;
1346bce29ac9SDaniel Bristot de Oliveira 
1347bce29ac9SDaniel Bristot de Oliveira 	/*
1348b5dce200SDaniel Bristot de Oliveira 	 * Disabling preemption is only required if IRQs are enabled,
1349b5dce200SDaniel Bristot de Oliveira 	 * and the options is set on.
1350b5dce200SDaniel Bristot de Oliveira 	 */
1351b5dce200SDaniel Bristot de Oliveira 	disable_preemption = !disable_irq && test_bit(OSN_PREEMPT_DISABLE, &osnoise_options);
1352b5dce200SDaniel Bristot de Oliveira 
1353b5dce200SDaniel Bristot de Oliveira 	/*
1354bce29ac9SDaniel Bristot de Oliveira 	 * Considers the current thread as the workload.
1355bce29ac9SDaniel Bristot de Oliveira 	 */
1356bce29ac9SDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1357bce29ac9SDaniel Bristot de Oliveira 
1358bce29ac9SDaniel Bristot de Oliveira 	/*
1359bce29ac9SDaniel Bristot de Oliveira 	 * Save the current stats for the diff
1360bce29ac9SDaniel Bristot de Oliveira 	 */
1361bce29ac9SDaniel Bristot de Oliveira 	save_osn_sample_stats(osn_var, &s);
1362bce29ac9SDaniel Bristot de Oliveira 
1363bce29ac9SDaniel Bristot de Oliveira 	/*
1364bce29ac9SDaniel Bristot de Oliveira 	 * if threshold is 0, use the default value of 5 us.
1365bce29ac9SDaniel Bristot de Oliveira 	 */
1366bce29ac9SDaniel Bristot de Oliveira 	threshold = tracing_thresh ? : 5000;
1367bce29ac9SDaniel Bristot de Oliveira 
1368bce29ac9SDaniel Bristot de Oliveira 	/*
1369b5dce200SDaniel Bristot de Oliveira 	 * Apply PREEMPT and IRQ disabled options.
1370b5dce200SDaniel Bristot de Oliveira 	 */
1371b5dce200SDaniel Bristot de Oliveira 	if (disable_irq)
1372b5dce200SDaniel Bristot de Oliveira 		local_irq_disable();
1373b5dce200SDaniel Bristot de Oliveira 
1374b5dce200SDaniel Bristot de Oliveira 	if (disable_preemption)
1375b5dce200SDaniel Bristot de Oliveira 		preempt_disable();
1376b5dce200SDaniel Bristot de Oliveira 
1377b5dce200SDaniel Bristot de Oliveira 	/*
1378bce29ac9SDaniel Bristot de Oliveira 	 * Make sure NMIs see sampling first
1379bce29ac9SDaniel Bristot de Oliveira 	 */
1380bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = true;
1381bce29ac9SDaniel Bristot de Oliveira 	barrier();
1382bce29ac9SDaniel Bristot de Oliveira 
1383bce29ac9SDaniel Bristot de Oliveira 	/*
1384bce29ac9SDaniel Bristot de Oliveira 	 * Transform the *_us config to nanoseconds to avoid the
1385bce29ac9SDaniel Bristot de Oliveira 	 * division on the main loop.
1386bce29ac9SDaniel Bristot de Oliveira 	 */
1387bce29ac9SDaniel Bristot de Oliveira 	runtime = osnoise_data.sample_runtime * NSEC_PER_USEC;
1388bce29ac9SDaniel Bristot de Oliveira 	stop_in = osnoise_data.stop_tracing * NSEC_PER_USEC;
1389bce29ac9SDaniel Bristot de Oliveira 
1390bce29ac9SDaniel Bristot de Oliveira 	/*
1391bce29ac9SDaniel Bristot de Oliveira 	 * Start timestemp
1392bce29ac9SDaniel Bristot de Oliveira 	 */
1393bce29ac9SDaniel Bristot de Oliveira 	start = time_get();
1394bce29ac9SDaniel Bristot de Oliveira 
1395bce29ac9SDaniel Bristot de Oliveira 	/*
1396bce29ac9SDaniel Bristot de Oliveira 	 * "previous" loop.
1397bce29ac9SDaniel Bristot de Oliveira 	 */
1398bce29ac9SDaniel Bristot de Oliveira 	last_int_count = set_int_safe_time(osn_var, &last_sample);
1399bce29ac9SDaniel Bristot de Oliveira 
1400bce29ac9SDaniel Bristot de Oliveira 	do {
1401bce29ac9SDaniel Bristot de Oliveira 		/*
1402bce29ac9SDaniel Bristot de Oliveira 		 * Get sample!
1403bce29ac9SDaniel Bristot de Oliveira 		 */
1404bce29ac9SDaniel Bristot de Oliveira 		int_count = set_int_safe_time(osn_var, &sample);
1405bce29ac9SDaniel Bristot de Oliveira 
1406bce29ac9SDaniel Bristot de Oliveira 		noise = time_sub(sample, last_sample);
1407bce29ac9SDaniel Bristot de Oliveira 
1408bce29ac9SDaniel Bristot de Oliveira 		/*
1409bce29ac9SDaniel Bristot de Oliveira 		 * This shouldn't happen.
1410bce29ac9SDaniel Bristot de Oliveira 		 */
1411bce29ac9SDaniel Bristot de Oliveira 		if (noise < 0) {
1412bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("negative noise!");
1413bce29ac9SDaniel Bristot de Oliveira 			goto out;
1414bce29ac9SDaniel Bristot de Oliveira 		}
1415bce29ac9SDaniel Bristot de Oliveira 
1416bce29ac9SDaniel Bristot de Oliveira 		/*
1417bce29ac9SDaniel Bristot de Oliveira 		 * Sample runtime.
1418bce29ac9SDaniel Bristot de Oliveira 		 */
1419bce29ac9SDaniel Bristot de Oliveira 		total = time_sub(sample, start);
1420bce29ac9SDaniel Bristot de Oliveira 
1421bce29ac9SDaniel Bristot de Oliveira 		/*
1422bce29ac9SDaniel Bristot de Oliveira 		 * Check for possible overflows.
1423bce29ac9SDaniel Bristot de Oliveira 		 */
1424bce29ac9SDaniel Bristot de Oliveira 		if (total < last_total) {
1425bce29ac9SDaniel Bristot de Oliveira 			osnoise_taint("total overflow!");
1426bce29ac9SDaniel Bristot de Oliveira 			break;
1427bce29ac9SDaniel Bristot de Oliveira 		}
1428bce29ac9SDaniel Bristot de Oliveira 
1429bce29ac9SDaniel Bristot de Oliveira 		last_total = total;
1430bce29ac9SDaniel Bristot de Oliveira 
1431bce29ac9SDaniel Bristot de Oliveira 		if (noise >= threshold) {
1432bce29ac9SDaniel Bristot de Oliveira 			int interference = int_count - last_int_count;
1433bce29ac9SDaniel Bristot de Oliveira 
1434bce29ac9SDaniel Bristot de Oliveira 			if (noise > max_noise)
1435bce29ac9SDaniel Bristot de Oliveira 				max_noise = noise;
1436bce29ac9SDaniel Bristot de Oliveira 
1437bce29ac9SDaniel Bristot de Oliveira 			if (!interference)
1438bce29ac9SDaniel Bristot de Oliveira 				hw_count++;
1439bce29ac9SDaniel Bristot de Oliveira 
1440bce29ac9SDaniel Bristot de Oliveira 			sum_noise += noise;
1441bce29ac9SDaniel Bristot de Oliveira 
1442bce29ac9SDaniel Bristot de Oliveira 			trace_sample_threshold(last_sample, noise, interference);
1443bce29ac9SDaniel Bristot de Oliveira 
1444bce29ac9SDaniel Bristot de Oliveira 			if (osnoise_data.stop_tracing)
1445bce29ac9SDaniel Bristot de Oliveira 				if (noise > stop_in)
1446bce29ac9SDaniel Bristot de Oliveira 					osnoise_stop_tracing();
1447bce29ac9SDaniel Bristot de Oliveira 		}
1448bce29ac9SDaniel Bristot de Oliveira 
1449bce29ac9SDaniel Bristot de Oliveira 		/*
1450caf4c86bSNicolas Saenz Julienne 		 * In some cases, notably when running on a nohz_full CPU with
1451caf4c86bSNicolas Saenz Julienne 		 * a stopped tick PREEMPT_RCU has no way to account for QSs.
1452caf4c86bSNicolas Saenz Julienne 		 * This will eventually cause unwarranted noise as PREEMPT_RCU
1453caf4c86bSNicolas Saenz Julienne 		 * will force preemption as the means of ending the current
1454caf4c86bSNicolas Saenz Julienne 		 * grace period. We avoid this problem by calling
1455caf4c86bSNicolas Saenz Julienne 		 * rcu_momentary_dyntick_idle(), which performs a zero duration
1456caf4c86bSNicolas Saenz Julienne 		 * EQS allowing PREEMPT_RCU to end the current grace period.
1457caf4c86bSNicolas Saenz Julienne 		 * This call shouldn't be wrapped inside an RCU critical
1458caf4c86bSNicolas Saenz Julienne 		 * section.
1459caf4c86bSNicolas Saenz Julienne 		 *
1460caf4c86bSNicolas Saenz Julienne 		 * Note that in non PREEMPT_RCU kernels QSs are handled through
1461caf4c86bSNicolas Saenz Julienne 		 * cond_resched()
1462caf4c86bSNicolas Saenz Julienne 		 */
1463caf4c86bSNicolas Saenz Julienne 		if (IS_ENABLED(CONFIG_PREEMPT_RCU)) {
1464b5dce200SDaniel Bristot de Oliveira 			if (!disable_irq)
1465caf4c86bSNicolas Saenz Julienne 				local_irq_disable();
1466b5dce200SDaniel Bristot de Oliveira 
1467caf4c86bSNicolas Saenz Julienne 			rcu_momentary_dyntick_idle();
1468b5dce200SDaniel Bristot de Oliveira 
1469b5dce200SDaniel Bristot de Oliveira 			if (!disable_irq)
1470caf4c86bSNicolas Saenz Julienne 				local_irq_enable();
1471caf4c86bSNicolas Saenz Julienne 		}
1472caf4c86bSNicolas Saenz Julienne 
1473caf4c86bSNicolas Saenz Julienne 		/*
1474bce29ac9SDaniel Bristot de Oliveira 		 * For the non-preemptive kernel config: let threads runs, if
1475b5dce200SDaniel Bristot de Oliveira 		 * they so wish, unless set not do to so.
1476bce29ac9SDaniel Bristot de Oliveira 		 */
1477b5dce200SDaniel Bristot de Oliveira 		if (!disable_irq && !disable_preemption)
1478bce29ac9SDaniel Bristot de Oliveira 			cond_resched();
1479bce29ac9SDaniel Bristot de Oliveira 
1480bce29ac9SDaniel Bristot de Oliveira 		last_sample = sample;
1481bce29ac9SDaniel Bristot de Oliveira 		last_int_count = int_count;
1482bce29ac9SDaniel Bristot de Oliveira 
1483bce29ac9SDaniel Bristot de Oliveira 	} while (total < runtime && !kthread_should_stop());
1484bce29ac9SDaniel Bristot de Oliveira 
1485bce29ac9SDaniel Bristot de Oliveira 	/*
1486bce29ac9SDaniel Bristot de Oliveira 	 * Finish the above in the view for interrupts.
1487bce29ac9SDaniel Bristot de Oliveira 	 */
1488bce29ac9SDaniel Bristot de Oliveira 	barrier();
1489bce29ac9SDaniel Bristot de Oliveira 
1490bce29ac9SDaniel Bristot de Oliveira 	osn_var->sampling = false;
1491bce29ac9SDaniel Bristot de Oliveira 
1492bce29ac9SDaniel Bristot de Oliveira 	/*
1493bce29ac9SDaniel Bristot de Oliveira 	 * Make sure sampling data is no longer updated.
1494bce29ac9SDaniel Bristot de Oliveira 	 */
1495bce29ac9SDaniel Bristot de Oliveira 	barrier();
1496bce29ac9SDaniel Bristot de Oliveira 
1497bce29ac9SDaniel Bristot de Oliveira 	/*
1498b5dce200SDaniel Bristot de Oliveira 	 * Return to the preemptive state.
1499b5dce200SDaniel Bristot de Oliveira 	 */
1500b5dce200SDaniel Bristot de Oliveira 	if (disable_preemption)
1501b5dce200SDaniel Bristot de Oliveira 		preempt_enable();
1502b5dce200SDaniel Bristot de Oliveira 
1503b5dce200SDaniel Bristot de Oliveira 	if (disable_irq)
1504b5dce200SDaniel Bristot de Oliveira 		local_irq_enable();
1505b5dce200SDaniel Bristot de Oliveira 
1506b5dce200SDaniel Bristot de Oliveira 	/*
1507bce29ac9SDaniel Bristot de Oliveira 	 * Save noise info.
1508bce29ac9SDaniel Bristot de Oliveira 	 */
1509bce29ac9SDaniel Bristot de Oliveira 	s.noise = time_to_us(sum_noise);
1510bce29ac9SDaniel Bristot de Oliveira 	s.runtime = time_to_us(total);
1511bce29ac9SDaniel Bristot de Oliveira 	s.max_sample = time_to_us(max_noise);
1512bce29ac9SDaniel Bristot de Oliveira 	s.hw_count = hw_count;
1513bce29ac9SDaniel Bristot de Oliveira 
1514bce29ac9SDaniel Bristot de Oliveira 	/* Save interference stats info */
1515bce29ac9SDaniel Bristot de Oliveira 	diff_osn_sample_stats(osn_var, &s);
1516bce29ac9SDaniel Bristot de Oliveira 
1517bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_sample(&s);
1518bce29ac9SDaniel Bristot de Oliveira 
1519dae18134SDaniel Bristot de Oliveira 	notify_new_max_latency(max_noise);
1520bce29ac9SDaniel Bristot de Oliveira 
1521bce29ac9SDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing_total)
1522bce29ac9SDaniel Bristot de Oliveira 		if (s.noise > osnoise_data.stop_tracing_total)
1523bce29ac9SDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1524bce29ac9SDaniel Bristot de Oliveira 
1525bce29ac9SDaniel Bristot de Oliveira 	return 0;
1526bce29ac9SDaniel Bristot de Oliveira out:
1527bce29ac9SDaniel Bristot de Oliveira 	return ret;
1528bce29ac9SDaniel Bristot de Oliveira }
1529bce29ac9SDaniel Bristot de Oliveira 
1530bce29ac9SDaniel Bristot de Oliveira static struct cpumask osnoise_cpumask;
1531bce29ac9SDaniel Bristot de Oliveira static struct cpumask save_cpumask;
1532bce29ac9SDaniel Bristot de Oliveira 
1533bce29ac9SDaniel Bristot de Oliveira /*
1534dd990352SDaniel Bristot de Oliveira  * osnoise_sleep - sleep until the next period
1535dd990352SDaniel Bristot de Oliveira  */
1536*cb7ca871SDaniel Bristot de Oliveira static void osnoise_sleep(bool skip_period)
1537dd990352SDaniel Bristot de Oliveira {
1538dd990352SDaniel Bristot de Oliveira 	u64 interval;
1539dd990352SDaniel Bristot de Oliveira 	ktime_t wake_time;
1540dd990352SDaniel Bristot de Oliveira 
1541dd990352SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
1542*cb7ca871SDaniel Bristot de Oliveira 	if (skip_period)
1543*cb7ca871SDaniel Bristot de Oliveira 		interval = osnoise_data.sample_period;
1544*cb7ca871SDaniel Bristot de Oliveira 	else
1545dd990352SDaniel Bristot de Oliveira 		interval = osnoise_data.sample_period - osnoise_data.sample_runtime;
1546dd990352SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1547dd990352SDaniel Bristot de Oliveira 
1548dd990352SDaniel Bristot de Oliveira 	/*
1549dd990352SDaniel Bristot de Oliveira 	 * differently from hwlat_detector, the osnoise tracer can run
1550dd990352SDaniel Bristot de Oliveira 	 * without a pause because preemption is on.
1551dd990352SDaniel Bristot de Oliveira 	 */
1552dd990352SDaniel Bristot de Oliveira 	if (!interval) {
1553dd990352SDaniel Bristot de Oliveira 		/* Let synchronize_rcu_tasks() make progress */
1554dd990352SDaniel Bristot de Oliveira 		cond_resched_tasks_rcu_qs();
1555dd990352SDaniel Bristot de Oliveira 		return;
1556dd990352SDaniel Bristot de Oliveira 	}
1557dd990352SDaniel Bristot de Oliveira 
1558dd990352SDaniel Bristot de Oliveira 	wake_time = ktime_add_us(ktime_get(), interval);
1559dd990352SDaniel Bristot de Oliveira 	__set_current_state(TASK_INTERRUPTIBLE);
1560dd990352SDaniel Bristot de Oliveira 
1561b18c58afSDavidlohr Bueso 	while (schedule_hrtimeout(&wake_time, HRTIMER_MODE_ABS)) {
1562dd990352SDaniel Bristot de Oliveira 		if (kthread_should_stop())
1563dd990352SDaniel Bristot de Oliveira 			break;
1564dd990352SDaniel Bristot de Oliveira 	}
1565dd990352SDaniel Bristot de Oliveira }
1566dd990352SDaniel Bristot de Oliveira 
1567dd990352SDaniel Bristot de Oliveira /*
15684998e7fdSDaniel Bristot de Oliveira  * osnoise_migration_pending - checks if the task needs to migrate
15694998e7fdSDaniel Bristot de Oliveira  *
15704998e7fdSDaniel Bristot de Oliveira  * osnoise/timerlat threads are per-cpu. If there is a pending request to
15714998e7fdSDaniel Bristot de Oliveira  * migrate the thread away from the current CPU, something bad has happened.
15724998e7fdSDaniel Bristot de Oliveira  * Play the good citizen and leave.
15734998e7fdSDaniel Bristot de Oliveira  *
15744998e7fdSDaniel Bristot de Oliveira  * Returns 0 if it is safe to continue, 1 otherwise.
15754998e7fdSDaniel Bristot de Oliveira  */
15764998e7fdSDaniel Bristot de Oliveira static inline int osnoise_migration_pending(void)
15774998e7fdSDaniel Bristot de Oliveira {
15784998e7fdSDaniel Bristot de Oliveira 	if (!current->migration_pending)
15794998e7fdSDaniel Bristot de Oliveira 		return 0;
15804998e7fdSDaniel Bristot de Oliveira 
15814998e7fdSDaniel Bristot de Oliveira 	/*
15824998e7fdSDaniel Bristot de Oliveira 	 * If migration is pending, there is a task waiting for the
15834998e7fdSDaniel Bristot de Oliveira 	 * tracer to enable migration. The tracer does not allow migration,
15844998e7fdSDaniel Bristot de Oliveira 	 * thus: taint and leave to unblock the blocked thread.
15854998e7fdSDaniel Bristot de Oliveira 	 */
15864998e7fdSDaniel Bristot de Oliveira 	osnoise_taint("migration requested to osnoise threads, leaving.");
15874998e7fdSDaniel Bristot de Oliveira 
15884998e7fdSDaniel Bristot de Oliveira 	/*
15894998e7fdSDaniel Bristot de Oliveira 	 * Unset this thread from the threads managed by the interface.
15904998e7fdSDaniel Bristot de Oliveira 	 * The tracers are responsible for cleaning their env before
15914998e7fdSDaniel Bristot de Oliveira 	 * exiting.
15924998e7fdSDaniel Bristot de Oliveira 	 */
15934998e7fdSDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
15944998e7fdSDaniel Bristot de Oliveira 	this_cpu_osn_var()->kthread = NULL;
15954998e7fdSDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
15964998e7fdSDaniel Bristot de Oliveira 
15974998e7fdSDaniel Bristot de Oliveira 	return 1;
15984998e7fdSDaniel Bristot de Oliveira }
15994998e7fdSDaniel Bristot de Oliveira 
16004998e7fdSDaniel Bristot de Oliveira /*
1601bce29ac9SDaniel Bristot de Oliveira  * osnoise_main - The osnoise detection kernel thread
1602bce29ac9SDaniel Bristot de Oliveira  *
1603bce29ac9SDaniel Bristot de Oliveira  * Calls run_osnoise() function to measure the osnoise for the configured runtime,
1604bce29ac9SDaniel Bristot de Oliveira  * every period.
1605bce29ac9SDaniel Bristot de Oliveira  */
1606bce29ac9SDaniel Bristot de Oliveira static int osnoise_main(void *data)
1607bce29ac9SDaniel Bristot de Oliveira {
16084998e7fdSDaniel Bristot de Oliveira 	unsigned long flags;
16094998e7fdSDaniel Bristot de Oliveira 
16104998e7fdSDaniel Bristot de Oliveira 	/*
16114998e7fdSDaniel Bristot de Oliveira 	 * This thread was created pinned to the CPU using PF_NO_SETAFFINITY.
16124998e7fdSDaniel Bristot de Oliveira 	 * The problem is that cgroup does not allow PF_NO_SETAFFINITY thread.
16134998e7fdSDaniel Bristot de Oliveira 	 *
16144998e7fdSDaniel Bristot de Oliveira 	 * To work around this limitation, disable migration and remove the
16154998e7fdSDaniel Bristot de Oliveira 	 * flag.
16164998e7fdSDaniel Bristot de Oliveira 	 */
16174998e7fdSDaniel Bristot de Oliveira 	migrate_disable();
16184998e7fdSDaniel Bristot de Oliveira 	raw_spin_lock_irqsave(&current->pi_lock, flags);
16194998e7fdSDaniel Bristot de Oliveira 	current->flags &= ~(PF_NO_SETAFFINITY);
16204998e7fdSDaniel Bristot de Oliveira 	raw_spin_unlock_irqrestore(&current->pi_lock, flags);
1621bce29ac9SDaniel Bristot de Oliveira 
1622bce29ac9SDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
16234998e7fdSDaniel Bristot de Oliveira 		if (osnoise_migration_pending())
16244998e7fdSDaniel Bristot de Oliveira 			break;
16254998e7fdSDaniel Bristot de Oliveira 
1626*cb7ca871SDaniel Bristot de Oliveira 		/* skip a period if tracing is off on all instances */
1627*cb7ca871SDaniel Bristot de Oliveira 		if (!osnoise_has_tracing_on()) {
1628*cb7ca871SDaniel Bristot de Oliveira 			osnoise_sleep(true);
1629*cb7ca871SDaniel Bristot de Oliveira 			continue;
1630*cb7ca871SDaniel Bristot de Oliveira 		}
1631*cb7ca871SDaniel Bristot de Oliveira 
1632bce29ac9SDaniel Bristot de Oliveira 		run_osnoise();
1633*cb7ca871SDaniel Bristot de Oliveira 		osnoise_sleep(false);
1634bce29ac9SDaniel Bristot de Oliveira 	}
1635bce29ac9SDaniel Bristot de Oliveira 
16364998e7fdSDaniel Bristot de Oliveira 	migrate_enable();
1637bce29ac9SDaniel Bristot de Oliveira 	return 0;
1638bce29ac9SDaniel Bristot de Oliveira }
1639bce29ac9SDaniel Bristot de Oliveira 
1640a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
1641a955d7eaSDaniel Bristot de Oliveira /*
1642a955d7eaSDaniel Bristot de Oliveira  * timerlat_irq - hrtimer handler for timerlat.
1643a955d7eaSDaniel Bristot de Oliveira  */
1644a955d7eaSDaniel Bristot de Oliveira static enum hrtimer_restart timerlat_irq(struct hrtimer *timer)
1645a955d7eaSDaniel Bristot de Oliveira {
1646a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1647a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat;
1648a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1649a955d7eaSDaniel Bristot de Oliveira 	u64 now;
1650a955d7eaSDaniel Bristot de Oliveira 	u64 diff;
1651a955d7eaSDaniel Bristot de Oliveira 
1652a955d7eaSDaniel Bristot de Oliveira 	/*
1653a955d7eaSDaniel Bristot de Oliveira 	 * I am not sure if the timer was armed for this CPU. So, get
1654a955d7eaSDaniel Bristot de Oliveira 	 * the timerlat struct from the timer itself, not from this
1655a955d7eaSDaniel Bristot de Oliveira 	 * CPU.
1656a955d7eaSDaniel Bristot de Oliveira 	 */
1657a955d7eaSDaniel Bristot de Oliveira 	tlat = container_of(timer, struct timerlat_variables, timer);
1658a955d7eaSDaniel Bristot de Oliveira 
1659a955d7eaSDaniel Bristot de Oliveira 	now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1660a955d7eaSDaniel Bristot de Oliveira 
1661a955d7eaSDaniel Bristot de Oliveira 	/*
1662a955d7eaSDaniel Bristot de Oliveira 	 * Enable the osnoise: events for thread an softirq.
1663a955d7eaSDaniel Bristot de Oliveira 	 */
1664a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = true;
1665a955d7eaSDaniel Bristot de Oliveira 
1666a955d7eaSDaniel Bristot de Oliveira 	osn_var->thread.arrival_time = time_get();
1667a955d7eaSDaniel Bristot de Oliveira 
1668a955d7eaSDaniel Bristot de Oliveira 	/*
1669a955d7eaSDaniel Bristot de Oliveira 	 * A hardirq is running: the timer IRQ. It is for sure preempting
1670a955d7eaSDaniel Bristot de Oliveira 	 * a thread, and potentially preempting a softirq.
1671a955d7eaSDaniel Bristot de Oliveira 	 *
1672a955d7eaSDaniel Bristot de Oliveira 	 * At this point, it is not interesting to know the duration of the
1673a955d7eaSDaniel Bristot de Oliveira 	 * preempted thread (and maybe softirq), but how much time they will
1674a955d7eaSDaniel Bristot de Oliveira 	 * delay the beginning of the execution of the timer thread.
1675a955d7eaSDaniel Bristot de Oliveira 	 *
1676a955d7eaSDaniel Bristot de Oliveira 	 * To get the correct (net) delay added by the softirq, its delta_start
1677a955d7eaSDaniel Bristot de Oliveira 	 * is set as the IRQ one. In this way, at the return of the IRQ, the delta
1678a955d7eaSDaniel Bristot de Oliveira 	 * start of the sofitrq will be zeroed, accounting then only the time
1679a955d7eaSDaniel Bristot de Oliveira 	 * after that.
1680a955d7eaSDaniel Bristot de Oliveira 	 *
1681a955d7eaSDaniel Bristot de Oliveira 	 * The thread follows the same principle. However, if a softirq is
1682a955d7eaSDaniel Bristot de Oliveira 	 * running, the thread needs to receive the softirq delta_start. The
1683a955d7eaSDaniel Bristot de Oliveira 	 * reason being is that the softirq will be the last to be unfolded,
1684a955d7eaSDaniel Bristot de Oliveira 	 * resseting the thread delay to zero.
168501e181c7SDaniel Bristot de Oliveira 	 *
168601e181c7SDaniel Bristot de Oliveira 	 * The PREEMPT_RT is a special case, though. As softirqs run as threads
168701e181c7SDaniel Bristot de Oliveira 	 * on RT, moving the thread is enough.
1688a955d7eaSDaniel Bristot de Oliveira 	 */
168901e181c7SDaniel Bristot de Oliveira 	if (!IS_ENABLED(CONFIG_PREEMPT_RT) && osn_var->softirq.delta_start) {
1690a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1691a955d7eaSDaniel Bristot de Oliveira 				   &osn_var->softirq.delta_start);
1692a955d7eaSDaniel Bristot de Oliveira 
1693a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->softirq.delta_start,
1694a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1695a955d7eaSDaniel Bristot de Oliveira 	} else {
1696a955d7eaSDaniel Bristot de Oliveira 		copy_int_safe_time(osn_var, &osn_var->thread.delta_start,
1697a955d7eaSDaniel Bristot de Oliveira 				    &osn_var->irq.delta_start);
1698a955d7eaSDaniel Bristot de Oliveira 	}
1699a955d7eaSDaniel Bristot de Oliveira 
1700a955d7eaSDaniel Bristot de Oliveira 	/*
1701a955d7eaSDaniel Bristot de Oliveira 	 * Compute the current time with the expected time.
1702a955d7eaSDaniel Bristot de Oliveira 	 */
1703a955d7eaSDaniel Bristot de Oliveira 	diff = now - tlat->abs_period;
1704a955d7eaSDaniel Bristot de Oliveira 
1705a955d7eaSDaniel Bristot de Oliveira 	tlat->count++;
1706a955d7eaSDaniel Bristot de Oliveira 	s.seqnum = tlat->count;
1707a955d7eaSDaniel Bristot de Oliveira 	s.timer_latency = diff;
1708a955d7eaSDaniel Bristot de Oliveira 	s.context = IRQ_CONTEXT;
1709a955d7eaSDaniel Bristot de Oliveira 
1710a955d7eaSDaniel Bristot de Oliveira 	trace_timerlat_sample(&s);
1711a955d7eaSDaniel Bristot de Oliveira 
1712aa748949SDaniel Bristot de Oliveira 	if (osnoise_data.stop_tracing) {
1713aa748949SDaniel Bristot de Oliveira 		if (time_to_us(diff) >= osnoise_data.stop_tracing) {
17144dd2aea2SDaniel Bristot de Oliveira 
17154dd2aea2SDaniel Bristot de Oliveira 			/*
17164dd2aea2SDaniel Bristot de Oliveira 			 * At this point, if stop_tracing is set and <= print_stack,
17174dd2aea2SDaniel Bristot de Oliveira 			 * print_stack is set and would be printed in the thread handler.
17184dd2aea2SDaniel Bristot de Oliveira 			 *
17194dd2aea2SDaniel Bristot de Oliveira 			 * Thus, print the stack trace as it is helpful to define the
17204dd2aea2SDaniel Bristot de Oliveira 			 * root cause of an IRQ latency.
17214dd2aea2SDaniel Bristot de Oliveira 			 */
17224dd2aea2SDaniel Bristot de Oliveira 			if (osnoise_data.stop_tracing <= osnoise_data.print_stack) {
17234dd2aea2SDaniel Bristot de Oliveira 				timerlat_save_stack(0);
17244dd2aea2SDaniel Bristot de Oliveira 				timerlat_dump_stack(time_to_us(diff));
17254dd2aea2SDaniel Bristot de Oliveira 			}
17264dd2aea2SDaniel Bristot de Oliveira 
1727a955d7eaSDaniel Bristot de Oliveira 			osnoise_stop_tracing();
1728a955d7eaSDaniel Bristot de Oliveira 			notify_new_max_latency(diff);
1729a955d7eaSDaniel Bristot de Oliveira 
1730632478a0SDaniel Bristot de Oliveira 			wake_up_process(tlat->kthread);
1731632478a0SDaniel Bristot de Oliveira 
17329c556e5aSDaniel Bristot de Oliveira 			return HRTIMER_NORESTART;
1733aa748949SDaniel Bristot de Oliveira 		}
1734aa748949SDaniel Bristot de Oliveira 	}
1735a955d7eaSDaniel Bristot de Oliveira 
1736a955d7eaSDaniel Bristot de Oliveira 	wake_up_process(tlat->kthread);
1737a955d7eaSDaniel Bristot de Oliveira 
1738a955d7eaSDaniel Bristot de Oliveira 	if (osnoise_data.print_stack)
1739a955d7eaSDaniel Bristot de Oliveira 		timerlat_save_stack(0);
1740a955d7eaSDaniel Bristot de Oliveira 
1741a955d7eaSDaniel Bristot de Oliveira 	return HRTIMER_NORESTART;
1742a955d7eaSDaniel Bristot de Oliveira }
1743a955d7eaSDaniel Bristot de Oliveira 
1744a955d7eaSDaniel Bristot de Oliveira /*
1745a955d7eaSDaniel Bristot de Oliveira  * wait_next_period - Wait for the next period for timerlat
1746a955d7eaSDaniel Bristot de Oliveira  */
1747a955d7eaSDaniel Bristot de Oliveira static int wait_next_period(struct timerlat_variables *tlat)
1748a955d7eaSDaniel Bristot de Oliveira {
1749a955d7eaSDaniel Bristot de Oliveira 	ktime_t next_abs_period, now;
1750a955d7eaSDaniel Bristot de Oliveira 	u64 rel_period = osnoise_data.timerlat_period * 1000;
1751a955d7eaSDaniel Bristot de Oliveira 
1752a955d7eaSDaniel Bristot de Oliveira 	now = hrtimer_cb_get_time(&tlat->timer);
1753a955d7eaSDaniel Bristot de Oliveira 	next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1754a955d7eaSDaniel Bristot de Oliveira 
1755a955d7eaSDaniel Bristot de Oliveira 	/*
1756a955d7eaSDaniel Bristot de Oliveira 	 * Save the next abs_period.
1757a955d7eaSDaniel Bristot de Oliveira 	 */
1758a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1759a955d7eaSDaniel Bristot de Oliveira 
1760a955d7eaSDaniel Bristot de Oliveira 	/*
1761a955d7eaSDaniel Bristot de Oliveira 	 * If the new abs_period is in the past, skip the activation.
1762a955d7eaSDaniel Bristot de Oliveira 	 */
1763a955d7eaSDaniel Bristot de Oliveira 	while (ktime_compare(now, next_abs_period) > 0) {
1764a955d7eaSDaniel Bristot de Oliveira 		next_abs_period = ns_to_ktime(tlat->abs_period + rel_period);
1765a955d7eaSDaniel Bristot de Oliveira 		tlat->abs_period = (u64) ktime_to_ns(next_abs_period);
1766a955d7eaSDaniel Bristot de Oliveira 	}
1767a955d7eaSDaniel Bristot de Oliveira 
1768a955d7eaSDaniel Bristot de Oliveira 	set_current_state(TASK_INTERRUPTIBLE);
1769a955d7eaSDaniel Bristot de Oliveira 
1770a955d7eaSDaniel Bristot de Oliveira 	hrtimer_start(&tlat->timer, next_abs_period, HRTIMER_MODE_ABS_PINNED_HARD);
1771a955d7eaSDaniel Bristot de Oliveira 	schedule();
1772a955d7eaSDaniel Bristot de Oliveira 	return 1;
1773a955d7eaSDaniel Bristot de Oliveira }
1774a955d7eaSDaniel Bristot de Oliveira 
1775a955d7eaSDaniel Bristot de Oliveira /*
1776a955d7eaSDaniel Bristot de Oliveira  * timerlat_main- Timerlat main
1777a955d7eaSDaniel Bristot de Oliveira  */
1778a955d7eaSDaniel Bristot de Oliveira static int timerlat_main(void *data)
1779a955d7eaSDaniel Bristot de Oliveira {
1780a955d7eaSDaniel Bristot de Oliveira 	struct osnoise_variables *osn_var = this_cpu_osn_var();
1781a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_variables *tlat = this_cpu_tmr_var();
1782a955d7eaSDaniel Bristot de Oliveira 	struct timerlat_sample s;
1783a955d7eaSDaniel Bristot de Oliveira 	struct sched_param sp;
17844998e7fdSDaniel Bristot de Oliveira 	unsigned long flags;
1785a955d7eaSDaniel Bristot de Oliveira 	u64 now, diff;
1786a955d7eaSDaniel Bristot de Oliveira 
1787a955d7eaSDaniel Bristot de Oliveira 	/*
1788a955d7eaSDaniel Bristot de Oliveira 	 * Make the thread RT, that is how cyclictest is usually used.
1789a955d7eaSDaniel Bristot de Oliveira 	 */
1790a955d7eaSDaniel Bristot de Oliveira 	sp.sched_priority = DEFAULT_TIMERLAT_PRIO;
1791a955d7eaSDaniel Bristot de Oliveira 	sched_setscheduler_nocheck(current, SCHED_FIFO, &sp);
1792a955d7eaSDaniel Bristot de Oliveira 
17934998e7fdSDaniel Bristot de Oliveira 	/*
17944998e7fdSDaniel Bristot de Oliveira 	 * This thread was created pinned to the CPU using PF_NO_SETAFFINITY.
17954998e7fdSDaniel Bristot de Oliveira 	 * The problem is that cgroup does not allow PF_NO_SETAFFINITY thread.
17964998e7fdSDaniel Bristot de Oliveira 	 *
17974998e7fdSDaniel Bristot de Oliveira 	 * To work around this limitation, disable migration and remove the
17984998e7fdSDaniel Bristot de Oliveira 	 * flag.
17994998e7fdSDaniel Bristot de Oliveira 	 */
18004998e7fdSDaniel Bristot de Oliveira 	migrate_disable();
18014998e7fdSDaniel Bristot de Oliveira 	raw_spin_lock_irqsave(&current->pi_lock, flags);
18024998e7fdSDaniel Bristot de Oliveira 	current->flags &= ~(PF_NO_SETAFFINITY);
18034998e7fdSDaniel Bristot de Oliveira 	raw_spin_unlock_irqrestore(&current->pi_lock, flags);
18044998e7fdSDaniel Bristot de Oliveira 
1805a955d7eaSDaniel Bristot de Oliveira 	tlat->count = 0;
1806a955d7eaSDaniel Bristot de Oliveira 	tlat->tracing_thread = false;
1807a955d7eaSDaniel Bristot de Oliveira 
1808a955d7eaSDaniel Bristot de Oliveira 	hrtimer_init(&tlat->timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS_PINNED_HARD);
1809a955d7eaSDaniel Bristot de Oliveira 	tlat->timer.function = timerlat_irq;
1810a955d7eaSDaniel Bristot de Oliveira 	tlat->kthread = current;
1811a955d7eaSDaniel Bristot de Oliveira 	osn_var->pid = current->pid;
1812a955d7eaSDaniel Bristot de Oliveira 	/*
1813a955d7eaSDaniel Bristot de Oliveira 	 * Anotate the arrival time.
1814a955d7eaSDaniel Bristot de Oliveira 	 */
1815a955d7eaSDaniel Bristot de Oliveira 	tlat->abs_period = hrtimer_cb_get_time(&tlat->timer);
1816a955d7eaSDaniel Bristot de Oliveira 
1817a955d7eaSDaniel Bristot de Oliveira 	wait_next_period(tlat);
1818a955d7eaSDaniel Bristot de Oliveira 
1819a955d7eaSDaniel Bristot de Oliveira 	osn_var->sampling = 1;
1820a955d7eaSDaniel Bristot de Oliveira 
1821a955d7eaSDaniel Bristot de Oliveira 	while (!kthread_should_stop()) {
18224998e7fdSDaniel Bristot de Oliveira 
1823a955d7eaSDaniel Bristot de Oliveira 		now = ktime_to_ns(hrtimer_cb_get_time(&tlat->timer));
1824a955d7eaSDaniel Bristot de Oliveira 		diff = now - tlat->abs_period;
1825a955d7eaSDaniel Bristot de Oliveira 
1826a955d7eaSDaniel Bristot de Oliveira 		s.seqnum = tlat->count;
1827a955d7eaSDaniel Bristot de Oliveira 		s.timer_latency = diff;
1828a955d7eaSDaniel Bristot de Oliveira 		s.context = THREAD_CONTEXT;
1829a955d7eaSDaniel Bristot de Oliveira 
1830a955d7eaSDaniel Bristot de Oliveira 		trace_timerlat_sample(&s);
1831a955d7eaSDaniel Bristot de Oliveira 
1832b9f451a9SDaniel Bristot de Oliveira 		notify_new_max_latency(diff);
1833b9f451a9SDaniel Bristot de Oliveira 
1834b14f4568SDaniel Bristot de Oliveira 		timerlat_dump_stack(time_to_us(diff));
1835a955d7eaSDaniel Bristot de Oliveira 
1836a955d7eaSDaniel Bristot de Oliveira 		tlat->tracing_thread = false;
1837a955d7eaSDaniel Bristot de Oliveira 		if (osnoise_data.stop_tracing_total)
1838a955d7eaSDaniel Bristot de Oliveira 			if (time_to_us(diff) >= osnoise_data.stop_tracing_total)
1839a955d7eaSDaniel Bristot de Oliveira 				osnoise_stop_tracing();
1840a955d7eaSDaniel Bristot de Oliveira 
18414998e7fdSDaniel Bristot de Oliveira 		if (osnoise_migration_pending())
18424998e7fdSDaniel Bristot de Oliveira 			break;
18434998e7fdSDaniel Bristot de Oliveira 
1844a955d7eaSDaniel Bristot de Oliveira 		wait_next_period(tlat);
1845a955d7eaSDaniel Bristot de Oliveira 	}
1846a955d7eaSDaniel Bristot de Oliveira 
1847a955d7eaSDaniel Bristot de Oliveira 	hrtimer_cancel(&tlat->timer);
18484998e7fdSDaniel Bristot de Oliveira 	migrate_enable();
1849a955d7eaSDaniel Bristot de Oliveira 	return 0;
1850a955d7eaSDaniel Bristot de Oliveira }
1851ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
1852ccb67544SDaniel Bristot de Oliveira static int timerlat_main(void *data)
1853ccb67544SDaniel Bristot de Oliveira {
1854ccb67544SDaniel Bristot de Oliveira 	return 0;
1855ccb67544SDaniel Bristot de Oliveira }
1856a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
1857a955d7eaSDaniel Bristot de Oliveira 
1858bce29ac9SDaniel Bristot de Oliveira /*
1859c8895e27SDaniel Bristot de Oliveira  * stop_kthread - stop a workload thread
1860c8895e27SDaniel Bristot de Oliveira  */
1861c8895e27SDaniel Bristot de Oliveira static void stop_kthread(unsigned int cpu)
1862c8895e27SDaniel Bristot de Oliveira {
1863c8895e27SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1864c8895e27SDaniel Bristot de Oliveira 
1865c8895e27SDaniel Bristot de Oliveira 	kthread = per_cpu(per_cpu_osnoise_var, cpu).kthread;
186630838fcdSDaniel Bristot de Oliveira 	if (kthread) {
1867c8895e27SDaniel Bristot de Oliveira 		kthread_stop(kthread);
1868c8895e27SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
186930838fcdSDaniel Bristot de Oliveira 	} else {
187030838fcdSDaniel Bristot de Oliveira 		if (!test_bit(OSN_WORKLOAD, &osnoise_options)) {
187130838fcdSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = false;
187230838fcdSDaniel Bristot de Oliveira 			barrier();
187330838fcdSDaniel Bristot de Oliveira 			return;
187430838fcdSDaniel Bristot de Oliveira 		}
187530838fcdSDaniel Bristot de Oliveira 	}
1876c8895e27SDaniel Bristot de Oliveira }
1877c8895e27SDaniel Bristot de Oliveira 
1878c8895e27SDaniel Bristot de Oliveira /*
1879c8895e27SDaniel Bristot de Oliveira  * stop_per_cpu_kthread - Stop per-cpu threads
1880bce29ac9SDaniel Bristot de Oliveira  *
1881bce29ac9SDaniel Bristot de Oliveira  * Stop the osnoise sampling htread. Use this on unload and at system
1882bce29ac9SDaniel Bristot de Oliveira  * shutdown.
1883bce29ac9SDaniel Bristot de Oliveira  */
1884bce29ac9SDaniel Bristot de Oliveira static void stop_per_cpu_kthreads(void)
1885bce29ac9SDaniel Bristot de Oliveira {
1886bce29ac9SDaniel Bristot de Oliveira 	int cpu;
1887bce29ac9SDaniel Bristot de Oliveira 
188899c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1889bce29ac9SDaniel Bristot de Oliveira 
1890bce29ac9SDaniel Bristot de Oliveira 	for_each_online_cpu(cpu)
1891c8895e27SDaniel Bristot de Oliveira 		stop_kthread(cpu);
1892bce29ac9SDaniel Bristot de Oliveira 
189399c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1894c8895e27SDaniel Bristot de Oliveira }
1895c8895e27SDaniel Bristot de Oliveira 
1896c8895e27SDaniel Bristot de Oliveira /*
1897c8895e27SDaniel Bristot de Oliveira  * start_kthread - Start a workload tread
1898c8895e27SDaniel Bristot de Oliveira  */
1899c8895e27SDaniel Bristot de Oliveira static int start_kthread(unsigned int cpu)
1900c8895e27SDaniel Bristot de Oliveira {
1901c8895e27SDaniel Bristot de Oliveira 	struct task_struct *kthread;
1902c8895e27SDaniel Bristot de Oliveira 	void *main = osnoise_main;
1903c8895e27SDaniel Bristot de Oliveira 	char comm[24];
1904c8895e27SDaniel Bristot de Oliveira 
1905ccb67544SDaniel Bristot de Oliveira 	if (timerlat_enabled()) {
1906a955d7eaSDaniel Bristot de Oliveira 		snprintf(comm, 24, "timerlat/%d", cpu);
1907a955d7eaSDaniel Bristot de Oliveira 		main = timerlat_main;
1908a955d7eaSDaniel Bristot de Oliveira 	} else {
190930838fcdSDaniel Bristot de Oliveira 		/* if no workload, just return */
191030838fcdSDaniel Bristot de Oliveira 		if (!test_bit(OSN_WORKLOAD, &osnoise_options)) {
191130838fcdSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = true;
191230838fcdSDaniel Bristot de Oliveira 			barrier();
191330838fcdSDaniel Bristot de Oliveira 			return 0;
191430838fcdSDaniel Bristot de Oliveira 		}
191530838fcdSDaniel Bristot de Oliveira 
1916bce29ac9SDaniel Bristot de Oliveira 		snprintf(comm, 24, "osnoise/%d", cpu);
1917a955d7eaSDaniel Bristot de Oliveira 	}
1918ccb67544SDaniel Bristot de Oliveira 
191911e4e352SCai Huoqing 	kthread = kthread_run_on_cpu(main, NULL, cpu, comm);
1920bce29ac9SDaniel Bristot de Oliveira 
1921bce29ac9SDaniel Bristot de Oliveira 	if (IS_ERR(kthread)) {
1922bce29ac9SDaniel Bristot de Oliveira 		pr_err(BANNER "could not start sampling thread\n");
1923bce29ac9SDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
1924bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
1925bce29ac9SDaniel Bristot de Oliveira 	}
1926bce29ac9SDaniel Bristot de Oliveira 
1927bce29ac9SDaniel Bristot de Oliveira 	per_cpu(per_cpu_osnoise_var, cpu).kthread = kthread;
1928bce29ac9SDaniel Bristot de Oliveira 
1929bce29ac9SDaniel Bristot de Oliveira 	return 0;
1930bce29ac9SDaniel Bristot de Oliveira }
1931bce29ac9SDaniel Bristot de Oliveira 
1932bce29ac9SDaniel Bristot de Oliveira /*
1933c8895e27SDaniel Bristot de Oliveira  * start_per_cpu_kthread - Kick off per-cpu osnoise sampling kthreads
1934c8895e27SDaniel Bristot de Oliveira  *
1935c8895e27SDaniel Bristot de Oliveira  * This starts the kernel thread that will look for osnoise on many
1936c8895e27SDaniel Bristot de Oliveira  * cpus.
1937c8895e27SDaniel Bristot de Oliveira  */
193815ca4bdbSDaniel Bristot de Oliveira static int start_per_cpu_kthreads(void)
1939c8895e27SDaniel Bristot de Oliveira {
1940c8895e27SDaniel Bristot de Oliveira 	struct cpumask *current_mask = &save_cpumask;
19414b6b08f2SQiang.Zhang 	int retval = 0;
1942c8895e27SDaniel Bristot de Oliveira 	int cpu;
1943c8895e27SDaniel Bristot de Oliveira 
194499c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1945c8895e27SDaniel Bristot de Oliveira 	/*
194666df27f1SDaniel Bristot de Oliveira 	 * Run only on online CPUs in which osnoise is allowed to run.
1947c8895e27SDaniel Bristot de Oliveira 	 */
194866df27f1SDaniel Bristot de Oliveira 	cpumask_and(current_mask, cpu_online_mask, &osnoise_cpumask);
1949c8895e27SDaniel Bristot de Oliveira 
1950c8895e27SDaniel Bristot de Oliveira 	for_each_possible_cpu(cpu)
1951c8895e27SDaniel Bristot de Oliveira 		per_cpu(per_cpu_osnoise_var, cpu).kthread = NULL;
1952c8895e27SDaniel Bristot de Oliveira 
1953c8895e27SDaniel Bristot de Oliveira 	for_each_cpu(cpu, current_mask) {
1954c8895e27SDaniel Bristot de Oliveira 		retval = start_kthread(cpu);
1955c8895e27SDaniel Bristot de Oliveira 		if (retval) {
195699ee9317SNico Pache 			cpus_read_unlock();
1957c8895e27SDaniel Bristot de Oliveira 			stop_per_cpu_kthreads();
195899ee9317SNico Pache 			return retval;
1959c8895e27SDaniel Bristot de Oliveira 		}
1960c8895e27SDaniel Bristot de Oliveira 	}
1961c8895e27SDaniel Bristot de Oliveira 
196299c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1963c8895e27SDaniel Bristot de Oliveira 
19644b6b08f2SQiang.Zhang 	return retval;
1965c8895e27SDaniel Bristot de Oliveira }
1966c8895e27SDaniel Bristot de Oliveira 
1967c8895e27SDaniel Bristot de Oliveira #ifdef CONFIG_HOTPLUG_CPU
1968c8895e27SDaniel Bristot de Oliveira static void osnoise_hotplug_workfn(struct work_struct *dummy)
1969c8895e27SDaniel Bristot de Oliveira {
1970c8895e27SDaniel Bristot de Oliveira 	unsigned int cpu = smp_processor_id();
1971c8895e27SDaniel Bristot de Oliveira 
1972c8895e27SDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
1973c8895e27SDaniel Bristot de Oliveira 
1974dae18134SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
1975c8895e27SDaniel Bristot de Oliveira 		goto out_unlock_trace;
1976c8895e27SDaniel Bristot de Oliveira 
1977c8895e27SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
197899c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
1979c8895e27SDaniel Bristot de Oliveira 
1980c8895e27SDaniel Bristot de Oliveira 	if (!cpumask_test_cpu(cpu, &osnoise_cpumask))
1981c8895e27SDaniel Bristot de Oliveira 		goto out_unlock;
1982c8895e27SDaniel Bristot de Oliveira 
1983c8895e27SDaniel Bristot de Oliveira 	start_kthread(cpu);
1984c8895e27SDaniel Bristot de Oliveira 
1985c8895e27SDaniel Bristot de Oliveira out_unlock:
198699c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
1987c8895e27SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
1988c8895e27SDaniel Bristot de Oliveira out_unlock_trace:
1989c8895e27SDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
1990c8895e27SDaniel Bristot de Oliveira }
1991c8895e27SDaniel Bristot de Oliveira 
1992c8895e27SDaniel Bristot de Oliveira static DECLARE_WORK(osnoise_hotplug_work, osnoise_hotplug_workfn);
1993c8895e27SDaniel Bristot de Oliveira 
1994c8895e27SDaniel Bristot de Oliveira /*
1995c8895e27SDaniel Bristot de Oliveira  * osnoise_cpu_init - CPU hotplug online callback function
1996c8895e27SDaniel Bristot de Oliveira  */
1997c8895e27SDaniel Bristot de Oliveira static int osnoise_cpu_init(unsigned int cpu)
1998c8895e27SDaniel Bristot de Oliveira {
1999c8895e27SDaniel Bristot de Oliveira 	schedule_work_on(cpu, &osnoise_hotplug_work);
2000c8895e27SDaniel Bristot de Oliveira 	return 0;
2001c8895e27SDaniel Bristot de Oliveira }
2002c8895e27SDaniel Bristot de Oliveira 
2003c8895e27SDaniel Bristot de Oliveira /*
2004c8895e27SDaniel Bristot de Oliveira  * osnoise_cpu_die - CPU hotplug offline callback function
2005c8895e27SDaniel Bristot de Oliveira  */
2006c8895e27SDaniel Bristot de Oliveira static int osnoise_cpu_die(unsigned int cpu)
2007c8895e27SDaniel Bristot de Oliveira {
2008c8895e27SDaniel Bristot de Oliveira 	stop_kthread(cpu);
2009c8895e27SDaniel Bristot de Oliveira 	return 0;
2010c8895e27SDaniel Bristot de Oliveira }
2011c8895e27SDaniel Bristot de Oliveira 
2012c8895e27SDaniel Bristot de Oliveira static void osnoise_init_hotplug_support(void)
2013c8895e27SDaniel Bristot de Oliveira {
2014c8895e27SDaniel Bristot de Oliveira 	int ret;
2015c8895e27SDaniel Bristot de Oliveira 
2016c8895e27SDaniel Bristot de Oliveira 	ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "trace/osnoise:online",
2017c8895e27SDaniel Bristot de Oliveira 				osnoise_cpu_init, osnoise_cpu_die);
2018c8895e27SDaniel Bristot de Oliveira 	if (ret < 0)
2019c8895e27SDaniel Bristot de Oliveira 		pr_warn(BANNER "Error to init cpu hotplug support\n");
2020c8895e27SDaniel Bristot de Oliveira 
2021c8895e27SDaniel Bristot de Oliveira 	return;
2022c8895e27SDaniel Bristot de Oliveira }
2023c8895e27SDaniel Bristot de Oliveira #else /* CONFIG_HOTPLUG_CPU */
2024c8895e27SDaniel Bristot de Oliveira static void osnoise_init_hotplug_support(void)
2025c8895e27SDaniel Bristot de Oliveira {
2026498627b4SDaniel Bristot de Oliveira 	return;
2027c8895e27SDaniel Bristot de Oliveira }
2028c8895e27SDaniel Bristot de Oliveira #endif /* CONFIG_HOTPLUG_CPU */
2029c8895e27SDaniel Bristot de Oliveira 
2030c8895e27SDaniel Bristot de Oliveira /*
2031b179d48bSDaniel Bristot de Oliveira  * seq file functions for the osnoise/options file.
2032b179d48bSDaniel Bristot de Oliveira  */
2033b179d48bSDaniel Bristot de Oliveira static void *s_options_start(struct seq_file *s, loff_t *pos)
2034b179d48bSDaniel Bristot de Oliveira {
2035b179d48bSDaniel Bristot de Oliveira 	int option = *pos;
2036b179d48bSDaniel Bristot de Oliveira 
2037b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2038b179d48bSDaniel Bristot de Oliveira 
2039b179d48bSDaniel Bristot de Oliveira 	if (option >= OSN_MAX)
2040b179d48bSDaniel Bristot de Oliveira 		return NULL;
2041b179d48bSDaniel Bristot de Oliveira 
2042b179d48bSDaniel Bristot de Oliveira 	return pos;
2043b179d48bSDaniel Bristot de Oliveira }
2044b179d48bSDaniel Bristot de Oliveira 
2045b179d48bSDaniel Bristot de Oliveira static void *s_options_next(struct seq_file *s, void *v, loff_t *pos)
2046b179d48bSDaniel Bristot de Oliveira {
2047b179d48bSDaniel Bristot de Oliveira 	int option = ++(*pos);
2048b179d48bSDaniel Bristot de Oliveira 
2049b179d48bSDaniel Bristot de Oliveira 	if (option >= OSN_MAX)
2050b179d48bSDaniel Bristot de Oliveira 		return NULL;
2051b179d48bSDaniel Bristot de Oliveira 
2052b179d48bSDaniel Bristot de Oliveira 	return pos;
2053b179d48bSDaniel Bristot de Oliveira }
2054b179d48bSDaniel Bristot de Oliveira 
2055b179d48bSDaniel Bristot de Oliveira static int s_options_show(struct seq_file *s, void *v)
2056b179d48bSDaniel Bristot de Oliveira {
2057b179d48bSDaniel Bristot de Oliveira 	loff_t *pos = v;
2058b179d48bSDaniel Bristot de Oliveira 	int option = *pos;
2059b179d48bSDaniel Bristot de Oliveira 
2060b179d48bSDaniel Bristot de Oliveira 	if (option == OSN_DEFAULTS) {
2061b179d48bSDaniel Bristot de Oliveira 		if (osnoise_options == OSN_DEFAULT_OPTIONS)
2062b179d48bSDaniel Bristot de Oliveira 			seq_printf(s, "%s", osnoise_options_str[option]);
2063b179d48bSDaniel Bristot de Oliveira 		else
2064b179d48bSDaniel Bristot de Oliveira 			seq_printf(s, "NO_%s", osnoise_options_str[option]);
2065b179d48bSDaniel Bristot de Oliveira 		goto out;
2066b179d48bSDaniel Bristot de Oliveira 	}
2067b179d48bSDaniel Bristot de Oliveira 
2068b179d48bSDaniel Bristot de Oliveira 	if (test_bit(option, &osnoise_options))
2069b179d48bSDaniel Bristot de Oliveira 		seq_printf(s, "%s", osnoise_options_str[option]);
2070b179d48bSDaniel Bristot de Oliveira 	else
2071b179d48bSDaniel Bristot de Oliveira 		seq_printf(s, "NO_%s", osnoise_options_str[option]);
2072b179d48bSDaniel Bristot de Oliveira 
2073b179d48bSDaniel Bristot de Oliveira out:
2074b179d48bSDaniel Bristot de Oliveira 	if (option != OSN_MAX)
2075b179d48bSDaniel Bristot de Oliveira 		seq_puts(s, " ");
2076b179d48bSDaniel Bristot de Oliveira 
2077b179d48bSDaniel Bristot de Oliveira 	return 0;
2078b179d48bSDaniel Bristot de Oliveira }
2079b179d48bSDaniel Bristot de Oliveira 
2080b179d48bSDaniel Bristot de Oliveira static void s_options_stop(struct seq_file *s, void *v)
2081b179d48bSDaniel Bristot de Oliveira {
2082b179d48bSDaniel Bristot de Oliveira 	seq_puts(s, "\n");
2083b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2084b179d48bSDaniel Bristot de Oliveira }
2085b179d48bSDaniel Bristot de Oliveira 
2086b179d48bSDaniel Bristot de Oliveira static const struct seq_operations osnoise_options_seq_ops = {
2087b179d48bSDaniel Bristot de Oliveira 	.start		= s_options_start,
2088b179d48bSDaniel Bristot de Oliveira 	.next		= s_options_next,
2089b179d48bSDaniel Bristot de Oliveira 	.show		= s_options_show,
2090b179d48bSDaniel Bristot de Oliveira 	.stop		= s_options_stop
2091b179d48bSDaniel Bristot de Oliveira };
2092b179d48bSDaniel Bristot de Oliveira 
2093b179d48bSDaniel Bristot de Oliveira static int osnoise_options_open(struct inode *inode, struct file *file)
2094b179d48bSDaniel Bristot de Oliveira {
2095b179d48bSDaniel Bristot de Oliveira 	return seq_open(file, &osnoise_options_seq_ops);
2096b179d48bSDaniel Bristot de Oliveira };
2097b179d48bSDaniel Bristot de Oliveira 
2098b179d48bSDaniel Bristot de Oliveira /**
2099b179d48bSDaniel Bristot de Oliveira  * osnoise_options_write - Write function for "options" entry
2100b179d48bSDaniel Bristot de Oliveira  * @filp: The active open file structure
2101b179d48bSDaniel Bristot de Oliveira  * @ubuf: The user buffer that contains the value to write
2102b179d48bSDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to write to "file"
2103b179d48bSDaniel Bristot de Oliveira  * @ppos: The current position in @file
2104b179d48bSDaniel Bristot de Oliveira  *
2105b179d48bSDaniel Bristot de Oliveira  * Writing the option name sets the option, writing the "NO_"
2106b179d48bSDaniel Bristot de Oliveira  * prefix in front of the option name disables it.
2107b179d48bSDaniel Bristot de Oliveira  *
2108b179d48bSDaniel Bristot de Oliveira  * Writing "DEFAULTS" resets the option values to the default ones.
2109b179d48bSDaniel Bristot de Oliveira  */
2110b179d48bSDaniel Bristot de Oliveira static ssize_t osnoise_options_write(struct file *filp, const char __user *ubuf,
2111b179d48bSDaniel Bristot de Oliveira 				     size_t cnt, loff_t *ppos)
2112b179d48bSDaniel Bristot de Oliveira {
2113b179d48bSDaniel Bristot de Oliveira 	int running, option, enable, retval;
2114b179d48bSDaniel Bristot de Oliveira 	char buf[256], *option_str;
2115b179d48bSDaniel Bristot de Oliveira 
2116b179d48bSDaniel Bristot de Oliveira 	if (cnt >= 256)
2117b179d48bSDaniel Bristot de Oliveira 		return -EINVAL;
2118b179d48bSDaniel Bristot de Oliveira 
2119b179d48bSDaniel Bristot de Oliveira 	if (copy_from_user(buf, ubuf, cnt))
2120b179d48bSDaniel Bristot de Oliveira 		return -EFAULT;
2121b179d48bSDaniel Bristot de Oliveira 
2122b179d48bSDaniel Bristot de Oliveira 	buf[cnt] = 0;
2123b179d48bSDaniel Bristot de Oliveira 
2124b179d48bSDaniel Bristot de Oliveira 	if (strncmp(buf, "NO_", 3)) {
2125b179d48bSDaniel Bristot de Oliveira 		option_str = strstrip(buf);
2126b179d48bSDaniel Bristot de Oliveira 		enable = true;
2127b179d48bSDaniel Bristot de Oliveira 	} else {
2128b179d48bSDaniel Bristot de Oliveira 		option_str = strstrip(&buf[3]);
2129b179d48bSDaniel Bristot de Oliveira 		enable = false;
2130b179d48bSDaniel Bristot de Oliveira 	}
2131b179d48bSDaniel Bristot de Oliveira 
2132b179d48bSDaniel Bristot de Oliveira 	option = match_string(osnoise_options_str, OSN_MAX, option_str);
2133b179d48bSDaniel Bristot de Oliveira 	if (option < 0)
2134b179d48bSDaniel Bristot de Oliveira 		return -EINVAL;
2135b179d48bSDaniel Bristot de Oliveira 
2136b179d48bSDaniel Bristot de Oliveira 	/*
2137b179d48bSDaniel Bristot de Oliveira 	 * trace_types_lock is taken to avoid concurrency on start/stop.
2138b179d48bSDaniel Bristot de Oliveira 	 */
2139b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
2140b179d48bSDaniel Bristot de Oliveira 	running = osnoise_has_registered_instances();
2141b179d48bSDaniel Bristot de Oliveira 	if (running)
2142b179d48bSDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
2143b179d48bSDaniel Bristot de Oliveira 
2144b179d48bSDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2145b179d48bSDaniel Bristot de Oliveira 	/*
2146b179d48bSDaniel Bristot de Oliveira 	 * avoid CPU hotplug operations that might read options.
2147b179d48bSDaniel Bristot de Oliveira 	 */
2148b179d48bSDaniel Bristot de Oliveira 	cpus_read_lock();
2149b179d48bSDaniel Bristot de Oliveira 
2150b179d48bSDaniel Bristot de Oliveira 	retval = cnt;
2151b179d48bSDaniel Bristot de Oliveira 
2152b179d48bSDaniel Bristot de Oliveira 	if (enable) {
2153b179d48bSDaniel Bristot de Oliveira 		if (option == OSN_DEFAULTS)
2154b179d48bSDaniel Bristot de Oliveira 			osnoise_options = OSN_DEFAULT_OPTIONS;
2155b179d48bSDaniel Bristot de Oliveira 		else
2156b179d48bSDaniel Bristot de Oliveira 			set_bit(option, &osnoise_options);
2157b179d48bSDaniel Bristot de Oliveira 	} else {
2158b179d48bSDaniel Bristot de Oliveira 		if (option == OSN_DEFAULTS)
2159b179d48bSDaniel Bristot de Oliveira 			retval = -EINVAL;
2160b179d48bSDaniel Bristot de Oliveira 		else
2161b179d48bSDaniel Bristot de Oliveira 			clear_bit(option, &osnoise_options);
2162b179d48bSDaniel Bristot de Oliveira 	}
2163b179d48bSDaniel Bristot de Oliveira 
2164b179d48bSDaniel Bristot de Oliveira 	cpus_read_unlock();
2165b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2166b179d48bSDaniel Bristot de Oliveira 
2167b179d48bSDaniel Bristot de Oliveira 	if (running)
2168b179d48bSDaniel Bristot de Oliveira 		start_per_cpu_kthreads();
2169b179d48bSDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
2170b179d48bSDaniel Bristot de Oliveira 
2171b179d48bSDaniel Bristot de Oliveira 	return retval;
2172b179d48bSDaniel Bristot de Oliveira }
2173b179d48bSDaniel Bristot de Oliveira 
2174b179d48bSDaniel Bristot de Oliveira /*
2175bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_read - Read function for reading the "cpus" file
2176bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
2177bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The userspace provided buffer to read value into
2178bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to read
2179bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current "file" position
2180bce29ac9SDaniel Bristot de Oliveira  *
2181bce29ac9SDaniel Bristot de Oliveira  * Prints the "cpus" output into the user-provided buffer.
2182bce29ac9SDaniel Bristot de Oliveira  */
2183bce29ac9SDaniel Bristot de Oliveira static ssize_t
2184bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_read(struct file *filp, char __user *ubuf, size_t count,
2185bce29ac9SDaniel Bristot de Oliveira 		  loff_t *ppos)
2186bce29ac9SDaniel Bristot de Oliveira {
2187bce29ac9SDaniel Bristot de Oliveira 	char *mask_str;
2188bce29ac9SDaniel Bristot de Oliveira 	int len;
2189bce29ac9SDaniel Bristot de Oliveira 
2190bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2191bce29ac9SDaniel Bristot de Oliveira 
2192bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(NULL, 0, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask)) + 1;
2193bce29ac9SDaniel Bristot de Oliveira 	mask_str = kmalloc(len, GFP_KERNEL);
2194bce29ac9SDaniel Bristot de Oliveira 	if (!mask_str) {
2195bce29ac9SDaniel Bristot de Oliveira 		count = -ENOMEM;
2196bce29ac9SDaniel Bristot de Oliveira 		goto out_unlock;
2197bce29ac9SDaniel Bristot de Oliveira 	}
2198bce29ac9SDaniel Bristot de Oliveira 
2199bce29ac9SDaniel Bristot de Oliveira 	len = snprintf(mask_str, len, "%*pbl\n", cpumask_pr_args(&osnoise_cpumask));
2200bce29ac9SDaniel Bristot de Oliveira 	if (len >= count) {
2201bce29ac9SDaniel Bristot de Oliveira 		count = -EINVAL;
2202bce29ac9SDaniel Bristot de Oliveira 		goto out_free;
2203bce29ac9SDaniel Bristot de Oliveira 	}
2204bce29ac9SDaniel Bristot de Oliveira 
2205bce29ac9SDaniel Bristot de Oliveira 	count = simple_read_from_buffer(ubuf, count, ppos, mask_str, len);
2206bce29ac9SDaniel Bristot de Oliveira 
2207bce29ac9SDaniel Bristot de Oliveira out_free:
2208bce29ac9SDaniel Bristot de Oliveira 	kfree(mask_str);
2209bce29ac9SDaniel Bristot de Oliveira out_unlock:
2210bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2211bce29ac9SDaniel Bristot de Oliveira 
2212bce29ac9SDaniel Bristot de Oliveira 	return count;
2213bce29ac9SDaniel Bristot de Oliveira }
2214bce29ac9SDaniel Bristot de Oliveira 
2215bce29ac9SDaniel Bristot de Oliveira /*
2216bce29ac9SDaniel Bristot de Oliveira  * osnoise_cpus_write - Write function for "cpus" entry
2217bce29ac9SDaniel Bristot de Oliveira  * @filp: The active open file structure
2218bce29ac9SDaniel Bristot de Oliveira  * @ubuf: The user buffer that contains the value to write
2219bce29ac9SDaniel Bristot de Oliveira  * @cnt: The maximum number of bytes to write to "file"
2220bce29ac9SDaniel Bristot de Oliveira  * @ppos: The current position in @file
2221bce29ac9SDaniel Bristot de Oliveira  *
2222bce29ac9SDaniel Bristot de Oliveira  * This function provides a write implementation for the "cpus"
2223bce29ac9SDaniel Bristot de Oliveira  * interface to the osnoise trace. By default, it lists all  CPUs,
2224bce29ac9SDaniel Bristot de Oliveira  * in this way, allowing osnoise threads to run on any online CPU
2225bce29ac9SDaniel Bristot de Oliveira  * of the system. It serves to restrict the execution of osnoise to the
222666df27f1SDaniel Bristot de Oliveira  * set of CPUs writing via this interface. Why not use "tracing_cpumask"?
222766df27f1SDaniel Bristot de Oliveira  * Because the user might be interested in tracing what is running on
222866df27f1SDaniel Bristot de Oliveira  * other CPUs. For instance, one might run osnoise in one HT CPU
222966df27f1SDaniel Bristot de Oliveira  * while observing what is running on the sibling HT CPU.
2230bce29ac9SDaniel Bristot de Oliveira  */
2231bce29ac9SDaniel Bristot de Oliveira static ssize_t
2232bce29ac9SDaniel Bristot de Oliveira osnoise_cpus_write(struct file *filp, const char __user *ubuf, size_t count,
2233bce29ac9SDaniel Bristot de Oliveira 		   loff_t *ppos)
2234bce29ac9SDaniel Bristot de Oliveira {
2235bce29ac9SDaniel Bristot de Oliveira 	cpumask_var_t osnoise_cpumask_new;
2236bce29ac9SDaniel Bristot de Oliveira 	int running, err;
2237bce29ac9SDaniel Bristot de Oliveira 	char buf[256];
2238bce29ac9SDaniel Bristot de Oliveira 
2239bce29ac9SDaniel Bristot de Oliveira 	if (count >= 256)
2240bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
2241bce29ac9SDaniel Bristot de Oliveira 
2242bce29ac9SDaniel Bristot de Oliveira 	if (copy_from_user(buf, ubuf, count))
2243bce29ac9SDaniel Bristot de Oliveira 		return -EFAULT;
2244bce29ac9SDaniel Bristot de Oliveira 
2245bce29ac9SDaniel Bristot de Oliveira 	if (!zalloc_cpumask_var(&osnoise_cpumask_new, GFP_KERNEL))
2246bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
2247bce29ac9SDaniel Bristot de Oliveira 
2248bce29ac9SDaniel Bristot de Oliveira 	err = cpulist_parse(buf, osnoise_cpumask_new);
2249bce29ac9SDaniel Bristot de Oliveira 	if (err)
2250bce29ac9SDaniel Bristot de Oliveira 		goto err_free;
2251bce29ac9SDaniel Bristot de Oliveira 
2252bce29ac9SDaniel Bristot de Oliveira 	/*
2253dae18134SDaniel Bristot de Oliveira 	 * trace_types_lock is taken to avoid concurrency on start/stop.
2254bce29ac9SDaniel Bristot de Oliveira 	 */
2255bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&trace_types_lock);
2256dae18134SDaniel Bristot de Oliveira 	running = osnoise_has_registered_instances();
2257bce29ac9SDaniel Bristot de Oliveira 	if (running)
22582bd1bdf0SDaniel Bristot de Oliveira 		stop_per_cpu_kthreads();
2259bce29ac9SDaniel Bristot de Oliveira 
2260bce29ac9SDaniel Bristot de Oliveira 	mutex_lock(&interface_lock);
2261c8895e27SDaniel Bristot de Oliveira 	/*
2262c8895e27SDaniel Bristot de Oliveira 	 * osnoise_cpumask is read by CPU hotplug operations.
2263c8895e27SDaniel Bristot de Oliveira 	 */
226499c37d1aSSebastian Andrzej Siewior 	cpus_read_lock();
2265c8895e27SDaniel Bristot de Oliveira 
2266bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, osnoise_cpumask_new);
2267c8895e27SDaniel Bristot de Oliveira 
226899c37d1aSSebastian Andrzej Siewior 	cpus_read_unlock();
2269bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&interface_lock);
2270bce29ac9SDaniel Bristot de Oliveira 
2271bce29ac9SDaniel Bristot de Oliveira 	if (running)
22722bd1bdf0SDaniel Bristot de Oliveira 		start_per_cpu_kthreads();
2273bce29ac9SDaniel Bristot de Oliveira 	mutex_unlock(&trace_types_lock);
2274bce29ac9SDaniel Bristot de Oliveira 
2275bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
2276bce29ac9SDaniel Bristot de Oliveira 	return count;
2277bce29ac9SDaniel Bristot de Oliveira 
2278bce29ac9SDaniel Bristot de Oliveira err_free:
2279bce29ac9SDaniel Bristot de Oliveira 	free_cpumask_var(osnoise_cpumask_new);
2280bce29ac9SDaniel Bristot de Oliveira 
2281bce29ac9SDaniel Bristot de Oliveira 	return err;
2282bce29ac9SDaniel Bristot de Oliveira }
2283bce29ac9SDaniel Bristot de Oliveira 
2284bce29ac9SDaniel Bristot de Oliveira /*
2285bce29ac9SDaniel Bristot de Oliveira  * osnoise/runtime_us: cannot be greater than the period.
2286bce29ac9SDaniel Bristot de Oliveira  */
2287bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_runtime = {
2288bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2289bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_runtime,
2290bce29ac9SDaniel Bristot de Oliveira 	.max	= &osnoise_data.sample_period,
2291bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2292bce29ac9SDaniel Bristot de Oliveira };
2293bce29ac9SDaniel Bristot de Oliveira 
2294bce29ac9SDaniel Bristot de Oliveira /*
2295bce29ac9SDaniel Bristot de Oliveira  * osnoise/period_us: cannot be smaller than the runtime.
2296bce29ac9SDaniel Bristot de Oliveira  */
2297bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_period = {
2298bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2299bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.sample_period,
2300bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2301bce29ac9SDaniel Bristot de Oliveira 	.min	= &osnoise_data.sample_runtime,
2302bce29ac9SDaniel Bristot de Oliveira };
2303bce29ac9SDaniel Bristot de Oliveira 
2304bce29ac9SDaniel Bristot de Oliveira /*
2305bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_us: no limit.
2306bce29ac9SDaniel Bristot de Oliveira  */
2307bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_in = {
2308bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2309bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing,
2310bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2311bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2312bce29ac9SDaniel Bristot de Oliveira };
2313bce29ac9SDaniel Bristot de Oliveira 
2314bce29ac9SDaniel Bristot de Oliveira /*
2315bce29ac9SDaniel Bristot de Oliveira  * osnoise/stop_tracing_total_us: no limit.
2316bce29ac9SDaniel Bristot de Oliveira  */
2317bce29ac9SDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_stop_tracing_total = {
2318bce29ac9SDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2319bce29ac9SDaniel Bristot de Oliveira 	.val	= &osnoise_data.stop_tracing_total,
2320bce29ac9SDaniel Bristot de Oliveira 	.max	= NULL,
2321bce29ac9SDaniel Bristot de Oliveira 	.min	= NULL,
2322bce29ac9SDaniel Bristot de Oliveira };
2323bce29ac9SDaniel Bristot de Oliveira 
2324a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2325a955d7eaSDaniel Bristot de Oliveira /*
2326a955d7eaSDaniel Bristot de Oliveira  * osnoise/print_stack: print the stacktrace of the IRQ handler if the total
2327a955d7eaSDaniel Bristot de Oliveira  * latency is higher than val.
2328a955d7eaSDaniel Bristot de Oliveira  */
2329a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param osnoise_print_stack = {
2330a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2331a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.print_stack,
2332a955d7eaSDaniel Bristot de Oliveira 	.max	= NULL,
2333a955d7eaSDaniel Bristot de Oliveira 	.min	= NULL,
2334a955d7eaSDaniel Bristot de Oliveira };
2335a955d7eaSDaniel Bristot de Oliveira 
2336a955d7eaSDaniel Bristot de Oliveira /*
2337a955d7eaSDaniel Bristot de Oliveira  * osnoise/timerlat_period: min 100 us, max 1 s
2338a955d7eaSDaniel Bristot de Oliveira  */
23397a025e06STom Rix static u64 timerlat_min_period = 100;
23407a025e06STom Rix static u64 timerlat_max_period = 1000000;
2341a955d7eaSDaniel Bristot de Oliveira static struct trace_min_max_param timerlat_period = {
2342a955d7eaSDaniel Bristot de Oliveira 	.lock	= &interface_lock,
2343a955d7eaSDaniel Bristot de Oliveira 	.val	= &osnoise_data.timerlat_period,
2344a955d7eaSDaniel Bristot de Oliveira 	.max	= &timerlat_max_period,
2345a955d7eaSDaniel Bristot de Oliveira 	.min	= &timerlat_min_period,
2346a955d7eaSDaniel Bristot de Oliveira };
2347a955d7eaSDaniel Bristot de Oliveira #endif
2348a955d7eaSDaniel Bristot de Oliveira 
2349bce29ac9SDaniel Bristot de Oliveira static const struct file_operations cpus_fops = {
2350bce29ac9SDaniel Bristot de Oliveira 	.open		= tracing_open_generic,
2351bce29ac9SDaniel Bristot de Oliveira 	.read		= osnoise_cpus_read,
2352bce29ac9SDaniel Bristot de Oliveira 	.write		= osnoise_cpus_write,
2353bce29ac9SDaniel Bristot de Oliveira 	.llseek		= generic_file_llseek,
2354bce29ac9SDaniel Bristot de Oliveira };
2355bce29ac9SDaniel Bristot de Oliveira 
2356b179d48bSDaniel Bristot de Oliveira static const struct file_operations osnoise_options_fops = {
2357b179d48bSDaniel Bristot de Oliveira 	.open		= osnoise_options_open,
2358b179d48bSDaniel Bristot de Oliveira 	.read		= seq_read,
2359b179d48bSDaniel Bristot de Oliveira 	.llseek		= seq_lseek,
2360b179d48bSDaniel Bristot de Oliveira 	.release	= seq_release,
2361b179d48bSDaniel Bristot de Oliveira 	.write		= osnoise_options_write
2362b179d48bSDaniel Bristot de Oliveira };
2363b179d48bSDaniel Bristot de Oliveira 
2364ccb67544SDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2365b14f4568SDaniel Bristot de Oliveira #ifdef CONFIG_STACKTRACE
2366b14f4568SDaniel Bristot de Oliveira static int init_timerlat_stack_tracefs(struct dentry *top_dir)
2367b14f4568SDaniel Bristot de Oliveira {
2368b14f4568SDaniel Bristot de Oliveira 	struct dentry *tmp;
2369b14f4568SDaniel Bristot de Oliveira 
2370b14f4568SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("print_stack", TRACE_MODE_WRITE, top_dir,
2371b14f4568SDaniel Bristot de Oliveira 				  &osnoise_print_stack, &trace_min_max_fops);
2372b14f4568SDaniel Bristot de Oliveira 	if (!tmp)
2373b14f4568SDaniel Bristot de Oliveira 		return -ENOMEM;
2374b14f4568SDaniel Bristot de Oliveira 
2375b14f4568SDaniel Bristot de Oliveira 	return 0;
2376b14f4568SDaniel Bristot de Oliveira }
2377b14f4568SDaniel Bristot de Oliveira #else /* CONFIG_STACKTRACE */
2378b14f4568SDaniel Bristot de Oliveira static int init_timerlat_stack_tracefs(struct dentry *top_dir)
2379b14f4568SDaniel Bristot de Oliveira {
2380b14f4568SDaniel Bristot de Oliveira 	return 0;
2381b14f4568SDaniel Bristot de Oliveira }
2382b14f4568SDaniel Bristot de Oliveira #endif /* CONFIG_STACKTRACE */
2383b14f4568SDaniel Bristot de Oliveira 
2384ccb67544SDaniel Bristot de Oliveira /*
2385ccb67544SDaniel Bristot de Oliveira  * init_timerlat_tracefs - A function to initialize the timerlat interface files
2386ccb67544SDaniel Bristot de Oliveira  */
2387ccb67544SDaniel Bristot de Oliveira static int init_timerlat_tracefs(struct dentry *top_dir)
2388ccb67544SDaniel Bristot de Oliveira {
2389ccb67544SDaniel Bristot de Oliveira 	struct dentry *tmp;
2390ccb67544SDaniel Bristot de Oliveira 
2391ccb67544SDaniel Bristot de Oliveira 	tmp = tracefs_create_file("timerlat_period_us", TRACE_MODE_WRITE, top_dir,
2392ccb67544SDaniel Bristot de Oliveira 				  &timerlat_period, &trace_min_max_fops);
2393ccb67544SDaniel Bristot de Oliveira 	if (!tmp)
2394ccb67544SDaniel Bristot de Oliveira 		return -ENOMEM;
2395ccb67544SDaniel Bristot de Oliveira 
2396b14f4568SDaniel Bristot de Oliveira 	return init_timerlat_stack_tracefs(top_dir);
2397ccb67544SDaniel Bristot de Oliveira }
2398ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
2399ccb67544SDaniel Bristot de Oliveira static int init_timerlat_tracefs(struct dentry *top_dir)
2400ccb67544SDaniel Bristot de Oliveira {
2401ccb67544SDaniel Bristot de Oliveira 	return 0;
2402ccb67544SDaniel Bristot de Oliveira }
2403ccb67544SDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
2404ccb67544SDaniel Bristot de Oliveira 
2405bce29ac9SDaniel Bristot de Oliveira /*
2406bce29ac9SDaniel Bristot de Oliveira  * init_tracefs - A function to initialize the tracefs interface files
2407bce29ac9SDaniel Bristot de Oliveira  *
2408a955d7eaSDaniel Bristot de Oliveira  * This function creates entries in tracefs for "osnoise" and "timerlat".
2409a955d7eaSDaniel Bristot de Oliveira  * It creates these directories in the tracing directory, and within that
2410a955d7eaSDaniel Bristot de Oliveira  * directory the use can change and view the configs.
2411bce29ac9SDaniel Bristot de Oliveira  */
2412bce29ac9SDaniel Bristot de Oliveira static int init_tracefs(void)
2413bce29ac9SDaniel Bristot de Oliveira {
2414bce29ac9SDaniel Bristot de Oliveira 	struct dentry *top_dir;
2415bce29ac9SDaniel Bristot de Oliveira 	struct dentry *tmp;
2416bce29ac9SDaniel Bristot de Oliveira 	int ret;
2417bce29ac9SDaniel Bristot de Oliveira 
2418bce29ac9SDaniel Bristot de Oliveira 	ret = tracing_init_dentry();
2419bce29ac9SDaniel Bristot de Oliveira 	if (ret)
2420bce29ac9SDaniel Bristot de Oliveira 		return -ENOMEM;
2421bce29ac9SDaniel Bristot de Oliveira 
2422bce29ac9SDaniel Bristot de Oliveira 	top_dir = tracefs_create_dir("osnoise", NULL);
2423bce29ac9SDaniel Bristot de Oliveira 	if (!top_dir)
2424a955d7eaSDaniel Bristot de Oliveira 		return 0;
2425bce29ac9SDaniel Bristot de Oliveira 
242621ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("period_us", TRACE_MODE_WRITE, top_dir,
2427bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_period, &trace_min_max_fops);
2428bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2429bce29ac9SDaniel Bristot de Oliveira 		goto err;
2430bce29ac9SDaniel Bristot de Oliveira 
243121ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("runtime_us", TRACE_MODE_WRITE, top_dir,
2432bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_runtime, &trace_min_max_fops);
2433bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2434bce29ac9SDaniel Bristot de Oliveira 		goto err;
2435bce29ac9SDaniel Bristot de Oliveira 
243621ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("stop_tracing_us", TRACE_MODE_WRITE, top_dir,
2437bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_in, &trace_min_max_fops);
2438bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2439bce29ac9SDaniel Bristot de Oliveira 		goto err;
2440bce29ac9SDaniel Bristot de Oliveira 
244121ccc9cdSSteven Rostedt (VMware) 	tmp = tracefs_create_file("stop_tracing_total_us", TRACE_MODE_WRITE, top_dir,
2442bce29ac9SDaniel Bristot de Oliveira 				  &osnoise_stop_tracing_total, &trace_min_max_fops);
2443bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2444bce29ac9SDaniel Bristot de Oliveira 		goto err;
2445bce29ac9SDaniel Bristot de Oliveira 
244621ccc9cdSSteven Rostedt (VMware) 	tmp = trace_create_file("cpus", TRACE_MODE_WRITE, top_dir, NULL, &cpus_fops);
2447bce29ac9SDaniel Bristot de Oliveira 	if (!tmp)
2448bce29ac9SDaniel Bristot de Oliveira 		goto err;
2449a955d7eaSDaniel Bristot de Oliveira 
2450b179d48bSDaniel Bristot de Oliveira 	tmp = trace_create_file("options", TRACE_MODE_WRITE, top_dir, NULL,
2451b179d48bSDaniel Bristot de Oliveira 				&osnoise_options_fops);
2452b179d48bSDaniel Bristot de Oliveira 	if (!tmp)
2453b179d48bSDaniel Bristot de Oliveira 		goto err;
2454b179d48bSDaniel Bristot de Oliveira 
2455ccb67544SDaniel Bristot de Oliveira 	ret = init_timerlat_tracefs(top_dir);
2456ccb67544SDaniel Bristot de Oliveira 	if (ret)
2457a955d7eaSDaniel Bristot de Oliveira 		goto err;
2458bce29ac9SDaniel Bristot de Oliveira 
2459bce29ac9SDaniel Bristot de Oliveira 	return 0;
2460bce29ac9SDaniel Bristot de Oliveira 
2461bce29ac9SDaniel Bristot de Oliveira err:
2462bce29ac9SDaniel Bristot de Oliveira 	tracefs_remove(top_dir);
2463bce29ac9SDaniel Bristot de Oliveira 	return -ENOMEM;
2464bce29ac9SDaniel Bristot de Oliveira }
2465bce29ac9SDaniel Bristot de Oliveira 
2466bce29ac9SDaniel Bristot de Oliveira static int osnoise_hook_events(void)
2467bce29ac9SDaniel Bristot de Oliveira {
2468bce29ac9SDaniel Bristot de Oliveira 	int retval;
2469bce29ac9SDaniel Bristot de Oliveira 
2470bce29ac9SDaniel Bristot de Oliveira 	/*
2471bce29ac9SDaniel Bristot de Oliveira 	 * Trace is already hooked, we are re-enabling from
2472bce29ac9SDaniel Bristot de Oliveira 	 * a stop_tracing_*.
2473bce29ac9SDaniel Bristot de Oliveira 	 */
2474bce29ac9SDaniel Bristot de Oliveira 	if (trace_osnoise_callback_enabled)
2475bce29ac9SDaniel Bristot de Oliveira 		return 0;
2476bce29ac9SDaniel Bristot de Oliveira 
2477bce29ac9SDaniel Bristot de Oliveira 	retval = hook_irq_events();
2478bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2479bce29ac9SDaniel Bristot de Oliveira 		return -EINVAL;
2480bce29ac9SDaniel Bristot de Oliveira 
2481bce29ac9SDaniel Bristot de Oliveira 	retval = hook_softirq_events();
2482bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2483bce29ac9SDaniel Bristot de Oliveira 		goto out_unhook_irq;
2484bce29ac9SDaniel Bristot de Oliveira 
2485bce29ac9SDaniel Bristot de Oliveira 	retval = hook_thread_events();
2486bce29ac9SDaniel Bristot de Oliveira 	/*
2487bce29ac9SDaniel Bristot de Oliveira 	 * All fine!
2488bce29ac9SDaniel Bristot de Oliveira 	 */
2489bce29ac9SDaniel Bristot de Oliveira 	if (!retval)
2490bce29ac9SDaniel Bristot de Oliveira 		return 0;
2491bce29ac9SDaniel Bristot de Oliveira 
2492bce29ac9SDaniel Bristot de Oliveira 	unhook_softirq_events();
2493bce29ac9SDaniel Bristot de Oliveira out_unhook_irq:
2494bce29ac9SDaniel Bristot de Oliveira 	unhook_irq_events();
2495bce29ac9SDaniel Bristot de Oliveira 	return -EINVAL;
2496bce29ac9SDaniel Bristot de Oliveira }
2497bce29ac9SDaniel Bristot de Oliveira 
24980878355bSNikita Yushchenko static void osnoise_unhook_events(void)
24990878355bSNikita Yushchenko {
25000878355bSNikita Yushchenko 	unhook_thread_events();
25010878355bSNikita Yushchenko 	unhook_softirq_events();
25020878355bSNikita Yushchenko 	unhook_irq_events();
25030878355bSNikita Yushchenko }
25040878355bSNikita Yushchenko 
250515ca4bdbSDaniel Bristot de Oliveira /*
250615ca4bdbSDaniel Bristot de Oliveira  * osnoise_workload_start - start the workload and hook to events
250715ca4bdbSDaniel Bristot de Oliveira  */
250815ca4bdbSDaniel Bristot de Oliveira static int osnoise_workload_start(void)
2509bce29ac9SDaniel Bristot de Oliveira {
2510bce29ac9SDaniel Bristot de Oliveira 	int retval;
2511bce29ac9SDaniel Bristot de Oliveira 
25122fac8d64SDaniel Bristot de Oliveira 	/*
25132fac8d64SDaniel Bristot de Oliveira 	 * Instances need to be registered after calling workload
25142fac8d64SDaniel Bristot de Oliveira 	 * start. Hence, if there is already an instance, the
25152fac8d64SDaniel Bristot de Oliveira 	 * workload was already registered. Otherwise, this
25162fac8d64SDaniel Bristot de Oliveira 	 * code is on the way to register the first instance,
25172fac8d64SDaniel Bristot de Oliveira 	 * and the workload will start.
25182fac8d64SDaniel Bristot de Oliveira 	 */
25192fac8d64SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances())
25202fac8d64SDaniel Bristot de Oliveira 		return 0;
25212fac8d64SDaniel Bristot de Oliveira 
2522bce29ac9SDaniel Bristot de Oliveira 	osn_var_reset_all();
2523bce29ac9SDaniel Bristot de Oliveira 
2524bce29ac9SDaniel Bristot de Oliveira 	retval = osnoise_hook_events();
2525bce29ac9SDaniel Bristot de Oliveira 	if (retval)
2526a955d7eaSDaniel Bristot de Oliveira 		return retval;
2527c3b6343cSDaniel Bristot de Oliveira 
2528bce29ac9SDaniel Bristot de Oliveira 	/*
2529c3b6343cSDaniel Bristot de Oliveira 	 * Make sure that ftrace_nmi_enter/exit() see reset values
2530c3b6343cSDaniel Bristot de Oliveira 	 * before enabling trace_osnoise_callback_enabled.
2531bce29ac9SDaniel Bristot de Oliveira 	 */
2532bce29ac9SDaniel Bristot de Oliveira 	barrier();
2533bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = true;
2534bce29ac9SDaniel Bristot de Oliveira 
253515ca4bdbSDaniel Bristot de Oliveira 	retval = start_per_cpu_kthreads();
2536a955d7eaSDaniel Bristot de Oliveira 	if (retval) {
25370878355bSNikita Yushchenko 		trace_osnoise_callback_enabled = false;
25380878355bSNikita Yushchenko 		/*
25390878355bSNikita Yushchenko 		 * Make sure that ftrace_nmi_enter/exit() see
25400878355bSNikita Yushchenko 		 * trace_osnoise_callback_enabled as false before continuing.
25410878355bSNikita Yushchenko 		 */
25420878355bSNikita Yushchenko 		barrier();
25430878355bSNikita Yushchenko 
25440878355bSNikita Yushchenko 		osnoise_unhook_events();
2545a955d7eaSDaniel Bristot de Oliveira 		return retval;
2546a955d7eaSDaniel Bristot de Oliveira 	}
2547a955d7eaSDaniel Bristot de Oliveira 
2548a955d7eaSDaniel Bristot de Oliveira 	return 0;
2549a955d7eaSDaniel Bristot de Oliveira }
2550a955d7eaSDaniel Bristot de Oliveira 
255115ca4bdbSDaniel Bristot de Oliveira /*
255215ca4bdbSDaniel Bristot de Oliveira  * osnoise_workload_stop - stop the workload and unhook the events
255315ca4bdbSDaniel Bristot de Oliveira  */
255415ca4bdbSDaniel Bristot de Oliveira static void osnoise_workload_stop(void)
2555bce29ac9SDaniel Bristot de Oliveira {
25562fac8d64SDaniel Bristot de Oliveira 	/*
25572fac8d64SDaniel Bristot de Oliveira 	 * Instances need to be unregistered before calling
25582fac8d64SDaniel Bristot de Oliveira 	 * stop. Hence, if there is a registered instance, more
25592fac8d64SDaniel Bristot de Oliveira 	 * than one instance is running, and the workload will not
25602fac8d64SDaniel Bristot de Oliveira 	 * yet stop. Otherwise, this code is on the way to disable
25612fac8d64SDaniel Bristot de Oliveira 	 * the last instance, and the workload can stop.
25622fac8d64SDaniel Bristot de Oliveira 	 */
2563dae18134SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances())
2564bce29ac9SDaniel Bristot de Oliveira 		return;
2565bce29ac9SDaniel Bristot de Oliveira 
2566f0cfe17bSDaniel Bristot de Oliveira 	/*
2567f0cfe17bSDaniel Bristot de Oliveira 	 * If callbacks were already disabled in a previous stop
2568f0cfe17bSDaniel Bristot de Oliveira 	 * call, there is no need to disable then again.
2569f0cfe17bSDaniel Bristot de Oliveira 	 *
2570f0cfe17bSDaniel Bristot de Oliveira 	 * For instance, this happens when tracing is stopped via:
2571f0cfe17bSDaniel Bristot de Oliveira 	 * echo 0 > tracing_on
2572f0cfe17bSDaniel Bristot de Oliveira 	 * echo nop > current_tracer.
2573f0cfe17bSDaniel Bristot de Oliveira 	 */
2574f0cfe17bSDaniel Bristot de Oliveira 	if (!trace_osnoise_callback_enabled)
2575f0cfe17bSDaniel Bristot de Oliveira 		return;
2576f0cfe17bSDaniel Bristot de Oliveira 
2577bce29ac9SDaniel Bristot de Oliveira 	trace_osnoise_callback_enabled = false;
2578c3b6343cSDaniel Bristot de Oliveira 	/*
2579c3b6343cSDaniel Bristot de Oliveira 	 * Make sure that ftrace_nmi_enter/exit() see
2580c3b6343cSDaniel Bristot de Oliveira 	 * trace_osnoise_callback_enabled as false before continuing.
2581c3b6343cSDaniel Bristot de Oliveira 	 */
2582bce29ac9SDaniel Bristot de Oliveira 	barrier();
2583bce29ac9SDaniel Bristot de Oliveira 
2584bce29ac9SDaniel Bristot de Oliveira 	stop_per_cpu_kthreads();
2585bce29ac9SDaniel Bristot de Oliveira 
25860878355bSNikita Yushchenko 	osnoise_unhook_events();
2587bce29ac9SDaniel Bristot de Oliveira }
2588bce29ac9SDaniel Bristot de Oliveira 
258915ca4bdbSDaniel Bristot de Oliveira static void osnoise_tracer_start(struct trace_array *tr)
259015ca4bdbSDaniel Bristot de Oliveira {
259115ca4bdbSDaniel Bristot de Oliveira 	int retval;
259215ca4bdbSDaniel Bristot de Oliveira 
25932fac8d64SDaniel Bristot de Oliveira 	/*
25942fac8d64SDaniel Bristot de Oliveira 	 * If the instance is already registered, there is no need to
25952fac8d64SDaniel Bristot de Oliveira 	 * register it again.
25962fac8d64SDaniel Bristot de Oliveira 	 */
25972fac8d64SDaniel Bristot de Oliveira 	if (osnoise_instance_registered(tr))
259815ca4bdbSDaniel Bristot de Oliveira 		return;
259915ca4bdbSDaniel Bristot de Oliveira 
260015ca4bdbSDaniel Bristot de Oliveira 	retval = osnoise_workload_start();
260115ca4bdbSDaniel Bristot de Oliveira 	if (retval)
260215ca4bdbSDaniel Bristot de Oliveira 		pr_err(BANNER "Error starting osnoise tracer\n");
260315ca4bdbSDaniel Bristot de Oliveira 
2604dae18134SDaniel Bristot de Oliveira 	osnoise_register_instance(tr);
260515ca4bdbSDaniel Bristot de Oliveira }
260615ca4bdbSDaniel Bristot de Oliveira 
260715ca4bdbSDaniel Bristot de Oliveira static void osnoise_tracer_stop(struct trace_array *tr)
260815ca4bdbSDaniel Bristot de Oliveira {
2609dae18134SDaniel Bristot de Oliveira 	osnoise_unregister_instance(tr);
261015ca4bdbSDaniel Bristot de Oliveira 	osnoise_workload_stop();
261115ca4bdbSDaniel Bristot de Oliveira }
261215ca4bdbSDaniel Bristot de Oliveira 
2613bce29ac9SDaniel Bristot de Oliveira static int osnoise_tracer_init(struct trace_array *tr)
2614bce29ac9SDaniel Bristot de Oliveira {
26152fac8d64SDaniel Bristot de Oliveira 	/*
26162fac8d64SDaniel Bristot de Oliveira 	 * Only allow osnoise tracer if timerlat tracer is not running
26172fac8d64SDaniel Bristot de Oliveira 	 * already.
26182fac8d64SDaniel Bristot de Oliveira 	 */
26192fac8d64SDaniel Bristot de Oliveira 	if (timerlat_enabled())
2620bce29ac9SDaniel Bristot de Oliveira 		return -EBUSY;
2621bce29ac9SDaniel Bristot de Oliveira 
2622bce29ac9SDaniel Bristot de Oliveira 	tr->max_latency = 0;
2623bce29ac9SDaniel Bristot de Oliveira 
2624bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_start(tr);
2625bce29ac9SDaniel Bristot de Oliveira 	return 0;
2626bce29ac9SDaniel Bristot de Oliveira }
2627bce29ac9SDaniel Bristot de Oliveira 
2628bce29ac9SDaniel Bristot de Oliveira static void osnoise_tracer_reset(struct trace_array *tr)
2629bce29ac9SDaniel Bristot de Oliveira {
2630bce29ac9SDaniel Bristot de Oliveira 	osnoise_tracer_stop(tr);
2631bce29ac9SDaniel Bristot de Oliveira }
2632bce29ac9SDaniel Bristot de Oliveira 
2633bce29ac9SDaniel Bristot de Oliveira static struct tracer osnoise_tracer __read_mostly = {
2634bce29ac9SDaniel Bristot de Oliveira 	.name		= "osnoise",
2635bce29ac9SDaniel Bristot de Oliveira 	.init		= osnoise_tracer_init,
2636bce29ac9SDaniel Bristot de Oliveira 	.reset		= osnoise_tracer_reset,
2637bce29ac9SDaniel Bristot de Oliveira 	.start		= osnoise_tracer_start,
2638bce29ac9SDaniel Bristot de Oliveira 	.stop		= osnoise_tracer_stop,
2639bce29ac9SDaniel Bristot de Oliveira 	.print_header	= print_osnoise_headers,
2640bce29ac9SDaniel Bristot de Oliveira 	.allow_instances = true,
2641bce29ac9SDaniel Bristot de Oliveira };
2642bce29ac9SDaniel Bristot de Oliveira 
2643a955d7eaSDaniel Bristot de Oliveira #ifdef CONFIG_TIMERLAT_TRACER
2644a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_start(struct trace_array *tr)
2645a955d7eaSDaniel Bristot de Oliveira {
2646a955d7eaSDaniel Bristot de Oliveira 	int retval;
2647a955d7eaSDaniel Bristot de Oliveira 
26482fac8d64SDaniel Bristot de Oliveira 	/*
26492fac8d64SDaniel Bristot de Oliveira 	 * If the instance is already registered, there is no need to
26502fac8d64SDaniel Bristot de Oliveira 	 * register it again.
26512fac8d64SDaniel Bristot de Oliveira 	 */
26522fac8d64SDaniel Bristot de Oliveira 	if (osnoise_instance_registered(tr))
2653a955d7eaSDaniel Bristot de Oliveira 		return;
2654a955d7eaSDaniel Bristot de Oliveira 
265515ca4bdbSDaniel Bristot de Oliveira 	retval = osnoise_workload_start();
2656a955d7eaSDaniel Bristot de Oliveira 	if (retval)
26572fac8d64SDaniel Bristot de Oliveira 		pr_err(BANNER "Error starting timerlat tracer\n");
2658a955d7eaSDaniel Bristot de Oliveira 
2659dae18134SDaniel Bristot de Oliveira 	osnoise_register_instance(tr);
2660dae18134SDaniel Bristot de Oliveira 
2661a955d7eaSDaniel Bristot de Oliveira 	return;
2662a955d7eaSDaniel Bristot de Oliveira }
2663a955d7eaSDaniel Bristot de Oliveira 
2664a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_stop(struct trace_array *tr)
2665a955d7eaSDaniel Bristot de Oliveira {
2666a955d7eaSDaniel Bristot de Oliveira 	int cpu;
2667a955d7eaSDaniel Bristot de Oliveira 
26682fac8d64SDaniel Bristot de Oliveira 	osnoise_unregister_instance(tr);
2669a955d7eaSDaniel Bristot de Oliveira 
26702fac8d64SDaniel Bristot de Oliveira 	/*
26712fac8d64SDaniel Bristot de Oliveira 	 * Instruct the threads to stop only if this is the last instance.
26722fac8d64SDaniel Bristot de Oliveira 	 */
26732fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances()) {
2674a955d7eaSDaniel Bristot de Oliveira 		for_each_online_cpu(cpu)
2675a955d7eaSDaniel Bristot de Oliveira 			per_cpu(per_cpu_osnoise_var, cpu).sampling = 0;
26762fac8d64SDaniel Bristot de Oliveira 	}
2677a955d7eaSDaniel Bristot de Oliveira 
26782fac8d64SDaniel Bristot de Oliveira 	osnoise_workload_stop();
2679a955d7eaSDaniel Bristot de Oliveira }
2680a955d7eaSDaniel Bristot de Oliveira 
2681a955d7eaSDaniel Bristot de Oliveira static int timerlat_tracer_init(struct trace_array *tr)
2682a955d7eaSDaniel Bristot de Oliveira {
26832fac8d64SDaniel Bristot de Oliveira 	/*
26842fac8d64SDaniel Bristot de Oliveira 	 * Only allow timerlat tracer if osnoise tracer is not running already.
26852fac8d64SDaniel Bristot de Oliveira 	 */
26862fac8d64SDaniel Bristot de Oliveira 	if (osnoise_has_registered_instances() && !osnoise_data.timerlat_tracer)
2687a955d7eaSDaniel Bristot de Oliveira 		return -EBUSY;
2688a955d7eaSDaniel Bristot de Oliveira 
26892fac8d64SDaniel Bristot de Oliveira 	/*
26902fac8d64SDaniel Bristot de Oliveira 	 * If this is the first instance, set timerlat_tracer to block
26912fac8d64SDaniel Bristot de Oliveira 	 * osnoise tracer start.
26922fac8d64SDaniel Bristot de Oliveira 	 */
26932fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
26942fac8d64SDaniel Bristot de Oliveira 		osnoise_data.timerlat_tracer = 1;
2695a955d7eaSDaniel Bristot de Oliveira 
26962fac8d64SDaniel Bristot de Oliveira 	tr->max_latency = 0;
2697a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_start(tr);
2698a955d7eaSDaniel Bristot de Oliveira 
2699a955d7eaSDaniel Bristot de Oliveira 	return 0;
2700a955d7eaSDaniel Bristot de Oliveira }
2701a955d7eaSDaniel Bristot de Oliveira 
2702a955d7eaSDaniel Bristot de Oliveira static void timerlat_tracer_reset(struct trace_array *tr)
2703a955d7eaSDaniel Bristot de Oliveira {
2704a955d7eaSDaniel Bristot de Oliveira 	timerlat_tracer_stop(tr);
27052fac8d64SDaniel Bristot de Oliveira 
27062fac8d64SDaniel Bristot de Oliveira 	/*
27072fac8d64SDaniel Bristot de Oliveira 	 * If this is the last instance, reset timerlat_tracer allowing
27082fac8d64SDaniel Bristot de Oliveira 	 * osnoise to be started.
27092fac8d64SDaniel Bristot de Oliveira 	 */
27102fac8d64SDaniel Bristot de Oliveira 	if (!osnoise_has_registered_instances())
27112fac8d64SDaniel Bristot de Oliveira 		osnoise_data.timerlat_tracer = 0;
2712a955d7eaSDaniel Bristot de Oliveira }
2713a955d7eaSDaniel Bristot de Oliveira 
2714a955d7eaSDaniel Bristot de Oliveira static struct tracer timerlat_tracer __read_mostly = {
2715a955d7eaSDaniel Bristot de Oliveira 	.name		= "timerlat",
2716a955d7eaSDaniel Bristot de Oliveira 	.init		= timerlat_tracer_init,
2717a955d7eaSDaniel Bristot de Oliveira 	.reset		= timerlat_tracer_reset,
2718a955d7eaSDaniel Bristot de Oliveira 	.start		= timerlat_tracer_start,
2719a955d7eaSDaniel Bristot de Oliveira 	.stop		= timerlat_tracer_stop,
2720a955d7eaSDaniel Bristot de Oliveira 	.print_header	= print_timerlat_headers,
2721a955d7eaSDaniel Bristot de Oliveira 	.allow_instances = true,
2722a955d7eaSDaniel Bristot de Oliveira };
2723ccb67544SDaniel Bristot de Oliveira 
2724ccb67544SDaniel Bristot de Oliveira __init static int init_timerlat_tracer(void)
2725ccb67544SDaniel Bristot de Oliveira {
2726ccb67544SDaniel Bristot de Oliveira 	return register_tracer(&timerlat_tracer);
2727ccb67544SDaniel Bristot de Oliveira }
2728ccb67544SDaniel Bristot de Oliveira #else /* CONFIG_TIMERLAT_TRACER */
2729ccb67544SDaniel Bristot de Oliveira __init static int init_timerlat_tracer(void)
2730ccb67544SDaniel Bristot de Oliveira {
2731ccb67544SDaniel Bristot de Oliveira 	return 0;
2732ccb67544SDaniel Bristot de Oliveira }
2733a955d7eaSDaniel Bristot de Oliveira #endif /* CONFIG_TIMERLAT_TRACER */
2734a955d7eaSDaniel Bristot de Oliveira 
2735bce29ac9SDaniel Bristot de Oliveira __init static int init_osnoise_tracer(void)
2736bce29ac9SDaniel Bristot de Oliveira {
2737bce29ac9SDaniel Bristot de Oliveira 	int ret;
2738bce29ac9SDaniel Bristot de Oliveira 
2739bce29ac9SDaniel Bristot de Oliveira 	mutex_init(&interface_lock);
2740bce29ac9SDaniel Bristot de Oliveira 
2741bce29ac9SDaniel Bristot de Oliveira 	cpumask_copy(&osnoise_cpumask, cpu_all_mask);
2742bce29ac9SDaniel Bristot de Oliveira 
2743bce29ac9SDaniel Bristot de Oliveira 	ret = register_tracer(&osnoise_tracer);
2744a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
2745a955d7eaSDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering osnoise!\n");
2746bce29ac9SDaniel Bristot de Oliveira 		return ret;
2747a955d7eaSDaniel Bristot de Oliveira 	}
2748a955d7eaSDaniel Bristot de Oliveira 
2749ccb67544SDaniel Bristot de Oliveira 	ret = init_timerlat_tracer();
2750a955d7eaSDaniel Bristot de Oliveira 	if (ret) {
2751ccb67544SDaniel Bristot de Oliveira 		pr_err(BANNER "Error registering timerlat!\n");
2752a955d7eaSDaniel Bristot de Oliveira 		return ret;
2753a955d7eaSDaniel Bristot de Oliveira 	}
2754ccb67544SDaniel Bristot de Oliveira 
2755c8895e27SDaniel Bristot de Oliveira 	osnoise_init_hotplug_support();
2756bce29ac9SDaniel Bristot de Oliveira 
2757dae18134SDaniel Bristot de Oliveira 	INIT_LIST_HEAD_RCU(&osnoise_instances);
2758dae18134SDaniel Bristot de Oliveira 
2759bce29ac9SDaniel Bristot de Oliveira 	init_tracefs();
2760bce29ac9SDaniel Bristot de Oliveira 
2761bce29ac9SDaniel Bristot de Oliveira 	return 0;
2762bce29ac9SDaniel Bristot de Oliveira }
2763bce29ac9SDaniel Bristot de Oliveira late_initcall(init_osnoise_tracer);
2764