xref: /linux-6.15/kernel/trace/ftrace.c (revision b80f0f6c)
116444a8aSArnaldo Carvalho de Melo /*
216444a8aSArnaldo Carvalho de Melo  * Infrastructure for profiling code inserted by 'gcc -pg'.
316444a8aSArnaldo Carvalho de Melo  *
416444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2007-2008 Steven Rostedt <[email protected]>
516444a8aSArnaldo Carvalho de Melo  * Copyright (C) 2004-2008 Ingo Molnar <[email protected]>
616444a8aSArnaldo Carvalho de Melo  *
716444a8aSArnaldo Carvalho de Melo  * Originally ported from the -rt patch by:
816444a8aSArnaldo Carvalho de Melo  *   Copyright (C) 2007 Arnaldo Carvalho de Melo <[email protected]>
916444a8aSArnaldo Carvalho de Melo  *
1016444a8aSArnaldo Carvalho de Melo  * Based on code in the latency_tracer, that is:
1116444a8aSArnaldo Carvalho de Melo  *
1216444a8aSArnaldo Carvalho de Melo  *  Copyright (C) 2004-2006 Ingo Molnar
136d49e352SNadia Yvette Chambers  *  Copyright (C) 2004 Nadia Yvette Chambers
1416444a8aSArnaldo Carvalho de Melo  */
1516444a8aSArnaldo Carvalho de Melo 
163d083395SSteven Rostedt #include <linux/stop_machine.h>
173d083395SSteven Rostedt #include <linux/clocksource.h>
1829930025SIngo Molnar #include <linux/sched/task.h>
193d083395SSteven Rostedt #include <linux/kallsyms.h>
205072c59fSSteven Rostedt #include <linux/seq_file.h>
214a2b8ddaSFrederic Weisbecker #include <linux/suspend.h>
228434dc93SSteven Rostedt (Red Hat) #include <linux/tracefs.h>
233d083395SSteven Rostedt #include <linux/hardirq.h>
242d8b820bSIngo Molnar #include <linux/kthread.h>
255072c59fSSteven Rostedt #include <linux/uaccess.h>
265855feadSSteven Rostedt #include <linux/bsearch.h>
2756d82e00SPaul Gortmaker #include <linux/module.h>
282d8b820bSIngo Molnar #include <linux/ftrace.h>
29b0fc494fSSteven Rostedt #include <linux/sysctl.h>
305a0e3ad6STejun Heo #include <linux/slab.h>
315072c59fSSteven Rostedt #include <linux/ctype.h>
3268950619SSteven Rostedt #include <linux/sort.h>
333d083395SSteven Rostedt #include <linux/list.h>
3459df055fSSteven Rostedt #include <linux/hash.h>
353f379b03SPaul E. McKenney #include <linux/rcupdate.h>
3616444a8aSArnaldo Carvalho de Melo 
37ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
388aef2d28SSteven Rostedt 
39*b80f0f6cSSteven Rostedt (VMware) #include <asm/sections.h>
402af15d6aSSteven Rostedt #include <asm/setup.h>
41395a59d0SAbhishek Sagar 
420706f1c4SSteven Rostedt #include "trace_output.h"
43bac429f0SSteven Rostedt #include "trace_stat.h"
443d083395SSteven Rostedt 
456912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
460778d9adSSteven Rostedt 	({					\
470778d9adSSteven Rostedt 		int ___r = cond;		\
480778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
496912896eSSteven Rostedt 			ftrace_kill();		\
500778d9adSSteven Rostedt 		___r;				\
510778d9adSSteven Rostedt 	})
526912896eSSteven Rostedt 
536912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
540778d9adSSteven Rostedt 	({					\
550778d9adSSteven Rostedt 		int ___r = cond;		\
560778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
576912896eSSteven Rostedt 			ftrace_kill();		\
580778d9adSSteven Rostedt 		___r;				\
590778d9adSSteven Rostedt 	})
606912896eSSteven Rostedt 
618fc0c701SSteven Rostedt /* hash bits for specific function selection */
628fc0c701SSteven Rostedt #define FTRACE_HASH_BITS 7
638fc0c701SSteven Rostedt #define FTRACE_FUNC_HASHSIZE (1 << FTRACE_HASH_BITS)
6433dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6533dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
668fc0c701SSteven Rostedt 
67f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
6833b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
6933b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
7033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
715f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val) \
725f151b24SSteven Rostedt (Red Hat) 	.func_hash		= val, \
735f151b24SSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
74f04f24fbSMasami Hiramatsu #else
7533b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
765f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val)
77f04f24fbSMasami Hiramatsu #endif
78f04f24fbSMasami Hiramatsu 
792f5f6ad9SSteven Rostedt static struct ftrace_ops ftrace_list_end __read_mostly = {
802f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
81395b97a3SSteven Rostedt (Red Hat) 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_STUB,
8233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
832f5f6ad9SSteven Rostedt };
842f5f6ad9SSteven Rostedt 
854eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
864eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
87d61f82d0SSteven Rostedt static int last_ftrace_enabled;
88b0fc494fSSteven Rostedt 
892f5f6ad9SSteven Rostedt /* Current function tracing op */
902f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
91405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
92405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9360a7ecf4SSteven Rostedt 
94345ddcc8SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(struct ftrace_ops *ops)
95e3eea140SSteven Rostedt (Red Hat) {
96345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
97345ddcc8SSteven Rostedt (Red Hat) 
98345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
99345ddcc8SSteven Rostedt (Red Hat) 		return false;
100345ddcc8SSteven Rostedt (Red Hat) 
101345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
102345ddcc8SSteven Rostedt (Red Hat) 
103345ddcc8SSteven Rostedt (Red Hat) 	return tr->function_pids != NULL;
104e3eea140SSteven Rostedt (Red Hat) }
105e3eea140SSteven Rostedt (Red Hat) 
106e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
107e3eea140SSteven Rostedt (Red Hat) 
1084eebcc81SSteven Rostedt /*
1094eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1104eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1114eebcc81SSteven Rostedt  */
1124eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1134eebcc81SSteven Rostedt 
11452baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
115b0fc494fSSteven Rostedt 
116b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
11716444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1182b499381SSteven Rostedt static struct ftrace_ops global_ops;
11916444a8aSArnaldo Carvalho de Melo 
1202f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
1212f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
122a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs);
1232f5f6ad9SSteven Rostedt #else
1242f5f6ad9SSteven Rostedt /* See comment below, where ftrace_ops_list_func is defined */
1252f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
1262f5f6ad9SSteven Rostedt #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
1272f5f6ad9SSteven Rostedt #endif
128b848914cSSteven Rostedt 
1290a016409SSteven Rostedt /*
1300a016409SSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1311bb539caSSteven Rostedt  * can use rcu_dereference_raw_notrace() is that elements removed from this list
1320a016409SSteven Rostedt  * are simply leaked, so there is no need to interact with a grace-period
1331bb539caSSteven Rostedt  * mechanism.  The rcu_dereference_raw_notrace() calls are needed to handle
1340a016409SSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1350a016409SSteven Rostedt  *
1360a016409SSteven Rostedt  * Silly Alpha and silly pointer-speculation compiler optimizations!
1370a016409SSteven Rostedt  */
1380a016409SSteven Rostedt #define do_for_each_ftrace_op(op, list)			\
1391bb539caSSteven Rostedt 	op = rcu_dereference_raw_notrace(list);			\
1400a016409SSteven Rostedt 	do
1410a016409SSteven Rostedt 
1420a016409SSteven Rostedt /*
1430a016409SSteven Rostedt  * Optimized for just a single item in the list (as that is the normal case).
1440a016409SSteven Rostedt  */
1450a016409SSteven Rostedt #define while_for_each_ftrace_op(op)				\
1461bb539caSSteven Rostedt 	while (likely(op = rcu_dereference_raw_notrace((op)->next)) &&	\
1470a016409SSteven Rostedt 	       unlikely((op) != &ftrace_list_end))
1480a016409SSteven Rostedt 
149f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
150f04f24fbSMasami Hiramatsu {
151f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
152f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
15333b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
15433b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
155f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
156f04f24fbSMasami Hiramatsu 	}
157f04f24fbSMasami Hiramatsu #endif
158f04f24fbSMasami Hiramatsu }
159f04f24fbSMasami Hiramatsu 
160ea701f11SSteven Rostedt /**
161ea701f11SSteven Rostedt  * ftrace_nr_registered_ops - return number of ops registered
162ea701f11SSteven Rostedt  *
163ea701f11SSteven Rostedt  * Returns the number of ftrace_ops registered and tracing functions
164ea701f11SSteven Rostedt  */
165ea701f11SSteven Rostedt int ftrace_nr_registered_ops(void)
166ea701f11SSteven Rostedt {
167ea701f11SSteven Rostedt 	struct ftrace_ops *ops;
168ea701f11SSteven Rostedt 	int cnt = 0;
169ea701f11SSteven Rostedt 
170ea701f11SSteven Rostedt 	mutex_lock(&ftrace_lock);
171ea701f11SSteven Rostedt 
172ea701f11SSteven Rostedt 	for (ops = ftrace_ops_list;
173ea701f11SSteven Rostedt 	     ops != &ftrace_list_end; ops = ops->next)
174ea701f11SSteven Rostedt 		cnt++;
175ea701f11SSteven Rostedt 
176ea701f11SSteven Rostedt 	mutex_unlock(&ftrace_lock);
177ea701f11SSteven Rostedt 
178ea701f11SSteven Rostedt 	return cnt;
179ea701f11SSteven Rostedt }
180ea701f11SSteven Rostedt 
1812f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
182a1e2e31dSSteven Rostedt 			    struct ftrace_ops *op, struct pt_regs *regs)
183df4fc315SSteven Rostedt {
184345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
185345ddcc8SSteven Rostedt (Red Hat) 
186345ddcc8SSteven Rostedt (Red Hat) 	if (tr && this_cpu_read(tr->trace_buffer.data->ftrace_ignore_pid))
187df4fc315SSteven Rostedt 		return;
188df4fc315SSteven Rostedt 
189e3eea140SSteven Rostedt (Red Hat) 	op->saved_func(ip, parent_ip, op, regs);
190df4fc315SSteven Rostedt }
191df4fc315SSteven Rostedt 
19216444a8aSArnaldo Carvalho de Melo /**
1933d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
19416444a8aSArnaldo Carvalho de Melo  *
1953d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1963d083395SSteven Rostedt  * tracing.  There may be lag
19716444a8aSArnaldo Carvalho de Melo  */
1983d083395SSteven Rostedt void clear_ftrace_function(void)
19916444a8aSArnaldo Carvalho de Melo {
2003d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
2013d083395SSteven Rostedt }
20216444a8aSArnaldo Carvalho de Melo 
203ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_disable_all(struct ftrace_ops *ops)
204e248491aSJiri Olsa {
205e248491aSJiri Olsa 	int cpu;
206e248491aSJiri Olsa 
207e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
208e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
209e248491aSJiri Olsa }
210e248491aSJiri Olsa 
211ba27f2bcSSteven Rostedt (Red Hat) static int per_cpu_ops_alloc(struct ftrace_ops *ops)
212e248491aSJiri Olsa {
213e248491aSJiri Olsa 	int __percpu *disabled;
214e248491aSJiri Olsa 
215ba27f2bcSSteven Rostedt (Red Hat) 	if (WARN_ON_ONCE(!(ops->flags & FTRACE_OPS_FL_PER_CPU)))
216ba27f2bcSSteven Rostedt (Red Hat) 		return -EINVAL;
217ba27f2bcSSteven Rostedt (Red Hat) 
218e248491aSJiri Olsa 	disabled = alloc_percpu(int);
219e248491aSJiri Olsa 	if (!disabled)
220e248491aSJiri Olsa 		return -ENOMEM;
221e248491aSJiri Olsa 
222e248491aSJiri Olsa 	ops->disabled = disabled;
223ba27f2bcSSteven Rostedt (Red Hat) 	per_cpu_ops_disable_all(ops);
224e248491aSJiri Olsa 	return 0;
225e248491aSJiri Olsa }
226e248491aSJiri Olsa 
227405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync(struct work_struct *work)
228405e1d83SSteven Rostedt (Red Hat) {
229405e1d83SSteven Rostedt (Red Hat) 	/*
230405e1d83SSteven Rostedt (Red Hat) 	 * This function is just a stub to implement a hard force
231405e1d83SSteven Rostedt (Red Hat) 	 * of synchronize_sched(). This requires synchronizing
232405e1d83SSteven Rostedt (Red Hat) 	 * tasks even in userspace and idle.
233405e1d83SSteven Rostedt (Red Hat) 	 *
234405e1d83SSteven Rostedt (Red Hat) 	 * Yes, function tracing is rude.
235405e1d83SSteven Rostedt (Red Hat) 	 */
236405e1d83SSteven Rostedt (Red Hat) }
237405e1d83SSteven Rostedt (Red Hat) 
238405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
239405e1d83SSteven Rostedt (Red Hat) {
240405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
241405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
242405e1d83SSteven Rostedt (Red Hat) }
243405e1d83SSteven Rostedt (Red Hat) 
24423a8e844SSteven Rostedt (Red Hat) #ifdef CONFIG_FUNCTION_GRAPH_TRACER
24523a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void);
24655577204SSteven Rostedt (Red Hat) 
24755577204SSteven Rostedt (Red Hat) /* Both enabled by default (can be cleared by function_graph tracer flags */
24855577204SSteven Rostedt (Red Hat) static bool fgraph_sleep_time = true;
24955577204SSteven Rostedt (Red Hat) static bool fgraph_graph_time = true;
25055577204SSteven Rostedt (Red Hat) 
25123a8e844SSteven Rostedt (Red Hat) #else
25223a8e844SSteven Rostedt (Red Hat) static inline void update_function_graph_func(void) { }
25323a8e844SSteven Rostedt (Red Hat) #endif
25423a8e844SSteven Rostedt (Red Hat) 
25500ccbf2fSSteven Rostedt (Red Hat) 
25600ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
25700ccbf2fSSteven Rostedt (Red Hat) {
25800ccbf2fSSteven Rostedt (Red Hat) 	/*
259ba27f2bcSSteven Rostedt (Red Hat) 	 * If this is a dynamic, RCU, or per CPU ops, or we force list func,
26000ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
26100ccbf2fSSteven Rostedt (Red Hat) 	 */
262ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU |
263ba27f2bcSSteven Rostedt (Red Hat) 			  FTRACE_OPS_FL_RCU) || FTRACE_FORCE_LIST_FUNC)
26400ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
26500ccbf2fSSteven Rostedt (Red Hat) 
26600ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
26700ccbf2fSSteven Rostedt (Red Hat) }
26800ccbf2fSSteven Rostedt (Red Hat) 
2692b499381SSteven Rostedt static void update_ftrace_function(void)
2702b499381SSteven Rostedt {
2712b499381SSteven Rostedt 	ftrace_func_t func;
2722b499381SSteven Rostedt 
273cdbe61bfSSteven Rostedt 	/*
274f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
275f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
276f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
277f7aad4e1SSteven Rostedt (Red Hat) 	 */
278f7aad4e1SSteven Rostedt (Red Hat) 	set_function_trace_op = ftrace_ops_list;
279f7aad4e1SSteven Rostedt (Red Hat) 
280f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
281f7aad4e1SSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
282f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
283f7aad4e1SSteven Rostedt (Red Hat) 
284f7aad4e1SSteven Rostedt (Red Hat) 	/*
285cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2864740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2874740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
288cdbe61bfSSteven Rostedt 	 */
289f7aad4e1SSteven Rostedt (Red Hat) 	} else if (ftrace_ops_list->next == &ftrace_list_end) {
29000ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
291f7aad4e1SSteven Rostedt (Red Hat) 
2922f5f6ad9SSteven Rostedt 	} else {
2932f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
294405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
295b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2962f5f6ad9SSteven Rostedt 	}
2972b499381SSteven Rostedt 
2985f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2995f8bf2d2SSteven Rostedt (Red Hat) 
300405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
301405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
302405e1d83SSteven Rostedt (Red Hat) 		return;
303405e1d83SSteven Rostedt (Red Hat) 
304405e1d83SSteven Rostedt (Red Hat) 	/*
305405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
306405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
307405e1d83SSteven Rostedt (Red Hat) 	 */
308405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
309405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
310405e1d83SSteven Rostedt (Red Hat) 		/*
311405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
312405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
313405e1d83SSteven Rostedt (Red Hat) 		 */
314405e1d83SSteven Rostedt (Red Hat) 		return;
315405e1d83SSteven Rostedt (Red Hat) 	}
316405e1d83SSteven Rostedt (Red Hat) 
317405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
318405e1d83SSteven Rostedt (Red Hat) 	/*
319405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
320405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
321405e1d83SSteven Rostedt (Red Hat) 	 * we need to coorditate the setting of the function_trace_ops
322405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
323405e1d83SSteven Rostedt (Red Hat) 	 *
324405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
325405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
326405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
327405e1d83SSteven Rostedt (Red Hat) 	 */
328405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
329405e1d83SSteven Rostedt (Red Hat) 	/*
330405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
331405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
332405e1d83SSteven Rostedt (Red Hat) 	 */
333405e1d83SSteven Rostedt (Red Hat) 	schedule_on_each_cpu(ftrace_sync);
334405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
335405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
336405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
337405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
338405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
339405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
340405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
341405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
342405e1d83SSteven Rostedt (Red Hat) 
343491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
344491d0dcfSSteven Rostedt }
345491d0dcfSSteven Rostedt 
3467eea4fceSJiaxing Wang int using_ftrace_ops_list_func(void)
3477eea4fceSJiaxing Wang {
3487eea4fceSJiaxing Wang 	return ftrace_trace_function == ftrace_ops_list_func;
3497eea4fceSJiaxing Wang }
3507eea4fceSJiaxing Wang 
3512b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3523d083395SSteven Rostedt {
3532b499381SSteven Rostedt 	ops->next = *list;
35416444a8aSArnaldo Carvalho de Melo 	/*
355b848914cSSteven Rostedt 	 * We are entering ops into the list but another
35616444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
35716444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
358b848914cSSteven Rostedt 	 * the ops pointer included into the list.
35916444a8aSArnaldo Carvalho de Melo 	 */
3602b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
3612b499381SSteven Rostedt }
3623d083395SSteven Rostedt 
3632b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3642b499381SSteven Rostedt {
3652b499381SSteven Rostedt 	struct ftrace_ops **p;
3662b499381SSteven Rostedt 
3672b499381SSteven Rostedt 	/*
3682b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3692b499381SSteven Rostedt 	 * to the ftrace_stub.
3702b499381SSteven Rostedt 	 */
3712b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
3722b499381SSteven Rostedt 		*list = &ftrace_list_end;
3732b499381SSteven Rostedt 		return 0;
3742b499381SSteven Rostedt 	}
3752b499381SSteven Rostedt 
3762b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3772b499381SSteven Rostedt 		if (*p == ops)
3782b499381SSteven Rostedt 			break;
3792b499381SSteven Rostedt 
3802b499381SSteven Rostedt 	if (*p != ops)
3812b499381SSteven Rostedt 		return -1;
3822b499381SSteven Rostedt 
3832b499381SSteven Rostedt 	*p = (*p)->next;
3842b499381SSteven Rostedt 	return 0;
3852b499381SSteven Rostedt }
3862b499381SSteven Rostedt 
387f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
388f3bea491SSteven Rostedt (Red Hat) 
3892b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3902b499381SSteven Rostedt {
391591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
392591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
393591dffdaSSteven Rostedt (Red Hat) 
394b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
395b848914cSSteven Rostedt 		return -EBUSY;
396b848914cSSteven Rostedt 
39706aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
39808f6fba5SSteven Rostedt 	/*
39908f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
40008f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
40108f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
40208f6fba5SSteven Rostedt 	 */
40308f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
40408f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
40508f6fba5SSteven Rostedt 		return -EINVAL;
40608f6fba5SSteven Rostedt 
40708f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
40808f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
40908f6fba5SSteven Rostedt #endif
41008f6fba5SSteven Rostedt 
411cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
412cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
413cdbe61bfSSteven Rostedt 
414ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_PER_CPU) {
415ba27f2bcSSteven Rostedt (Red Hat) 		if (per_cpu_ops_alloc(ops))
416e248491aSJiri Olsa 			return -ENOMEM;
417ba27f2bcSSteven Rostedt (Red Hat) 	}
418ba27f2bcSSteven Rostedt (Red Hat) 
419b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
420b848914cSSteven Rostedt 
421e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
422e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
423e3eea140SSteven Rostedt (Red Hat) 
424345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
425e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
426e3eea140SSteven Rostedt (Red Hat) 
427f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
428f3bea491SSteven Rostedt (Red Hat) 
429491d0dcfSSteven Rostedt 	if (ftrace_enabled)
430491d0dcfSSteven Rostedt 		update_ftrace_function();
4313d083395SSteven Rostedt 
43216444a8aSArnaldo Carvalho de Melo 	return 0;
43316444a8aSArnaldo Carvalho de Melo }
43416444a8aSArnaldo Carvalho de Melo 
435e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
43616444a8aSArnaldo Carvalho de Melo {
4372b499381SSteven Rostedt 	int ret;
43816444a8aSArnaldo Carvalho de Melo 
439b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
440b848914cSSteven Rostedt 		return -EBUSY;
441b848914cSSteven Rostedt 
442b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
443b848914cSSteven Rostedt 
4442b499381SSteven Rostedt 	if (ret < 0)
4452b499381SSteven Rostedt 		return ret;
446b848914cSSteven Rostedt 
447491d0dcfSSteven Rostedt 	if (ftrace_enabled)
448491d0dcfSSteven Rostedt 		update_ftrace_function();
44916444a8aSArnaldo Carvalho de Melo 
450e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
451e3eea140SSteven Rostedt (Red Hat) 
452e6ea44e9SSteven Rostedt 	return 0;
4533d083395SSteven Rostedt }
4543d083395SSteven Rostedt 
455df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
456df4fc315SSteven Rostedt {
457e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
458e3eea140SSteven Rostedt (Red Hat) 
459491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
460df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
46110dd3ebeSKOSAKI Motohiro 		return;
462df4fc315SSteven Rostedt 
463e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
464e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
465345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
466345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
467e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
468e3eea140SSteven Rostedt (Red Hat) 		}
469e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
470e3eea140SSteven Rostedt (Red Hat) 
471491d0dcfSSteven Rostedt 	update_ftrace_function();
472df4fc315SSteven Rostedt }
473df4fc315SSteven Rostedt 
474493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
475493762fcSSteven Rostedt struct ftrace_profile {
476493762fcSSteven Rostedt 	struct hlist_node		node;
477493762fcSSteven Rostedt 	unsigned long			ip;
478493762fcSSteven Rostedt 	unsigned long			counter;
4790706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4800706f1c4SSteven Rostedt 	unsigned long long		time;
481e330b3bcSChase Douglas 	unsigned long long		time_squared;
4820706f1c4SSteven Rostedt #endif
483493762fcSSteven Rostedt };
484493762fcSSteven Rostedt 
485493762fcSSteven Rostedt struct ftrace_profile_page {
486493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
487493762fcSSteven Rostedt 	unsigned long			index;
488493762fcSSteven Rostedt 	struct ftrace_profile		records[];
489493762fcSSteven Rostedt };
490493762fcSSteven Rostedt 
491cafb168aSSteven Rostedt struct ftrace_profile_stat {
492cafb168aSSteven Rostedt 	atomic_t			disabled;
493cafb168aSSteven Rostedt 	struct hlist_head		*hash;
494cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
495cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
496cafb168aSSteven Rostedt 	struct tracer_stat		stat;
497cafb168aSSteven Rostedt };
498cafb168aSSteven Rostedt 
499493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
500493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
501493762fcSSteven Rostedt 
502493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
503493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
504493762fcSSteven Rostedt 
505fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
506fb9fb015SSteven Rostedt 
507fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
508493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
509493762fcSSteven Rostedt 
510cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
511493762fcSSteven Rostedt 
51220079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
51320079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
514493762fcSSteven Rostedt 
515493762fcSSteven Rostedt static void *
516493762fcSSteven Rostedt function_stat_next(void *v, int idx)
517493762fcSSteven Rostedt {
518493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
519493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
520493762fcSSteven Rostedt 
521493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
522493762fcSSteven Rostedt 
523493762fcSSteven Rostedt  again:
5240296e425SLi Zefan 	if (idx != 0)
525493762fcSSteven Rostedt 		rec++;
5260296e425SLi Zefan 
527493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
528493762fcSSteven Rostedt 		pg = pg->next;
529493762fcSSteven Rostedt 		if (!pg)
530493762fcSSteven Rostedt 			return NULL;
531493762fcSSteven Rostedt 		rec = &pg->records[0];
532493762fcSSteven Rostedt 		if (!rec->counter)
533493762fcSSteven Rostedt 			goto again;
534493762fcSSteven Rostedt 	}
535493762fcSSteven Rostedt 
536493762fcSSteven Rostedt 	return rec;
537493762fcSSteven Rostedt }
538493762fcSSteven Rostedt 
539493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
540493762fcSSteven Rostedt {
541cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
542cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
543cafb168aSSteven Rostedt 
544cafb168aSSteven Rostedt 	if (!stat || !stat->start)
545cafb168aSSteven Rostedt 		return NULL;
546cafb168aSSteven Rostedt 
547cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
548493762fcSSteven Rostedt }
549493762fcSSteven Rostedt 
5500706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5510706f1c4SSteven Rostedt /* function graph compares on total time */
5520706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
5530706f1c4SSteven Rostedt {
5540706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
5550706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
5560706f1c4SSteven Rostedt 
5570706f1c4SSteven Rostedt 	if (a->time < b->time)
5580706f1c4SSteven Rostedt 		return -1;
5590706f1c4SSteven Rostedt 	if (a->time > b->time)
5600706f1c4SSteven Rostedt 		return 1;
5610706f1c4SSteven Rostedt 	else
5620706f1c4SSteven Rostedt 		return 0;
5630706f1c4SSteven Rostedt }
5640706f1c4SSteven Rostedt #else
5650706f1c4SSteven Rostedt /* not function graph compares against hits */
566493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
567493762fcSSteven Rostedt {
568493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
569493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
570493762fcSSteven Rostedt 
571493762fcSSteven Rostedt 	if (a->counter < b->counter)
572493762fcSSteven Rostedt 		return -1;
573493762fcSSteven Rostedt 	if (a->counter > b->counter)
574493762fcSSteven Rostedt 		return 1;
575493762fcSSteven Rostedt 	else
576493762fcSSteven Rostedt 		return 0;
577493762fcSSteven Rostedt }
5780706f1c4SSteven Rostedt #endif
579493762fcSSteven Rostedt 
580493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
581493762fcSSteven Rostedt {
5820706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
583fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
584e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
58534886c8bSSteven Rostedt 		    "  --------                               "
586e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5870706f1c4SSteven Rostedt #else
588fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
589493762fcSSteven Rostedt 		    "  --------                               ---\n");
5900706f1c4SSteven Rostedt #endif
591493762fcSSteven Rostedt 	return 0;
592493762fcSSteven Rostedt }
593493762fcSSteven Rostedt 
594493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
595493762fcSSteven Rostedt {
596493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
597493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5983aaba20fSLi Zefan 	int ret = 0;
5990706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
60034886c8bSSteven Rostedt 	static struct trace_seq s;
60134886c8bSSteven Rostedt 	unsigned long long avg;
602e330b3bcSChase Douglas 	unsigned long long stddev;
6030706f1c4SSteven Rostedt #endif
6043aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
6053aaba20fSLi Zefan 
6063aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
6073aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
6083aaba20fSLi Zefan 		ret = -EBUSY;
6093aaba20fSLi Zefan 		goto out;
6103aaba20fSLi Zefan 	}
611493762fcSSteven Rostedt 
6128e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6138e436ca0SUmesh Tiwari 	avg = rec->time;
6148e436ca0SUmesh Tiwari 	do_div(avg, rec->counter);
6158e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
6168e436ca0SUmesh Tiwari 		goto out;
6178e436ca0SUmesh Tiwari #endif
6188e436ca0SUmesh Tiwari 
619493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
6200706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
621493762fcSSteven Rostedt 
6220706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
623fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
62434886c8bSSteven Rostedt 
625e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
626e330b3bcSChase Douglas 	if (rec->counter <= 1)
627e330b3bcSChase Douglas 		stddev = 0;
628e330b3bcSChase Douglas 	else {
62952d85d76SJuri Lelli 		/*
63052d85d76SJuri Lelli 		 * Apply Welford's method:
63152d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
63252d85d76SJuri Lelli 		 */
63352d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
63452d85d76SJuri Lelli 			 rec->time * rec->time;
63552d85d76SJuri Lelli 
636e330b3bcSChase Douglas 		/*
637e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
638e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
639e330b3bcSChase Douglas 		 */
64052d85d76SJuri Lelli 		do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
641e330b3bcSChase Douglas 	}
642e330b3bcSChase Douglas 
64334886c8bSSteven Rostedt 	trace_seq_init(&s);
64434886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
64534886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
64634886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
647e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
648e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
6490706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
6500706f1c4SSteven Rostedt #endif
6510706f1c4SSteven Rostedt 	seq_putc(m, '\n');
6523aaba20fSLi Zefan out:
6533aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
6540706f1c4SSteven Rostedt 
6553aaba20fSLi Zefan 	return ret;
656493762fcSSteven Rostedt }
657493762fcSSteven Rostedt 
658cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
659493762fcSSteven Rostedt {
660493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
661493762fcSSteven Rostedt 
662cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
663493762fcSSteven Rostedt 
664493762fcSSteven Rostedt 	while (pg) {
665493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
666493762fcSSteven Rostedt 		pg->index = 0;
667493762fcSSteven Rostedt 		pg = pg->next;
668493762fcSSteven Rostedt 	}
669493762fcSSteven Rostedt 
670cafb168aSSteven Rostedt 	memset(stat->hash, 0,
671493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
672493762fcSSteven Rostedt }
673493762fcSSteven Rostedt 
674cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
675493762fcSSteven Rostedt {
676493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
677318e0a73SSteven Rostedt 	int functions;
678318e0a73SSteven Rostedt 	int pages;
679493762fcSSteven Rostedt 	int i;
680493762fcSSteven Rostedt 
681493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
682cafb168aSSteven Rostedt 	if (stat->pages)
683493762fcSSteven Rostedt 		return 0;
684493762fcSSteven Rostedt 
685cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
686cafb168aSSteven Rostedt 	if (!stat->pages)
687493762fcSSteven Rostedt 		return -ENOMEM;
688493762fcSSteven Rostedt 
689318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
690318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
691318e0a73SSteven Rostedt #else
692318e0a73SSteven Rostedt 	/*
693318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
694318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
695318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
696318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
697318e0a73SSteven Rostedt 	 * the kernel.
698318e0a73SSteven Rostedt 	 */
699318e0a73SSteven Rostedt 	functions = 20000;
700318e0a73SSteven Rostedt #endif
701318e0a73SSteven Rostedt 
702cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
703493762fcSSteven Rostedt 
704318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
705318e0a73SSteven Rostedt 
70639e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
707493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
708493762fcSSteven Rostedt 		if (!pg->next)
709318e0a73SSteven Rostedt 			goto out_free;
710493762fcSSteven Rostedt 		pg = pg->next;
711493762fcSSteven Rostedt 	}
712493762fcSSteven Rostedt 
713493762fcSSteven Rostedt 	return 0;
714318e0a73SSteven Rostedt 
715318e0a73SSteven Rostedt  out_free:
716318e0a73SSteven Rostedt 	pg = stat->start;
717318e0a73SSteven Rostedt 	while (pg) {
718318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
719318e0a73SSteven Rostedt 
720318e0a73SSteven Rostedt 		pg = pg->next;
721318e0a73SSteven Rostedt 		free_page(tmp);
722318e0a73SSteven Rostedt 	}
723318e0a73SSteven Rostedt 
724318e0a73SSteven Rostedt 	stat->pages = NULL;
725318e0a73SSteven Rostedt 	stat->start = NULL;
726318e0a73SSteven Rostedt 
727318e0a73SSteven Rostedt 	return -ENOMEM;
728493762fcSSteven Rostedt }
729493762fcSSteven Rostedt 
730cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
731493762fcSSteven Rostedt {
732cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
733493762fcSSteven Rostedt 	int size;
734493762fcSSteven Rostedt 
735cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
736cafb168aSSteven Rostedt 
737cafb168aSSteven Rostedt 	if (stat->hash) {
738493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
739cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
740493762fcSSteven Rostedt 		return 0;
741493762fcSSteven Rostedt 	}
742493762fcSSteven Rostedt 
743493762fcSSteven Rostedt 	/*
744493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
745493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
746493762fcSSteven Rostedt 	 */
747493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
748493762fcSSteven Rostedt 
749cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
750493762fcSSteven Rostedt 
751cafb168aSSteven Rostedt 	if (!stat->hash)
752493762fcSSteven Rostedt 		return -ENOMEM;
753493762fcSSteven Rostedt 
754318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
755cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
756cafb168aSSteven Rostedt 		kfree(stat->hash);
757cafb168aSSteven Rostedt 		stat->hash = NULL;
758493762fcSSteven Rostedt 		return -ENOMEM;
759493762fcSSteven Rostedt 	}
760493762fcSSteven Rostedt 
761493762fcSSteven Rostedt 	return 0;
762493762fcSSteven Rostedt }
763493762fcSSteven Rostedt 
764cafb168aSSteven Rostedt static int ftrace_profile_init(void)
765cafb168aSSteven Rostedt {
766cafb168aSSteven Rostedt 	int cpu;
767cafb168aSSteven Rostedt 	int ret = 0;
768cafb168aSSteven Rostedt 
769c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
770cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
771cafb168aSSteven Rostedt 		if (ret)
772cafb168aSSteven Rostedt 			break;
773cafb168aSSteven Rostedt 	}
774cafb168aSSteven Rostedt 
775cafb168aSSteven Rostedt 	return ret;
776cafb168aSSteven Rostedt }
777cafb168aSSteven Rostedt 
778493762fcSSteven Rostedt /* interrupts must be disabled */
779cafb168aSSteven Rostedt static struct ftrace_profile *
780cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
781493762fcSSteven Rostedt {
782493762fcSSteven Rostedt 	struct ftrace_profile *rec;
783493762fcSSteven Rostedt 	struct hlist_head *hhd;
784493762fcSSteven Rostedt 	unsigned long key;
785493762fcSSteven Rostedt 
78620079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
787cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
788493762fcSSteven Rostedt 
789493762fcSSteven Rostedt 	if (hlist_empty(hhd))
790493762fcSSteven Rostedt 		return NULL;
791493762fcSSteven Rostedt 
7921bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
793493762fcSSteven Rostedt 		if (rec->ip == ip)
794493762fcSSteven Rostedt 			return rec;
795493762fcSSteven Rostedt 	}
796493762fcSSteven Rostedt 
797493762fcSSteven Rostedt 	return NULL;
798493762fcSSteven Rostedt }
799493762fcSSteven Rostedt 
800cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
801cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
802493762fcSSteven Rostedt {
803493762fcSSteven Rostedt 	unsigned long key;
804493762fcSSteven Rostedt 
80520079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
806cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
807493762fcSSteven Rostedt }
808493762fcSSteven Rostedt 
809318e0a73SSteven Rostedt /*
810318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
811318e0a73SSteven Rostedt  */
812493762fcSSteven Rostedt static struct ftrace_profile *
813318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
814493762fcSSteven Rostedt {
815493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
816493762fcSSteven Rostedt 
817318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
818cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
819493762fcSSteven Rostedt 		goto out;
820493762fcSSteven Rostedt 
821493762fcSSteven Rostedt 	/*
822318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
823318e0a73SSteven Rostedt 	 * could have added it
824493762fcSSteven Rostedt 	 */
825cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
826493762fcSSteven Rostedt 	if (rec)
827cafb168aSSteven Rostedt 		goto out;
828493762fcSSteven Rostedt 
829cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
830cafb168aSSteven Rostedt 		if (!stat->pages->next)
831cafb168aSSteven Rostedt 			goto out;
832cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
833493762fcSSteven Rostedt 	}
834493762fcSSteven Rostedt 
835cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
836493762fcSSteven Rostedt 	rec->ip = ip;
837cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
838493762fcSSteven Rostedt 
839493762fcSSteven Rostedt  out:
840cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
841493762fcSSteven Rostedt 
842493762fcSSteven Rostedt 	return rec;
843493762fcSSteven Rostedt }
844493762fcSSteven Rostedt 
845493762fcSSteven Rostedt static void
8462f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
847a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
848493762fcSSteven Rostedt {
849cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
850493762fcSSteven Rostedt 	struct ftrace_profile *rec;
851493762fcSSteven Rostedt 	unsigned long flags;
852493762fcSSteven Rostedt 
853493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
854493762fcSSteven Rostedt 		return;
855493762fcSSteven Rostedt 
856493762fcSSteven Rostedt 	local_irq_save(flags);
857cafb168aSSteven Rostedt 
858bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8590f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
860cafb168aSSteven Rostedt 		goto out;
861cafb168aSSteven Rostedt 
862cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
863493762fcSSteven Rostedt 	if (!rec) {
864318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
865493762fcSSteven Rostedt 		if (!rec)
866493762fcSSteven Rostedt 			goto out;
867493762fcSSteven Rostedt 	}
868493762fcSSteven Rostedt 
869493762fcSSteven Rostedt 	rec->counter++;
870493762fcSSteven Rostedt  out:
871493762fcSSteven Rostedt 	local_irq_restore(flags);
872493762fcSSteven Rostedt }
873493762fcSSteven Rostedt 
8740706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8750706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8760706f1c4SSteven Rostedt {
8778861dd30SNamhyung Kim 	int index = trace->depth;
8788861dd30SNamhyung Kim 
879a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8808861dd30SNamhyung Kim 
8818861dd30SNamhyung Kim 	if (index >= 0 && index < FTRACE_RETFUNC_DEPTH)
8828861dd30SNamhyung Kim 		current->ret_stack[index].subtime = 0;
8838861dd30SNamhyung Kim 
8840706f1c4SSteven Rostedt 	return 1;
8850706f1c4SSteven Rostedt }
8860706f1c4SSteven Rostedt 
8870706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8880706f1c4SSteven Rostedt {
889cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
890a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8910706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
892cafb168aSSteven Rostedt 	unsigned long flags;
8930706f1c4SSteven Rostedt 
8940706f1c4SSteven Rostedt 	local_irq_save(flags);
895bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8960f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
897cafb168aSSteven Rostedt 		goto out;
898cafb168aSSteven Rostedt 
89937e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
90037e44bc5SSteven Rostedt 	if (!trace->calltime)
90137e44bc5SSteven Rostedt 		goto out;
90237e44bc5SSteven Rostedt 
903a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
904a2a16d6aSSteven Rostedt 
90555577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
906a2a16d6aSSteven Rostedt 		int index;
907a2a16d6aSSteven Rostedt 
908a2a16d6aSSteven Rostedt 		index = trace->depth;
909a2a16d6aSSteven Rostedt 
910a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
911a2a16d6aSSteven Rostedt 		if (index)
912a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
913a2a16d6aSSteven Rostedt 
914a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
915a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
916a2a16d6aSSteven Rostedt 		else
917a2a16d6aSSteven Rostedt 			calltime = 0;
918a2a16d6aSSteven Rostedt 	}
919a2a16d6aSSteven Rostedt 
920cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
921e330b3bcSChase Douglas 	if (rec) {
922a2a16d6aSSteven Rostedt 		rec->time += calltime;
923e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
924e330b3bcSChase Douglas 	}
925a2a16d6aSSteven Rostedt 
926cafb168aSSteven Rostedt  out:
9270706f1c4SSteven Rostedt 	local_irq_restore(flags);
9280706f1c4SSteven Rostedt }
9290706f1c4SSteven Rostedt 
9300706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9310706f1c4SSteven Rostedt {
9320706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
9330706f1c4SSteven Rostedt 				     &profile_graph_entry);
9340706f1c4SSteven Rostedt }
9350706f1c4SSteven Rostedt 
9360706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9370706f1c4SSteven Rostedt {
9380706f1c4SSteven Rostedt 	unregister_ftrace_graph();
9390706f1c4SSteven Rostedt }
9400706f1c4SSteven Rostedt #else
941bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
942493762fcSSteven Rostedt 	.func		= function_profile_call,
943f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
94433b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
945493762fcSSteven Rostedt };
946493762fcSSteven Rostedt 
9470706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9480706f1c4SSteven Rostedt {
9490706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9500706f1c4SSteven Rostedt }
9510706f1c4SSteven Rostedt 
9520706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9530706f1c4SSteven Rostedt {
9540706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9550706f1c4SSteven Rostedt }
9560706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9570706f1c4SSteven Rostedt 
958493762fcSSteven Rostedt static ssize_t
959493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
960493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
961493762fcSSteven Rostedt {
962493762fcSSteven Rostedt 	unsigned long val;
963493762fcSSteven Rostedt 	int ret;
964493762fcSSteven Rostedt 
96522fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
96622fe9b54SPeter Huewe 	if (ret)
967493762fcSSteven Rostedt 		return ret;
968493762fcSSteven Rostedt 
969493762fcSSteven Rostedt 	val = !!val;
970493762fcSSteven Rostedt 
971493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
972493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
973493762fcSSteven Rostedt 		if (val) {
974493762fcSSteven Rostedt 			ret = ftrace_profile_init();
975493762fcSSteven Rostedt 			if (ret < 0) {
976493762fcSSteven Rostedt 				cnt = ret;
977493762fcSSteven Rostedt 				goto out;
978493762fcSSteven Rostedt 			}
979493762fcSSteven Rostedt 
9800706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9810706f1c4SSteven Rostedt 			if (ret < 0) {
9820706f1c4SSteven Rostedt 				cnt = ret;
9830706f1c4SSteven Rostedt 				goto out;
9840706f1c4SSteven Rostedt 			}
985493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
986493762fcSSteven Rostedt 		} else {
987493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9880f6ce3deSSteven Rostedt 			/*
9890f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9900f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9910f6ce3deSSteven Rostedt 			 */
9920706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
993493762fcSSteven Rostedt 		}
994493762fcSSteven Rostedt 	}
995493762fcSSteven Rostedt  out:
996493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
997493762fcSSteven Rostedt 
998cf8517cfSJiri Olsa 	*ppos += cnt;
999493762fcSSteven Rostedt 
1000493762fcSSteven Rostedt 	return cnt;
1001493762fcSSteven Rostedt }
1002493762fcSSteven Rostedt 
1003493762fcSSteven Rostedt static ssize_t
1004493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
1005493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
1006493762fcSSteven Rostedt {
1007fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
1008493762fcSSteven Rostedt 	int r;
1009493762fcSSteven Rostedt 
1010493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
1011493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
1012493762fcSSteven Rostedt }
1013493762fcSSteven Rostedt 
1014493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
1015493762fcSSteven Rostedt 	.open		= tracing_open_generic,
1016493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
1017493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
10186038f373SArnd Bergmann 	.llseek		= default_llseek,
1019493762fcSSteven Rostedt };
1020493762fcSSteven Rostedt 
1021cafb168aSSteven Rostedt /* used to initialize the real stat files */
1022cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
1023cafb168aSSteven Rostedt 	.name		= "functions",
1024cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
1025cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
1026cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
1027cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
1028cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
1029cafb168aSSteven Rostedt };
1030cafb168aSSteven Rostedt 
10318434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1032493762fcSSteven Rostedt {
1033cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
1034493762fcSSteven Rostedt 	struct dentry *entry;
1035cafb168aSSteven Rostedt 	char *name;
1036493762fcSSteven Rostedt 	int ret;
1037cafb168aSSteven Rostedt 	int cpu;
1038493762fcSSteven Rostedt 
1039cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
1040cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
1041cafb168aSSteven Rostedt 
10426363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
1043cafb168aSSteven Rostedt 		if (!name) {
1044cafb168aSSteven Rostedt 			/*
1045cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1046cafb168aSSteven Rostedt 			 * we still do not free memory.
1047cafb168aSSteven Rostedt 			 */
1048cafb168aSSteven Rostedt 			WARN(1,
1049cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1050cafb168aSSteven Rostedt 			     cpu);
1051493762fcSSteven Rostedt 			return;
1052493762fcSSteven Rostedt 		}
1053cafb168aSSteven Rostedt 		stat->stat = function_stats;
1054cafb168aSSteven Rostedt 		stat->stat.name = name;
1055cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1056cafb168aSSteven Rostedt 		if (ret) {
1057cafb168aSSteven Rostedt 			WARN(1,
1058cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1059cafb168aSSteven Rostedt 			     cpu);
1060cafb168aSSteven Rostedt 			kfree(name);
1061cafb168aSSteven Rostedt 			return;
1062cafb168aSSteven Rostedt 		}
1063cafb168aSSteven Rostedt 	}
1064493762fcSSteven Rostedt 
10658434dc93SSteven Rostedt (Red Hat) 	entry = tracefs_create_file("function_profile_enabled", 0644,
1066493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
1067493762fcSSteven Rostedt 	if (!entry)
1068a395d6a7SJoe Perches 		pr_warn("Could not create tracefs 'function_profile_enabled' entry\n");
1069493762fcSSteven Rostedt }
1070493762fcSSteven Rostedt 
1071493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10728434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1073493762fcSSteven Rostedt {
1074493762fcSSteven Rostedt }
1075493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1076493762fcSSteven Rostedt 
107773d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
107873d3fd96SIngo Molnar 
10791619dc3fSPratyush Anand #ifdef CONFIG_FUNCTION_GRAPH_TRACER
10801619dc3fSPratyush Anand static int ftrace_graph_active;
10811619dc3fSPratyush Anand #else
10821619dc3fSPratyush Anand # define ftrace_graph_active 0
10831619dc3fSPratyush Anand #endif
10841619dc3fSPratyush Anand 
10853d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
108673d3fd96SIngo Molnar 
108779922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
108879922b80SSteven Rostedt (Red Hat) 
1089e1effa01SSteven Rostedt (Red Hat) /*
1090e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1091e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1092e1effa01SSteven Rostedt (Red Hat)  */
1093e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1094e1effa01SSteven Rostedt (Red Hat) 
109599ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1096cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
109799ecdc43SSteven Rostedt #endif
109899ecdc43SSteven Rostedt 
10998fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
11008fc0c701SSteven Rostedt 
1101b6887d79SSteven Rostedt struct ftrace_func_probe {
11028fc0c701SSteven Rostedt 	struct hlist_node	node;
1103b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
11048fc0c701SSteven Rostedt 	unsigned long		flags;
11058fc0c701SSteven Rostedt 	unsigned long		ip;
11068fc0c701SSteven Rostedt 	void			*data;
11077818b388SSteven Rostedt (Red Hat) 	struct list_head	free_list;
11088fc0c701SSteven Rostedt };
11098fc0c701SSteven Rostedt 
1110b448c4e3SSteven Rostedt struct ftrace_func_entry {
1111b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1112b448c4e3SSteven Rostedt 	unsigned long ip;
1113b448c4e3SSteven Rostedt };
1114b448c4e3SSteven Rostedt 
111533dc9b12SSteven Rostedt /*
111633dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
111733dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
111833dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
111933dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
112033dc9b12SSteven Rostedt  */
112133dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
112233dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
112333dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1124b448c4e3SSteven Rostedt };
112533dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
11265072c59fSSteven Rostedt 
11272b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1128f45948e8SSteven Rostedt 	.func				= ftrace_stub,
112933b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
113033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
113133b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
113233b7f99cSSteven Rostedt (Red Hat) 	.flags				= FTRACE_OPS_FL_RECURSION_SAFE |
1133e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_INITIALIZED |
1134e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1135f45948e8SSteven Rostedt };
1136f45948e8SSteven Rostedt 
1137aec0be2dSSteven Rostedt (Red Hat) /*
1138aec0be2dSSteven Rostedt (Red Hat)  * This is used by __kernel_text_address() to return true if the
11390af26492SSteven Rostedt (Red Hat)  * address is on a dynamically allocated trampoline that would
1140aec0be2dSSteven Rostedt (Red Hat)  * not return true for either core_kernel_text() or
1141aec0be2dSSteven Rostedt (Red Hat)  * is_module_text_address().
1142aec0be2dSSteven Rostedt (Red Hat)  */
1143aec0be2dSSteven Rostedt (Red Hat) bool is_ftrace_trampoline(unsigned long addr)
1144aec0be2dSSteven Rostedt (Red Hat) {
1145aec0be2dSSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
1146aec0be2dSSteven Rostedt (Red Hat) 	bool ret = false;
1147aec0be2dSSteven Rostedt (Red Hat) 
1148aec0be2dSSteven Rostedt (Red Hat) 	/*
1149aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
1150aec0be2dSSteven Rostedt (Red Hat) 	 * they are freed after a synchronize_sched().
1151aec0be2dSSteven Rostedt (Red Hat) 	 */
1152aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1153aec0be2dSSteven Rostedt (Red Hat) 
1154aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1155aec0be2dSSteven Rostedt (Red Hat) 		/*
1156aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1157aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1158aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1159aec0be2dSSteven Rostedt (Red Hat) 		 */
1160aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1161aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1162aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
1163aec0be2dSSteven Rostedt (Red Hat) 				ret = true;
1164aec0be2dSSteven Rostedt (Red Hat) 				goto out;
1165aec0be2dSSteven Rostedt (Red Hat) 			}
1166aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1167aec0be2dSSteven Rostedt (Red Hat) 
1168aec0be2dSSteven Rostedt (Red Hat)  out:
1169aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1170aec0be2dSSteven Rostedt (Red Hat) 
1171aec0be2dSSteven Rostedt (Red Hat) 	return ret;
1172aec0be2dSSteven Rostedt (Red Hat) }
1173aec0be2dSSteven Rostedt (Red Hat) 
11743c1720f0SSteven Rostedt struct ftrace_page {
11753c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1176a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1177431aa3fbSSteven Rostedt 	int			index;
1178a7900875SSteven Rostedt 	int			size;
1179aa5e5ceaSDavid Miller };
11803c1720f0SSteven Rostedt 
1181a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1182a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11833c1720f0SSteven Rostedt 
11843c1720f0SSteven Rostedt /* estimate from running different kernels */
11853c1720f0SSteven Rostedt #define NR_TO_INIT		10000
11863c1720f0SSteven Rostedt 
11873c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11883c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11893c1720f0SSteven Rostedt 
11902b0cce0eSSteven Rostedt (VMware) static __always_inline unsigned long
11912b0cce0eSSteven Rostedt (VMware) ftrace_hash_key(struct ftrace_hash *hash, unsigned long ip)
11922b0cce0eSSteven Rostedt (VMware) {
11932b0cce0eSSteven Rostedt (VMware) 	if (hash->size_bits > 0)
11942b0cce0eSSteven Rostedt (VMware) 		return hash_long(ip, hash->size_bits);
11952b0cce0eSSteven Rostedt (VMware) 
11962b0cce0eSSteven Rostedt (VMware) 	return 0;
11972b0cce0eSSteven Rostedt (VMware) }
11982b0cce0eSSteven Rostedt (VMware) 
11992b2c279cSSteven Rostedt (VMware) /* Only use this function if ftrace_hash_empty() has already been tested */
12002b2c279cSSteven Rostedt (VMware) static __always_inline struct ftrace_func_entry *
12012b2c279cSSteven Rostedt (VMware) __ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1202b448c4e3SSteven Rostedt {
1203b448c4e3SSteven Rostedt 	unsigned long key;
1204b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1205b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1206b448c4e3SSteven Rostedt 
12072b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, ip);
1208b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1209b448c4e3SSteven Rostedt 
12101bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1211b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1212b448c4e3SSteven Rostedt 			return entry;
1213b448c4e3SSteven Rostedt 	}
1214b448c4e3SSteven Rostedt 	return NULL;
1215b448c4e3SSteven Rostedt }
1216b448c4e3SSteven Rostedt 
12172b2c279cSSteven Rostedt (VMware) /**
12182b2c279cSSteven Rostedt (VMware)  * ftrace_lookup_ip - Test to see if an ip exists in an ftrace_hash
12192b2c279cSSteven Rostedt (VMware)  * @hash: The hash to look at
12202b2c279cSSteven Rostedt (VMware)  * @ip: The instruction pointer to test
12212b2c279cSSteven Rostedt (VMware)  *
12222b2c279cSSteven Rostedt (VMware)  * Search a given @hash to see if a given instruction pointer (@ip)
12232b2c279cSSteven Rostedt (VMware)  * exists in it.
12242b2c279cSSteven Rostedt (VMware)  *
12252b2c279cSSteven Rostedt (VMware)  * Returns the entry that holds the @ip if found. NULL otherwise.
12262b2c279cSSteven Rostedt (VMware)  */
12272b2c279cSSteven Rostedt (VMware) struct ftrace_func_entry *
12282b2c279cSSteven Rostedt (VMware) ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
12292b2c279cSSteven Rostedt (VMware) {
12302b2c279cSSteven Rostedt (VMware) 	if (ftrace_hash_empty(hash))
12312b2c279cSSteven Rostedt (VMware) 		return NULL;
12322b2c279cSSteven Rostedt (VMware) 
12332b2c279cSSteven Rostedt (VMware) 	return __ftrace_lookup_ip(hash, ip);
12342b2c279cSSteven Rostedt (VMware) }
12352b2c279cSSteven Rostedt (VMware) 
123633dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
123733dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
123833dc9b12SSteven Rostedt {
123933dc9b12SSteven Rostedt 	struct hlist_head *hhd;
124033dc9b12SSteven Rostedt 	unsigned long key;
124133dc9b12SSteven Rostedt 
12422b0cce0eSSteven Rostedt (VMware) 	key = ftrace_hash_key(hash, entry->ip);
124333dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
124433dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
124533dc9b12SSteven Rostedt 	hash->count++;
124633dc9b12SSteven Rostedt }
124733dc9b12SSteven Rostedt 
1248b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1249b448c4e3SSteven Rostedt {
1250b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1251b448c4e3SSteven Rostedt 
1252b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1253b448c4e3SSteven Rostedt 	if (!entry)
1254b448c4e3SSteven Rostedt 		return -ENOMEM;
1255b448c4e3SSteven Rostedt 
1256b448c4e3SSteven Rostedt 	entry->ip = ip;
125733dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1258b448c4e3SSteven Rostedt 
1259b448c4e3SSteven Rostedt 	return 0;
1260b448c4e3SSteven Rostedt }
1261b448c4e3SSteven Rostedt 
1262b448c4e3SSteven Rostedt static void
126333dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
126433dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
126533dc9b12SSteven Rostedt {
126633dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
126733dc9b12SSteven Rostedt 	kfree(entry);
126833dc9b12SSteven Rostedt 	hash->count--;
126933dc9b12SSteven Rostedt }
127033dc9b12SSteven Rostedt 
127133dc9b12SSteven Rostedt static void
1272b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1273b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1274b448c4e3SSteven Rostedt {
1275b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1276b448c4e3SSteven Rostedt 	hash->count--;
1277b448c4e3SSteven Rostedt }
1278b448c4e3SSteven Rostedt 
1279b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1280b448c4e3SSteven Rostedt {
1281b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1282b67bfe0dSSasha Levin 	struct hlist_node *tn;
1283b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1284b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1285b448c4e3SSteven Rostedt 	int i;
1286b448c4e3SSteven Rostedt 
128733dc9b12SSteven Rostedt 	if (!hash->count)
128833dc9b12SSteven Rostedt 		return;
128933dc9b12SSteven Rostedt 
1290b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1291b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1292b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
129333dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1294b448c4e3SSteven Rostedt 	}
1295b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1296b448c4e3SSteven Rostedt }
1297b448c4e3SSteven Rostedt 
129833dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
129933dc9b12SSteven Rostedt {
130033dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
130133dc9b12SSteven Rostedt 		return;
130233dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
130333dc9b12SSteven Rostedt 	kfree(hash->buckets);
130433dc9b12SSteven Rostedt 	kfree(hash);
130533dc9b12SSteven Rostedt }
130633dc9b12SSteven Rostedt 
130707fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
130807fd5515SSteven Rostedt {
130907fd5515SSteven Rostedt 	struct ftrace_hash *hash;
131007fd5515SSteven Rostedt 
131107fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
131207fd5515SSteven Rostedt 	free_ftrace_hash(hash);
131307fd5515SSteven Rostedt }
131407fd5515SSteven Rostedt 
131507fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
131607fd5515SSteven Rostedt {
131707fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
131807fd5515SSteven Rostedt 		return;
131907fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
132007fd5515SSteven Rostedt }
132107fd5515SSteven Rostedt 
13225500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
13235500fa51SJiri Olsa {
1324f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
132533b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
132633b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
13275500fa51SJiri Olsa }
13285500fa51SJiri Olsa 
132933dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
133033dc9b12SSteven Rostedt {
133133dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
133233dc9b12SSteven Rostedt 	int size;
133333dc9b12SSteven Rostedt 
133433dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
133533dc9b12SSteven Rostedt 	if (!hash)
133633dc9b12SSteven Rostedt 		return NULL;
133733dc9b12SSteven Rostedt 
133833dc9b12SSteven Rostedt 	size = 1 << size_bits;
133947b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
134033dc9b12SSteven Rostedt 
134133dc9b12SSteven Rostedt 	if (!hash->buckets) {
134233dc9b12SSteven Rostedt 		kfree(hash);
134333dc9b12SSteven Rostedt 		return NULL;
134433dc9b12SSteven Rostedt 	}
134533dc9b12SSteven Rostedt 
134633dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
134733dc9b12SSteven Rostedt 
134833dc9b12SSteven Rostedt 	return hash;
134933dc9b12SSteven Rostedt }
135033dc9b12SSteven Rostedt 
135133dc9b12SSteven Rostedt static struct ftrace_hash *
135233dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
135333dc9b12SSteven Rostedt {
135433dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
135533dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
135633dc9b12SSteven Rostedt 	int size;
135733dc9b12SSteven Rostedt 	int ret;
135833dc9b12SSteven Rostedt 	int i;
135933dc9b12SSteven Rostedt 
136033dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
136133dc9b12SSteven Rostedt 	if (!new_hash)
136233dc9b12SSteven Rostedt 		return NULL;
136333dc9b12SSteven Rostedt 
136433dc9b12SSteven Rostedt 	/* Empty hash? */
136506a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
136633dc9b12SSteven Rostedt 		return new_hash;
136733dc9b12SSteven Rostedt 
136833dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
136933dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1370b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
137133dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
137233dc9b12SSteven Rostedt 			if (ret < 0)
137333dc9b12SSteven Rostedt 				goto free_hash;
137433dc9b12SSteven Rostedt 		}
137533dc9b12SSteven Rostedt 	}
137633dc9b12SSteven Rostedt 
137733dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
137833dc9b12SSteven Rostedt 
137933dc9b12SSteven Rostedt 	return new_hash;
138033dc9b12SSteven Rostedt 
138133dc9b12SSteven Rostedt  free_hash:
138233dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
138333dc9b12SSteven Rostedt 	return NULL;
138433dc9b12SSteven Rostedt }
138533dc9b12SSteven Rostedt 
138641fb61c2SSteven Rostedt static void
138784261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
138841fb61c2SSteven Rostedt static void
138984261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
139041fb61c2SSteven Rostedt 
1391f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1392f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1393f8b8be8aSMasami Hiramatsu 
13943e278c0dSNamhyung Kim static struct ftrace_hash *
13953e278c0dSNamhyung Kim __ftrace_hash_move(struct ftrace_hash *src)
139633dc9b12SSteven Rostedt {
139733dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
1398b67bfe0dSSasha Levin 	struct hlist_node *tn;
139933dc9b12SSteven Rostedt 	struct hlist_head *hhd;
140007fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
140133dc9b12SSteven Rostedt 	int size = src->count;
140233dc9b12SSteven Rostedt 	int bits = 0;
140333dc9b12SSteven Rostedt 	int i;
140433dc9b12SSteven Rostedt 
140533dc9b12SSteven Rostedt 	/*
14063e278c0dSNamhyung Kim 	 * If the new source is empty, just return the empty_hash.
140733dc9b12SSteven Rostedt 	 */
14083e278c0dSNamhyung Kim 	if (!src->count)
14093e278c0dSNamhyung Kim 		return EMPTY_HASH;
141033dc9b12SSteven Rostedt 
141133dc9b12SSteven Rostedt 	/*
141233dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
141333dc9b12SSteven Rostedt 	 */
141433dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
141533dc9b12SSteven Rostedt 		bits++;
141633dc9b12SSteven Rostedt 
141733dc9b12SSteven Rostedt 	/* Don't allocate too much */
141833dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
141933dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
142033dc9b12SSteven Rostedt 
142107fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
142207fd5515SSteven Rostedt 	if (!new_hash)
14233e278c0dSNamhyung Kim 		return NULL;
142433dc9b12SSteven Rostedt 
142533dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
142633dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
142733dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1428b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
142933dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
143007fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
143133dc9b12SSteven Rostedt 		}
143233dc9b12SSteven Rostedt 	}
143333dc9b12SSteven Rostedt 
14343e278c0dSNamhyung Kim 	return new_hash;
14353e278c0dSNamhyung Kim }
14363e278c0dSNamhyung Kim 
14373e278c0dSNamhyung Kim static int
14383e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
14393e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
14403e278c0dSNamhyung Kim {
14413e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
14423e278c0dSNamhyung Kim 	int ret;
14433e278c0dSNamhyung Kim 
14443e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
14453e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
14463e278c0dSNamhyung Kim 		return -EINVAL;
14473e278c0dSNamhyung Kim 
14483e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
14493e278c0dSNamhyung Kim 	if (!new_hash)
14503e278c0dSNamhyung Kim 		return -ENOMEM;
14513e278c0dSNamhyung Kim 
1452f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1453f8b8be8aSMasami Hiramatsu 	if (enable) {
1454f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1455f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1456f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1457f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1458f8b8be8aSMasami Hiramatsu 			return ret;
1459f8b8be8aSMasami Hiramatsu 		}
1460f8b8be8aSMasami Hiramatsu 	}
1461f8b8be8aSMasami Hiramatsu 
14625c27c775SMasami Hiramatsu 	/*
14635c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14645c27c775SMasami Hiramatsu 	 * them back.
14655c27c775SMasami Hiramatsu 	 */
146684261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14675c27c775SMasami Hiramatsu 
146807fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
146907fd5515SSteven Rostedt 
147084261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
147141fb61c2SSteven Rostedt 
14725c27c775SMasami Hiramatsu 	return 0;
147333dc9b12SSteven Rostedt }
147433dc9b12SSteven Rostedt 
1475fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1476fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1477fef5aeeeSSteven Rostedt (Red Hat) {
1478fef5aeeeSSteven Rostedt (Red Hat) 	/*
1479fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1480fef5aeeeSSteven Rostedt (Red Hat) 	 * hash and not in the notrace hash. Note, an emty hash is
1481fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1482fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1483fef5aeeeSSteven Rostedt (Red Hat) 	 */
1484fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
14852b2c279cSSteven Rostedt (VMware) 		__ftrace_lookup_ip(hash->filter_hash, ip)) &&
1486fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
14872b2c279cSSteven Rostedt (VMware) 		 !__ftrace_lookup_ip(hash->notrace_hash, ip));
1488fef5aeeeSSteven Rostedt (Red Hat) }
1489fef5aeeeSSteven Rostedt (Red Hat) 
1490265c831cSSteven Rostedt /*
1491b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1492b848914cSSteven Rostedt  * the ops->func or not.
1493b848914cSSteven Rostedt  *
1494b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1495b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1496b848914cSSteven Rostedt  *  AND
1497b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1498cdbe61bfSSteven Rostedt  *
1499cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1500cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1501b848914cSSteven Rostedt  */
1502b848914cSSteven Rostedt static int
1503195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1504b848914cSSteven Rostedt {
1505fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1506b848914cSSteven Rostedt 	int ret;
1507b848914cSSteven Rostedt 
1508195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1509195a8afcSSteven Rostedt (Red Hat) 	/*
1510195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1511195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1512195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1513195a8afcSSteven Rostedt (Red Hat) 	 */
1514195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1515195a8afcSSteven Rostedt (Red Hat) 		return 0;
1516195a8afcSSteven Rostedt (Red Hat) #endif
1517195a8afcSSteven Rostedt (Red Hat) 
1518fef5aeeeSSteven Rostedt (Red Hat) 	hash.filter_hash = rcu_dereference_raw_notrace(ops->func_hash->filter_hash);
1519fef5aeeeSSteven Rostedt (Red Hat) 	hash.notrace_hash = rcu_dereference_raw_notrace(ops->func_hash->notrace_hash);
1520b848914cSSteven Rostedt 
1521fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1522b848914cSSteven Rostedt 		ret = 1;
1523b848914cSSteven Rostedt 	else
1524b848914cSSteven Rostedt 		ret = 0;
1525b848914cSSteven Rostedt 
1526b848914cSSteven Rostedt 	return ret;
1527b848914cSSteven Rostedt }
1528b848914cSSteven Rostedt 
1529b848914cSSteven Rostedt /*
1530265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1531265c831cSSteven Rostedt  * you must use a goto.
1532265c831cSSteven Rostedt  */
1533265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1534265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1535265c831cSSteven Rostedt 		int _____i;						\
1536265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1537265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1538265c831cSSteven Rostedt 
1539265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1540265c831cSSteven Rostedt 		}				\
1541265c831cSSteven Rostedt 	}
1542ecea656dSAbhishek Sagar 
15435855feadSSteven Rostedt 
15445855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15455855feadSSteven Rostedt {
1546a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1547a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15485855feadSSteven Rostedt 
1549a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15505855feadSSteven Rostedt 		return -1;
1551a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1552a650e02aSSteven Rostedt 		return 1;
1553a650e02aSSteven Rostedt 	return 0;
1554a650e02aSSteven Rostedt }
1555a650e02aSSteven Rostedt 
155604cf31a7SMichael Ellerman /**
155704cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
155804cf31a7SMichael Ellerman  *	if it touches the given ip range
155904cf31a7SMichael Ellerman  * @start: start of range to search.
156004cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
156104cf31a7SMichael Ellerman  *	to check.
156204cf31a7SMichael Ellerman  *
156304cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
156404cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
156504cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
156604cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
156704cf31a7SMichael Ellerman  */
156804cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1569a650e02aSSteven Rostedt {
1570a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1571a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1572a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1573a650e02aSSteven Rostedt 
1574a650e02aSSteven Rostedt 	key.ip = start;
1575a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1576a650e02aSSteven Rostedt 
1577a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1578a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1579a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1580a650e02aSSteven Rostedt 			continue;
1581a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1582a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1583a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1584a650e02aSSteven Rostedt 		if (rec)
1585f0cf973aSSteven Rostedt 			return rec->ip;
1586a650e02aSSteven Rostedt 	}
1587a650e02aSSteven Rostedt 
15885855feadSSteven Rostedt 	return 0;
15895855feadSSteven Rostedt }
15905855feadSSteven Rostedt 
1591c88fd863SSteven Rostedt /**
1592c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1593c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1594c88fd863SSteven Rostedt  *
1595f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1596c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1597c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1598c88fd863SSteven Rostedt  * determine if the address belongs or not.
1599c88fd863SSteven Rostedt  */
1600f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1601c88fd863SSteven Rostedt {
1602a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
16035855feadSSteven Rostedt }
1604c88fd863SSteven Rostedt 
1605a650e02aSSteven Rostedt /**
1606a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1607a650e02aSSteven Rostedt  * @start: start of range to search
1608a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1609a650e02aSSteven Rostedt  *
1610a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1611a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1612a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1613a650e02aSSteven Rostedt  * determine if the address belongs or not.
1614a650e02aSSteven Rostedt  */
1615d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1616a650e02aSSteven Rostedt {
1617f0cf973aSSteven Rostedt 	unsigned long ret;
1618f0cf973aSSteven Rostedt 
1619f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1620a650e02aSSteven Rostedt 				    (unsigned long)end);
1621f0cf973aSSteven Rostedt 
1622f0cf973aSSteven Rostedt 	return (int)!!ret;
1623c88fd863SSteven Rostedt }
1624c88fd863SSteven Rostedt 
16254fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16264fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16274fbb48cbSSteven Rostedt (Red Hat) {
16284fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16294fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16304fbb48cbSSteven Rostedt (Red Hat) 
16314fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16324fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16334fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16344fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16354fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16364fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16374fbb48cbSSteven Rostedt (Red Hat) 				break;
16384fbb48cbSSteven Rostedt (Red Hat) 			}
16394fbb48cbSSteven Rostedt (Red Hat) 		}
16404fbb48cbSSteven Rostedt (Red Hat) 	}
16414fbb48cbSSteven Rostedt (Red Hat) 
16424fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16434fbb48cbSSteven Rostedt (Red Hat) }
16444fbb48cbSSteven Rostedt (Red Hat) 
164584b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1646ed926f9bSSteven Rostedt 				     int filter_hash,
1647ed926f9bSSteven Rostedt 				     bool inc)
1648ed926f9bSSteven Rostedt {
1649ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1650ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1651ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1652ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
165384b6d3e6SJiri Olsa 	bool update = false;
1654ed926f9bSSteven Rostedt 	int count = 0;
1655ed926f9bSSteven Rostedt 	int all = 0;
1656ed926f9bSSteven Rostedt 
1657ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1658ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
165984b6d3e6SJiri Olsa 		return false;
1660ed926f9bSSteven Rostedt 
1661ed926f9bSSteven Rostedt 	/*
1662ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1663ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1664ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1665ed926f9bSSteven Rostedt 	 *
1666ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1667ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1668ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1669ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1670ed926f9bSSteven Rostedt 	 *   gets inversed.
1671ed926f9bSSteven Rostedt 	 */
1672ed926f9bSSteven Rostedt 	if (filter_hash) {
167333b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
167433b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
167506a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1676ed926f9bSSteven Rostedt 			all = 1;
1677ed926f9bSSteven Rostedt 	} else {
1678ed926f9bSSteven Rostedt 		inc = !inc;
167933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
168033b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1681ed926f9bSSteven Rostedt 		/*
1682ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1683ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1684ed926f9bSSteven Rostedt 		 */
168506a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
168684b6d3e6SJiri Olsa 			return false;
1687ed926f9bSSteven Rostedt 	}
1688ed926f9bSSteven Rostedt 
1689ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1690ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1691ed926f9bSSteven Rostedt 		int in_hash = 0;
1692ed926f9bSSteven Rostedt 		int match = 0;
1693ed926f9bSSteven Rostedt 
1694b7ffffbbSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1695b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1696b7ffffbbSSteven Rostedt (Red Hat) 
1697ed926f9bSSteven Rostedt 		if (all) {
1698ed926f9bSSteven Rostedt 			/*
1699ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1700ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1701ed926f9bSSteven Rostedt 			 */
1702b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1703ed926f9bSSteven Rostedt 				match = 1;
1704ed926f9bSSteven Rostedt 		} else {
170506a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
170606a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1707ed926f9bSSteven Rostedt 
1708ed926f9bSSteven Rostedt 			/*
170919eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
171019eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1711ed926f9bSSteven Rostedt 			 *
171219eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
171319eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
171419eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
171519eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
171619eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1717ed926f9bSSteven Rostedt 			 */
1718ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1719ed926f9bSSteven Rostedt 				match = 1;
1720ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
172106a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1722ed926f9bSSteven Rostedt 				match = 1;
1723ed926f9bSSteven Rostedt 		}
1724ed926f9bSSteven Rostedt 		if (!match)
1725ed926f9bSSteven Rostedt 			continue;
1726ed926f9bSSteven Rostedt 
1727ed926f9bSSteven Rostedt 		if (inc) {
1728ed926f9bSSteven Rostedt 			rec->flags++;
17290376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
173084b6d3e6SJiri Olsa 				return false;
173179922b80SSteven Rostedt (Red Hat) 
173279922b80SSteven Rostedt (Red Hat) 			/*
173379922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
173479922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
173579922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
173679922b80SSteven Rostedt (Red Hat) 			 */
1737fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
173879922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1739fef5aeeeSSteven Rostedt (Red Hat) 			else
174079922b80SSteven Rostedt (Red Hat) 				/*
174179922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
174279922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1743bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1744bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
174579922b80SSteven Rostedt (Red Hat) 				 */
1746fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
174779922b80SSteven Rostedt (Red Hat) 
174808f6fba5SSteven Rostedt 			/*
174908f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
175008f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
175108f6fba5SSteven Rostedt 			 */
175208f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
175308f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1754ed926f9bSSteven Rostedt 		} else {
17550376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
175684b6d3e6SJiri Olsa 				return false;
1757ed926f9bSSteven Rostedt 			rec->flags--;
175879922b80SSteven Rostedt (Red Hat) 
17594fbb48cbSSteven Rostedt (Red Hat) 			/*
17604fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
17614fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
17624fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
17634fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
17644fbb48cbSSteven Rostedt (Red Hat) 			 */
17650376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
17664fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
17674fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
17684fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
17694fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
17704fbb48cbSSteven Rostedt (Red Hat) 			}
177179922b80SSteven Rostedt (Red Hat) 
177279922b80SSteven Rostedt (Red Hat) 			/*
1773fef5aeeeSSteven Rostedt (Red Hat) 			 * If the rec had TRAMP enabled, then it needs to
1774fef5aeeeSSteven Rostedt (Red Hat) 			 * be cleared. As TRAMP can only be enabled iff
1775fef5aeeeSSteven Rostedt (Red Hat) 			 * there is only a single ops attached to it.
1776fef5aeeeSSteven Rostedt (Red Hat) 			 * In otherwords, always disable it on decrementing.
1777fef5aeeeSSteven Rostedt (Red Hat) 			 * In the future, we may set it if rec count is
1778fef5aeeeSSteven Rostedt (Red Hat) 			 * decremented to one, and the ops that is left
1779fef5aeeeSSteven Rostedt (Red Hat) 			 * has a trampoline.
1780fef5aeeeSSteven Rostedt (Red Hat) 			 */
1781fef5aeeeSSteven Rostedt (Red Hat) 			rec->flags &= ~FTRACE_FL_TRAMP;
1782fef5aeeeSSteven Rostedt (Red Hat) 
1783fef5aeeeSSteven Rostedt (Red Hat) 			/*
178479922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
178579922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
178679922b80SSteven Rostedt (Red Hat) 			 */
1787ed926f9bSSteven Rostedt 		}
1788ed926f9bSSteven Rostedt 		count++;
178984b6d3e6SJiri Olsa 
179084b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
179184b6d3e6SJiri Olsa 		update |= ftrace_test_record(rec, 1) != FTRACE_UPDATE_IGNORE;
179284b6d3e6SJiri Olsa 
1793ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1794ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
179584b6d3e6SJiri Olsa 			return update;
1796ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
179784b6d3e6SJiri Olsa 
179884b6d3e6SJiri Olsa 	return update;
1799ed926f9bSSteven Rostedt }
1800ed926f9bSSteven Rostedt 
180184b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1802ed926f9bSSteven Rostedt 				    int filter_hash)
1803ed926f9bSSteven Rostedt {
180484b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1805ed926f9bSSteven Rostedt }
1806ed926f9bSSteven Rostedt 
180784b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1808ed926f9bSSteven Rostedt 				   int filter_hash)
1809ed926f9bSSteven Rostedt {
181084b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1811ed926f9bSSteven Rostedt }
1812ed926f9bSSteven Rostedt 
181384261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
181484261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
181584261912SSteven Rostedt (Red Hat) {
181684261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
181784261912SSteven Rostedt (Red Hat) 
181884261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
181984261912SSteven Rostedt (Red Hat) 
182084261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
182184261912SSteven Rostedt (Red Hat) 		return;
182284261912SSteven Rostedt (Red Hat) 
182384261912SSteven Rostedt (Red Hat) 	/*
182484261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
182584261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
182684261912SSteven Rostedt (Red Hat) 	 */
182784261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
182884261912SSteven Rostedt (Red Hat) 		/* Already done */
182984261912SSteven Rostedt (Red Hat) 		if (op == ops)
183084261912SSteven Rostedt (Red Hat) 			continue;
183184261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
183284261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
183384261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
183484261912SSteven Rostedt (Red Hat) }
183584261912SSteven Rostedt (Red Hat) 
183684261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
183784261912SSteven Rostedt (Red Hat) 					   int filter_hash)
183884261912SSteven Rostedt (Red Hat) {
183984261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
184084261912SSteven Rostedt (Red Hat) }
184184261912SSteven Rostedt (Red Hat) 
184284261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
184384261912SSteven Rostedt (Red Hat) 					  int filter_hash)
184484261912SSteven Rostedt (Red Hat) {
184584261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
184684261912SSteven Rostedt (Red Hat) }
184784261912SSteven Rostedt (Red Hat) 
1848f8b8be8aSMasami Hiramatsu /*
1849f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1850f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1851f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1852f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1853f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1854f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1855f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
1856f8b8be8aSMasami Hiramatsu  */
1857f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1858f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1859f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1860f8b8be8aSMasami Hiramatsu {
1861f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1862f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1863f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
1864f8b8be8aSMasami Hiramatsu 
1865f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1866f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1867f8b8be8aSMasami Hiramatsu 		return 0;
1868f8b8be8aSMasami Hiramatsu 
1869f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
1870f8b8be8aSMasami Hiramatsu 		return 0;
1871f8b8be8aSMasami Hiramatsu 
1872f8b8be8aSMasami Hiramatsu 	/*
1873f8b8be8aSMasami Hiramatsu 	 * Since the IPMODIFY is a very address sensitive action, we do not
1874f8b8be8aSMasami Hiramatsu 	 * allow ftrace_ops to set all functions to new hash.
1875f8b8be8aSMasami Hiramatsu 	 */
1876f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1877f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1878f8b8be8aSMasami Hiramatsu 
1879f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1880f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1881546fece4SSteven Rostedt (Red Hat) 
1882546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1883546fece4SSteven Rostedt (Red Hat) 			continue;
1884546fece4SSteven Rostedt (Red Hat) 
1885f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1886f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1887f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1888f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1889f8b8be8aSMasami Hiramatsu 			continue;
1890f8b8be8aSMasami Hiramatsu 
1891f8b8be8aSMasami Hiramatsu 		if (in_new) {
1892f8b8be8aSMasami Hiramatsu 			/* New entries must ensure no others are using it */
1893f8b8be8aSMasami Hiramatsu 			if (rec->flags & FTRACE_FL_IPMODIFY)
1894f8b8be8aSMasami Hiramatsu 				goto rollback;
1895f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1896f8b8be8aSMasami Hiramatsu 		} else /* Removed entry */
1897f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1898f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1899f8b8be8aSMasami Hiramatsu 
1900f8b8be8aSMasami Hiramatsu 	return 0;
1901f8b8be8aSMasami Hiramatsu 
1902f8b8be8aSMasami Hiramatsu rollback:
1903f8b8be8aSMasami Hiramatsu 	end = rec;
1904f8b8be8aSMasami Hiramatsu 
1905f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1906f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1907546fece4SSteven Rostedt (Red Hat) 
1908546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1909546fece4SSteven Rostedt (Red Hat) 			continue;
1910546fece4SSteven Rostedt (Red Hat) 
1911f8b8be8aSMasami Hiramatsu 		if (rec == end)
1912f8b8be8aSMasami Hiramatsu 			goto err_out;
1913f8b8be8aSMasami Hiramatsu 
1914f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1915f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1916f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1917f8b8be8aSMasami Hiramatsu 			continue;
1918f8b8be8aSMasami Hiramatsu 
1919f8b8be8aSMasami Hiramatsu 		if (in_new)
1920f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1921f8b8be8aSMasami Hiramatsu 		else
1922f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1923f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1924f8b8be8aSMasami Hiramatsu 
1925f8b8be8aSMasami Hiramatsu err_out:
1926f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1927f8b8be8aSMasami Hiramatsu }
1928f8b8be8aSMasami Hiramatsu 
1929f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1930f8b8be8aSMasami Hiramatsu {
1931f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1932f8b8be8aSMasami Hiramatsu 
1933f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1934f8b8be8aSMasami Hiramatsu 		hash = NULL;
1935f8b8be8aSMasami Hiramatsu 
1936f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
1937f8b8be8aSMasami Hiramatsu }
1938f8b8be8aSMasami Hiramatsu 
1939f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
1940f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
1941f8b8be8aSMasami Hiramatsu {
1942f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1943f8b8be8aSMasami Hiramatsu 
1944f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1945f8b8be8aSMasami Hiramatsu 		hash = NULL;
1946f8b8be8aSMasami Hiramatsu 
1947f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
1948f8b8be8aSMasami Hiramatsu }
1949f8b8be8aSMasami Hiramatsu 
1950f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1951f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
1952f8b8be8aSMasami Hiramatsu {
1953f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
1954f8b8be8aSMasami Hiramatsu 
1955f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
1956f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
1957f8b8be8aSMasami Hiramatsu 
1958f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
1959f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
1960f8b8be8aSMasami Hiramatsu 
1961f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
1962f8b8be8aSMasami Hiramatsu }
1963f8b8be8aSMasami Hiramatsu 
1964b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
196505736a42SSteven Rostedt {
196605736a42SSteven Rostedt 	int i;
196705736a42SSteven Rostedt 
196805736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
196905736a42SSteven Rostedt 
197005736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
197105736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
197205736a42SSteven Rostedt }
197305736a42SSteven Rostedt 
19744fd3279bSSteven Rostedt (Red Hat) static struct ftrace_ops *
19754fd3279bSSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
197639daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
197739daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
19784fd3279bSSteven Rostedt (Red Hat) 
197902a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
1980b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
198102a392a0SSteven Rostedt (Red Hat) 
198202a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
198302a392a0SSteven Rostedt (Red Hat) {
198402a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
198502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
198602a392a0SSteven Rostedt (Red Hat) 		break;
198702a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
198802a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
198902a392a0SSteven Rostedt (Red Hat) 		break;
199002a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
199102a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
199202a392a0SSteven Rostedt (Red Hat) 		break;
199302a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
199402a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
199502a392a0SSteven Rostedt (Red Hat) 		break;
199602a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
199702a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
199802a392a0SSteven Rostedt (Red Hat) 		break;
199902a392a0SSteven Rostedt (Red Hat) 	}
200002a392a0SSteven Rostedt (Red Hat) }
200102a392a0SSteven Rostedt (Red Hat) 
2002c88fd863SSteven Rostedt /**
2003c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
2004c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
20054fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
2006c88fd863SSteven Rostedt  *
2007c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2008c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2009c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2010c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2011c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
2012c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
2013c88fd863SSteven Rostedt  */
20144fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
20153c1720f0SSteven Rostedt {
20164fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
20174fd3279bSSteven Rostedt (Red Hat) 
2018b17e8a37SSteven Rostedt 	switch (failed) {
2019593eb8a2SSteven Rostedt 	case -EFAULT:
20206912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
202105736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
202205736a42SSteven Rostedt 		print_ip_sym(ip);
202305736a42SSteven Rostedt 		break;
2024593eb8a2SSteven Rostedt 	case -EINVAL:
20256912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
202605736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
202705736a42SSteven Rostedt 		print_ip_sym(ip);
202805736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
20294fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2030b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2031b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2032b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2033b05086c7SSteven Rostedt (Red Hat) 		}
203405736a42SSteven Rostedt 		break;
2035593eb8a2SSteven Rostedt 	case -EPERM:
20366912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2037593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
2038593eb8a2SSteven Rostedt 		print_ip_sym(ip);
2039593eb8a2SSteven Rostedt 		break;
2040593eb8a2SSteven Rostedt 	default:
20416912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2042593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
2043593eb8a2SSteven Rostedt 		print_ip_sym(ip);
204405736a42SSteven Rostedt 	}
204502a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
20464fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
20474fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
20484fd3279bSSteven Rostedt (Red Hat) 
20494fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
20504fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
20514fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
20524fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
20534fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
205439daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
205539daa7b9SSteven Rostedt (Red Hat) 				do {
205639daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
205739daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
205839daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
205939daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
206039daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
206139daa7b9SSteven Rostedt (Red Hat) 			} else
20624fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
20634fd3279bSSteven Rostedt (Red Hat) 
20644fd3279bSSteven Rostedt (Red Hat) 		}
20654fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
206639daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
20674fd3279bSSteven Rostedt (Red Hat) 	}
2068b17e8a37SSteven Rostedt }
206905736a42SSteven Rostedt 
2070c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
20713d083395SSteven Rostedt {
207264fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2073e7d3737eSFrederic Weisbecker 
207402a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
207502a392a0SSteven Rostedt (Red Hat) 
2076b7ffffbbSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_DISABLED)
2077b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2078b7ffffbbSSteven Rostedt (Red Hat) 
20793d083395SSteven Rostedt 	/*
208030fb6aa7SJiri Olsa 	 * If we are updating calls:
20813d083395SSteven Rostedt 	 *
2082ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2083ed926f9bSSteven Rostedt 	 *   because someone is using it.
20843d083395SSteven Rostedt 	 *
2085ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2086ed926f9bSSteven Rostedt 	 *
208730fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2088ed926f9bSSteven Rostedt 	 * are enabled.
20893d083395SSteven Rostedt 	 */
20900376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
209164fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
20923d083395SSteven Rostedt 
209308f6fba5SSteven Rostedt 	/*
209479922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
209579922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
209679922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
209708f6fba5SSteven Rostedt 	 */
209879922b80SSteven Rostedt (Red Hat) 	if (flag) {
209979922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
210079922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
210108f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
210208f6fba5SSteven Rostedt 
210379922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
210479922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
210579922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
210679922b80SSteven Rostedt (Red Hat) 	}
210779922b80SSteven Rostedt (Red Hat) 
210864fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
210964fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2110c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
211164fbcd16SXiao Guangrong 
211264fbcd16SXiao Guangrong 	if (flag) {
211308f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
211408f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
211508f6fba5SSteven Rostedt 
211608f6fba5SSteven Rostedt 		if (update) {
211764fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
211808f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
211908f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
212008f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
212108f6fba5SSteven Rostedt 				else
212208f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
212308f6fba5SSteven Rostedt 			}
212479922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
212579922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
212679922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
212779922b80SSteven Rostedt (Red Hat) 				else
212879922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
212979922b80SSteven Rostedt (Red Hat) 			}
213064fbcd16SXiao Guangrong 		}
213164fbcd16SXiao Guangrong 
213208f6fba5SSteven Rostedt 		/*
213308f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
213408f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
213508f6fba5SSteven Rostedt 		 * Otherwise,
213608f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2137f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
213879922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
213908f6fba5SSteven Rostedt 		 */
214002a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
214102a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
214208f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
214302a392a0SSteven Rostedt (Red Hat) 		}
2144f1b2f2bdSSteven Rostedt (Red Hat) 
214502a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
214608f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
214708f6fba5SSteven Rostedt 	}
214808f6fba5SSteven Rostedt 
214908f6fba5SSteven Rostedt 	if (update) {
215008f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
21510376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
215208f6fba5SSteven Rostedt 			rec->flags = 0;
215308f6fba5SSteven Rostedt 		else
2154b24d443bSSteven Rostedt (Red Hat) 			/*
2155b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2156b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2157b24d443bSSteven Rostedt (Red Hat) 			 */
2158b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2159b24d443bSSteven Rostedt (Red Hat) 					FTRACE_FL_REGS_EN);
216008f6fba5SSteven Rostedt 	}
2161c88fd863SSteven Rostedt 
216202a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2163c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2164c88fd863SSteven Rostedt }
2165c88fd863SSteven Rostedt 
2166c88fd863SSteven Rostedt /**
2167c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
2168c88fd863SSteven Rostedt  * @rec: the record to update
2169c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
2170c88fd863SSteven Rostedt  *
2171c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2172c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2173c88fd863SSteven Rostedt  */
2174c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
2175c88fd863SSteven Rostedt {
2176c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
2177c88fd863SSteven Rostedt }
2178c88fd863SSteven Rostedt 
2179c88fd863SSteven Rostedt /**
2180c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
2181c88fd863SSteven Rostedt  * @rec: the record to test
2182c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
2183c88fd863SSteven Rostedt  *
2184c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2185c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2186c88fd863SSteven Rostedt  * represents.
2187c88fd863SSteven Rostedt  */
2188c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
2189c88fd863SSteven Rostedt {
2190c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
2191c88fd863SSteven Rostedt }
2192c88fd863SSteven Rostedt 
219379922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
21945fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
21955fecaa04SSteven Rostedt (Red Hat) {
21965fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2197fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
21985fecaa04SSteven Rostedt (Red Hat) 
21995fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
22005fecaa04SSteven Rostedt (Red Hat) 
22015fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
22025fecaa04SSteven Rostedt (Red Hat) 			continue;
22035fecaa04SSteven Rostedt (Red Hat) 
2204fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
22055fecaa04SSteven Rostedt (Red Hat) 			return op;
22065fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
22075fecaa04SSteven Rostedt (Red Hat) 
22085fecaa04SSteven Rostedt (Red Hat) 	return NULL;
22095fecaa04SSteven Rostedt (Red Hat) }
22105fecaa04SSteven Rostedt (Red Hat) 
22115fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
221239daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
221339daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
221439daa7b9SSteven Rostedt (Red Hat) {
221539daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
221639daa7b9SSteven Rostedt (Red Hat) 
221739daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
221839daa7b9SSteven Rostedt (Red Hat) 
221939daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
222039daa7b9SSteven Rostedt (Red Hat) 			continue;
222139daa7b9SSteven Rostedt (Red Hat) 
222239daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
222339daa7b9SSteven Rostedt (Red Hat) 			return op;
222439daa7b9SSteven Rostedt (Red Hat) 	}
222539daa7b9SSteven Rostedt (Red Hat) 
222639daa7b9SSteven Rostedt (Red Hat) 	return NULL;
222739daa7b9SSteven Rostedt (Red Hat) }
222839daa7b9SSteven Rostedt (Red Hat) 
222939daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
223079922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
223179922b80SSteven Rostedt (Red Hat) {
223279922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2233fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
223479922b80SSteven Rostedt (Red Hat) 
2235fef5aeeeSSteven Rostedt (Red Hat) 	/*
2236fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2237fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2238fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2239fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2240fef5aeeeSSteven Rostedt (Red Hat) 	 */
2241fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2242fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
224379922b80SSteven Rostedt (Red Hat) 			return removed_ops;
224479922b80SSteven Rostedt (Red Hat) 	}
224579922b80SSteven Rostedt (Red Hat) 
2246fef5aeeeSSteven Rostedt (Red Hat) 	/*
2247fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2248fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2249fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2250fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2251fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2252fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
22534fc40904SSteven Rostedt (Red Hat) 	 * yet.
22544fc40904SSteven Rostedt (Red Hat) 	 *
22554fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
22564fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
22574fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
22584fc40904SSteven Rostedt (Red Hat) 	 *
22594fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
22604fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
22614fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
22624fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2263fef5aeeeSSteven Rostedt (Red Hat) 	 */
226479922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2265fef5aeeeSSteven Rostedt (Red Hat) 
2266fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
226779922b80SSteven Rostedt (Red Hat) 			continue;
226879922b80SSteven Rostedt (Red Hat) 
2269fef5aeeeSSteven Rostedt (Red Hat) 		/*
2270fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2271fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2272fef5aeeeSSteven Rostedt (Red Hat) 		 */
2273fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2274fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2275fef5aeeeSSteven Rostedt (Red Hat) 
2276fef5aeeeSSteven Rostedt (Red Hat) 
22774fc40904SSteven Rostedt (Red Hat) 		/*
22784fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
22794fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
22804fc40904SSteven Rostedt (Red Hat) 		 * function.
22814fc40904SSteven Rostedt (Red Hat) 		 */
2282fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2283fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
228479922b80SSteven Rostedt (Red Hat) 			return op;
22854fc40904SSteven Rostedt (Red Hat) 		/*
22864fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
22874fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
22884fc40904SSteven Rostedt (Red Hat) 		 * we want!
22894fc40904SSteven Rostedt (Red Hat) 		 */
22904fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
22914fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
22924fc40904SSteven Rostedt (Red Hat) 			return op;
229379922b80SSteven Rostedt (Red Hat) 
229479922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
229579922b80SSteven Rostedt (Red Hat) 
229679922b80SSteven Rostedt (Red Hat) 	return NULL;
229779922b80SSteven Rostedt (Red Hat) }
229879922b80SSteven Rostedt (Red Hat) 
229979922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
230079922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
230179922b80SSteven Rostedt (Red Hat) {
230279922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2303fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
230479922b80SSteven Rostedt (Red Hat) 
230579922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
230679922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2307fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
230879922b80SSteven Rostedt (Red Hat) 			return op;
230979922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
231079922b80SSteven Rostedt (Red Hat) 
231179922b80SSteven Rostedt (Red Hat) 	return NULL;
231279922b80SSteven Rostedt (Red Hat) }
231379922b80SSteven Rostedt (Red Hat) 
23147413af1fSSteven Rostedt (Red Hat) /**
23157413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
23167413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23177413af1fSSteven Rostedt (Red Hat)  *
23187413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
23197413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
23207413af1fSSteven Rostedt (Red Hat)  * is not not set, then it wants to convert to the normal callback.
23217413af1fSSteven Rostedt (Red Hat)  *
23227413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
23237413af1fSSteven Rostedt (Red Hat)  */
23247413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
23257413af1fSSteven Rostedt (Red Hat) {
232679922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
232779922b80SSteven Rostedt (Red Hat) 
232879922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
232979922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
233079922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
233179922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2332bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2333bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
233479922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
233579922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
233679922b80SSteven Rostedt (Red Hat) 		}
233779922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
233879922b80SSteven Rostedt (Red Hat) 	}
233979922b80SSteven Rostedt (Red Hat) 
23407413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
23417413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23427413af1fSSteven Rostedt (Red Hat) 	else
23437413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23447413af1fSSteven Rostedt (Red Hat) }
23457413af1fSSteven Rostedt (Red Hat) 
23467413af1fSSteven Rostedt (Red Hat) /**
23477413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
23487413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23497413af1fSSteven Rostedt (Red Hat)  *
23507413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
23517413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
23527413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
23537413af1fSSteven Rostedt (Red Hat)  *
23547413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
23557413af1fSSteven Rostedt (Red Hat)  */
23567413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
23577413af1fSSteven Rostedt (Red Hat) {
235879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
235979922b80SSteven Rostedt (Red Hat) 
236079922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
236179922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
236279922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
236379922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2364a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
236579922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
236679922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
236779922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
236879922b80SSteven Rostedt (Red Hat) 		}
236979922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
237079922b80SSteven Rostedt (Red Hat) 	}
237179922b80SSteven Rostedt (Red Hat) 
23727413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
23737413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23747413af1fSSteven Rostedt (Red Hat) 	else
23757413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23767413af1fSSteven Rostedt (Red Hat) }
23777413af1fSSteven Rostedt (Red Hat) 
2378c88fd863SSteven Rostedt static int
2379c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
2380c88fd863SSteven Rostedt {
238108f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2382c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2383c88fd863SSteven Rostedt 	int ret;
2384c88fd863SSteven Rostedt 
23857c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2386c88fd863SSteven Rostedt 
23877c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
23887c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
23897c0868e0SSteven Rostedt (Red Hat) 
23907c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
239108f6fba5SSteven Rostedt 
239202a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
239302a392a0SSteven Rostedt (Red Hat) 
2394c88fd863SSteven Rostedt 	switch (ret) {
2395c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2396c88fd863SSteven Rostedt 		return 0;
2397c88fd863SSteven Rostedt 
2398c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
239902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2400c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2401c88fd863SSteven Rostedt 
2402c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
240302a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
240439b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
240508f6fba5SSteven Rostedt 
240608f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
240702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
240808f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
24093d083395SSteven Rostedt 	}
24103d083395SSteven Rostedt 
2411c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
2412c88fd863SSteven Rostedt }
2413c88fd863SSteven Rostedt 
2414e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
24153d083395SSteven Rostedt {
24163d083395SSteven Rostedt 	struct dyn_ftrace *rec;
24173d083395SSteven Rostedt 	struct ftrace_page *pg;
24186a24a244SSteven Rostedt 	int failed;
24193d083395SSteven Rostedt 
242045a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
242145a4a237SSteven Rostedt 		return;
242245a4a237SSteven Rostedt 
2423265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2424546fece4SSteven Rostedt (Red Hat) 
2425546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2426546fece4SSteven Rostedt (Red Hat) 			continue;
2427546fece4SSteven Rostedt (Red Hat) 
2428e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2429fa9d13cfSZhaolei 		if (failed) {
24304fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
24314377245aSSteven Rostedt 			/* Stop processing */
24324377245aSSteven Rostedt 			return;
24334377245aSSteven Rostedt 		}
2434265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
24353d083395SSteven Rostedt }
24363c1720f0SSteven Rostedt 
2437c88fd863SSteven Rostedt struct ftrace_rec_iter {
2438c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2439c88fd863SSteven Rostedt 	int			index;
2440c88fd863SSteven Rostedt };
2441c88fd863SSteven Rostedt 
2442c88fd863SSteven Rostedt /**
2443c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
2444c88fd863SSteven Rostedt  *
2445c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2446c88fd863SSteven Rostedt  * the records that represent address locations where functions
2447c88fd863SSteven Rostedt  * are traced.
2448c88fd863SSteven Rostedt  *
2449c88fd863SSteven Rostedt  * May return NULL if no records are available.
2450c88fd863SSteven Rostedt  */
2451c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2452c88fd863SSteven Rostedt {
2453c88fd863SSteven Rostedt 	/*
2454c88fd863SSteven Rostedt 	 * We only use a single iterator.
2455c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2456c88fd863SSteven Rostedt 	 */
2457c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2458c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2459c88fd863SSteven Rostedt 
2460c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2461c88fd863SSteven Rostedt 	iter->index = 0;
2462c88fd863SSteven Rostedt 
2463c88fd863SSteven Rostedt 	/* Could have empty pages */
2464c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2465c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2466c88fd863SSteven Rostedt 
2467c88fd863SSteven Rostedt 	if (!iter->pg)
2468c88fd863SSteven Rostedt 		return NULL;
2469c88fd863SSteven Rostedt 
2470c88fd863SSteven Rostedt 	return iter;
2471c88fd863SSteven Rostedt }
2472c88fd863SSteven Rostedt 
2473c88fd863SSteven Rostedt /**
2474c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
2475c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2476c88fd863SSteven Rostedt  *
2477c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2478c88fd863SSteven Rostedt  */
2479c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2480c88fd863SSteven Rostedt {
2481c88fd863SSteven Rostedt 	iter->index++;
2482c88fd863SSteven Rostedt 
2483c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2484c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2485c88fd863SSteven Rostedt 		iter->index = 0;
2486c88fd863SSteven Rostedt 
2487c88fd863SSteven Rostedt 		/* Could have empty pages */
2488c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2489c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2490c88fd863SSteven Rostedt 	}
2491c88fd863SSteven Rostedt 
2492c88fd863SSteven Rostedt 	if (!iter->pg)
2493c88fd863SSteven Rostedt 		return NULL;
2494c88fd863SSteven Rostedt 
2495c88fd863SSteven Rostedt 	return iter;
2496c88fd863SSteven Rostedt }
2497c88fd863SSteven Rostedt 
2498c88fd863SSteven Rostedt /**
2499c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
2500c88fd863SSteven Rostedt  * @iter: The current iterator location
2501c88fd863SSteven Rostedt  *
2502c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2503c88fd863SSteven Rostedt  */
2504c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2505c88fd863SSteven Rostedt {
2506c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2507c88fd863SSteven Rostedt }
2508c88fd863SSteven Rostedt 
25093b47bfc1SSteven Rostedt static int
251031e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
25113c1720f0SSteven Rostedt {
2512492a7ea5SAbhishek Sagar 	int ret;
251337ad5084SSteven Rostedt 
251445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
251545a4a237SSteven Rostedt 		return 0;
251645a4a237SSteven Rostedt 
251725aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
25183d083395SSteven Rostedt 	if (ret) {
251902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
25204fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
25213d083395SSteven Rostedt 		return 0;
2522d61f82d0SSteven Rostedt 	}
2523d61f82d0SSteven Rostedt 	return 1;
25243d083395SSteven Rostedt }
25253d083395SSteven Rostedt 
2526000ab691SSteven Rostedt /*
2527000ab691SSteven Rostedt  * archs can override this function if they must do something
2528000ab691SSteven Rostedt  * before the modifying code is performed.
2529000ab691SSteven Rostedt  */
2530000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
2531000ab691SSteven Rostedt {
2532000ab691SSteven Rostedt 	return 0;
2533000ab691SSteven Rostedt }
2534000ab691SSteven Rostedt 
2535000ab691SSteven Rostedt /*
2536000ab691SSteven Rostedt  * archs can override this function if they must do something
2537000ab691SSteven Rostedt  * after the modifying code is performed.
2538000ab691SSteven Rostedt  */
2539000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
2540000ab691SSteven Rostedt {
2541000ab691SSteven Rostedt 	return 0;
2542000ab691SSteven Rostedt }
2543000ab691SSteven Rostedt 
25448ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
25458ed3e2cfSSteven Rostedt {
254659338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2547cd21067fSPetr Mladek 	int err = 0;
254859338f75SSteven Rostedt (Red Hat) 
254959338f75SSteven Rostedt (Red Hat) 	/*
255059338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
255159338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
255259338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
255359338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
255459338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
255559338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
255659338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
255759338f75SSteven Rostedt (Red Hat) 	 * traced.
255859338f75SSteven Rostedt (Red Hat) 	 */
2559cd21067fSPetr Mladek 	if (update) {
2560cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2561cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2562cd21067fSPetr Mladek 			return;
2563cd21067fSPetr Mladek 	}
256459338f75SSteven Rostedt (Red Hat) 
25658ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
25668ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
25678ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
25688ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
25698ed3e2cfSSteven Rostedt 
2570405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2571405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2572405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2573405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2574405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2575405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2576cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2577cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2578cd21067fSPetr Mladek 			return;
2579405e1d83SSteven Rostedt (Red Hat) 	}
25808ed3e2cfSSteven Rostedt 
25818ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2582cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
25838ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2584cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2585cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
25868ed3e2cfSSteven Rostedt }
25878ed3e2cfSSteven Rostedt 
25883d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
25893d083395SSteven Rostedt {
25903d083395SSteven Rostedt 	int *command = data;
25913d083395SSteven Rostedt 
25928ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
25935a45cfe1SSteven Rostedt 
2594c88fd863SSteven Rostedt 	return 0;
2595c88fd863SSteven Rostedt }
2596c88fd863SSteven Rostedt 
2597c88fd863SSteven Rostedt /**
2598c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
2599c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2600c88fd863SSteven Rostedt  *
2601c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2602c88fd863SSteven Rostedt  * it can call this function.
2603c88fd863SSteven Rostedt  */
2604c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2605c88fd863SSteven Rostedt {
2606c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2607c88fd863SSteven Rostedt }
2608c88fd863SSteven Rostedt 
2609c88fd863SSteven Rostedt /**
2610c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
2611c88fd863SSteven Rostedt  * @command: The command that needs to be done
2612c88fd863SSteven Rostedt  *
2613c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2614c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2615c88fd863SSteven Rostedt  */
2616c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2617c88fd863SSteven Rostedt {
2618c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2619c88fd863SSteven Rostedt }
2620c88fd863SSteven Rostedt 
2621c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2622c88fd863SSteven Rostedt {
2623c88fd863SSteven Rostedt 	int ret;
2624c88fd863SSteven Rostedt 
2625c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
2626c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
2627c88fd863SSteven Rostedt 	if (ret)
2628c88fd863SSteven Rostedt 		return;
2629c88fd863SSteven Rostedt 
2630c88fd863SSteven Rostedt 	/*
2631c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2632c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2633c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2634c88fd863SSteven Rostedt 	 * produces the most overhead.
2635c88fd863SSteven Rostedt 	 */
2636c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2637c88fd863SSteven Rostedt 
2638000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
2639000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
26403d083395SSteven Rostedt }
26413d083395SSteven Rostedt 
26428252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
26437485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2644e1effa01SSteven Rostedt (Red Hat) {
2645e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
26467485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
26477485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2648e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
26498252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
26507485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2651e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2652e1effa01SSteven Rostedt (Red Hat) }
2653e1effa01SSteven Rostedt (Red Hat) 
26543d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
265560a7ecf4SSteven Rostedt static int ftrace_start_up;
2656df4fc315SSteven Rostedt 
265712cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
265812cce594SSteven Rostedt (Red Hat) {
265912cce594SSteven Rostedt (Red Hat) }
266012cce594SSteven Rostedt (Red Hat) 
2661ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_free(struct ftrace_ops *ops)
2662db0fbadcSJiri Slaby {
2663db0fbadcSJiri Slaby 	free_percpu(ops->disabled);
2664db0fbadcSJiri Slaby }
2665db0fbadcSJiri Slaby 
2666df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2667df4fc315SSteven Rostedt {
2668df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2669df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2670df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2671df4fc315SSteven Rostedt 	}
2672df4fc315SSteven Rostedt 
2673df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2674df4fc315SSteven Rostedt 		return;
2675df4fc315SSteven Rostedt 
2676df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2677df4fc315SSteven Rostedt }
26783d083395SSteven Rostedt 
2679e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2680e1effa01SSteven Rostedt (Red Hat) {
2681e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2682e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2683e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2684e1effa01SSteven Rostedt (Red Hat) }
2685e1effa01SSteven Rostedt (Red Hat) 
2686a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
26873d083395SSteven Rostedt {
26888a56d776SSteven Rostedt (Red Hat) 	int ret;
2689b848914cSSteven Rostedt 
26904eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2691a1cd6173SSteven Rostedt 		return -ENODEV;
26924eebcc81SSteven Rostedt 
26938a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
26948a56d776SSteven Rostedt (Red Hat) 	if (ret)
26958a56d776SSteven Rostedt (Red Hat) 		return ret;
26968a56d776SSteven Rostedt (Red Hat) 
269760a7ecf4SSteven Rostedt 	ftrace_start_up++;
26983d083395SSteven Rostedt 
2699e1effa01SSteven Rostedt (Red Hat) 	/*
2700e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2701e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2702e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2703e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2704e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2705e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2706e1effa01SSteven Rostedt (Red Hat) 	 */
2707e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
270866209a5bSSteven Rostedt (Red Hat) 
2709f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2710f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2711f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2712f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2713f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2714f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2715f8b8be8aSMasami Hiramatsu 		return ret;
2716f8b8be8aSMasami Hiramatsu 	}
2717f8b8be8aSMasami Hiramatsu 
27187f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
27197f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2720ed926f9bSSteven Rostedt 
2721df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2722a1cd6173SSteven Rostedt 
2723e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2724e1effa01SSteven Rostedt (Red Hat) 
2725a1cd6173SSteven Rostedt 	return 0;
27263d083395SSteven Rostedt }
27273d083395SSteven Rostedt 
27288a56d776SSteven Rostedt (Red Hat) static int ftrace_shutdown(struct ftrace_ops *ops, int command)
27293d083395SSteven Rostedt {
27308a56d776SSteven Rostedt (Red Hat) 	int ret;
2731b848914cSSteven Rostedt 
27324eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
27338a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
27348a56d776SSteven Rostedt (Red Hat) 
27358a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
27368a56d776SSteven Rostedt (Red Hat) 	if (ret)
27378a56d776SSteven Rostedt (Red Hat) 		return ret;
27384eebcc81SSteven Rostedt 
273960a7ecf4SSteven Rostedt 	ftrace_start_up--;
27409ea1a153SFrederic Weisbecker 	/*
27419ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
27429ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
27439ea1a153SFrederic Weisbecker 	 * further ftrace uses.
27449ea1a153SFrederic Weisbecker 	 */
27459ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
27469ea1a153SFrederic Weisbecker 
2747f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
2748f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
27497f50d06bSJiri Olsa 
27507f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
27517f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2752ed926f9bSSteven Rostedt 
2753ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2754b848914cSSteven Rostedt 
2755d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2756d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2757d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2758d61f82d0SSteven Rostedt 	}
2759d61f82d0SSteven Rostedt 
2760a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
2761a4c35ed2SSteven Rostedt (Red Hat) 		/*
2762ba27f2bcSSteven Rostedt (Red Hat) 		 * If these are per_cpu ops, they still need their
2763a4c35ed2SSteven Rostedt (Red Hat) 		 * per_cpu field freed. Since, function tracing is
2764a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
2765a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
2766a4c35ed2SSteven Rostedt (Red Hat) 		 */
2767ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2768ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
27698a56d776SSteven Rostedt (Red Hat) 		return 0;
2770a4c35ed2SSteven Rostedt (Red Hat) 	}
27713d083395SSteven Rostedt 
277279922b80SSteven Rostedt (Red Hat) 	/*
277379922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
277479922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
277579922b80SSteven Rostedt (Red Hat) 	 */
2776e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
277779922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
277879922b80SSteven Rostedt (Red Hat) 
2779fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
2780fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
2781fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
2782fef5aeeeSSteven Rostedt (Red Hat) 
2783d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
2784a4c35ed2SSteven Rostedt (Red Hat) 
278584bde62cSSteven Rostedt (Red Hat) 	/*
278684bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
278784bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
278884bde62cSSteven Rostedt (Red Hat) 	 */
278984bde62cSSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
279084bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
279184bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
279284bde62cSSteven Rostedt (Red Hat) 
279384bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
2794977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
279584bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
279684bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
279784bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
279884bde62cSSteven Rostedt (Red Hat) 	}
279984bde62cSSteven Rostedt (Red Hat) 
2800fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
2801fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2802fef5aeeeSSteven Rostedt (Red Hat) 
2803fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
2804e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
280579922b80SSteven Rostedt (Red Hat) 
2806a4c35ed2SSteven Rostedt (Red Hat) 	/*
2807a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
2808a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
2809ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
2810a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
2811a4c35ed2SSteven Rostedt (Red Hat) 	 *
2812a4c35ed2SSteven Rostedt (Red Hat) 	 * Again, normal synchronize_sched() is not good enough.
2813a4c35ed2SSteven Rostedt (Red Hat) 	 * We need to do a hard force of sched synchronization.
2814a4c35ed2SSteven Rostedt (Red Hat) 	 * This is because we use preempt_disable() to do RCU, but
2815a4c35ed2SSteven Rostedt (Red Hat) 	 * the function tracers can be called where RCU is not watching
2816a4c35ed2SSteven Rostedt (Red Hat) 	 * (like before user_exit()). We can not rely on the RCU
2817a4c35ed2SSteven Rostedt (Red Hat) 	 * infrastructure to do the synchronization, thus we must do it
2818a4c35ed2SSteven Rostedt (Red Hat) 	 * ourselves.
2819a4c35ed2SSteven Rostedt (Red Hat) 	 */
2820ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU)) {
2821a4c35ed2SSteven Rostedt (Red Hat) 		schedule_on_each_cpu(ftrace_sync);
2822a4c35ed2SSteven Rostedt (Red Hat) 
282312cce594SSteven Rostedt (Red Hat) 		arch_ftrace_trampoline_free(ops);
282412cce594SSteven Rostedt (Red Hat) 
2825ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2826ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
2827a4c35ed2SSteven Rostedt (Red Hat) 	}
2828a4c35ed2SSteven Rostedt (Red Hat) 
28298a56d776SSteven Rostedt (Red Hat) 	return 0;
28303d083395SSteven Rostedt }
28313d083395SSteven Rostedt 
2832e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2833b0fc494fSSteven Rostedt {
28341619dc3fSPratyush Anand 	int command;
28351619dc3fSPratyush Anand 
28364eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
28374eebcc81SSteven Rostedt 		return;
28384eebcc81SSteven Rostedt 
2839d61f82d0SSteven Rostedt 	/* Force update next time */
2840d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
284160a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
28421619dc3fSPratyush Anand 	if (ftrace_start_up) {
28431619dc3fSPratyush Anand 		command = FTRACE_UPDATE_CALLS;
28441619dc3fSPratyush Anand 		if (ftrace_graph_active)
28451619dc3fSPratyush Anand 			command |= FTRACE_START_FUNC_RET;
2846524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_enable(command);
28471619dc3fSPratyush Anand 	}
2848b0fc494fSSteven Rostedt }
2849b0fc494fSSteven Rostedt 
2850e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2851b0fc494fSSteven Rostedt {
28521619dc3fSPratyush Anand 	int command;
28531619dc3fSPratyush Anand 
28544eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
28554eebcc81SSteven Rostedt 		return;
28564eebcc81SSteven Rostedt 
285760a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
28581619dc3fSPratyush Anand 	if (ftrace_start_up) {
28591619dc3fSPratyush Anand 		command = FTRACE_DISABLE_CALLS;
28601619dc3fSPratyush Anand 		if (ftrace_graph_active)
28611619dc3fSPratyush Anand 			command |= FTRACE_STOP_FUNC_RET;
28621619dc3fSPratyush Anand 		ftrace_run_update_code(command);
28631619dc3fSPratyush Anand 	}
2864b0fc494fSSteven Rostedt }
2865b0fc494fSSteven Rostedt 
2866a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
28673d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
28683d083395SSteven Rostedt 
28698c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
2870f7bc8b61SSteven Rostedt {
28718c4f3c3fSSteven Rostedt (Red Hat) 	/*
28728c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
28738c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
28748c4f3c3fSSteven Rostedt (Red Hat) 	 */
287533b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
287633b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
28778c4f3c3fSSteven Rostedt (Red Hat) }
2878f7bc8b61SSteven Rostedt 
28798c4f3c3fSSteven Rostedt (Red Hat) /*
28808c4f3c3fSSteven Rostedt (Red Hat)  * Check if the current ops references the record.
28818c4f3c3fSSteven Rostedt (Red Hat)  *
28828c4f3c3fSSteven Rostedt (Red Hat)  * If the ops traces all functions, then it was already accounted for.
28838c4f3c3fSSteven Rostedt (Red Hat)  * If the ops does not trace the current record function, skip it.
28848c4f3c3fSSteven Rostedt (Red Hat)  * If the ops ignores the function via notrace filter, skip it.
28858c4f3c3fSSteven Rostedt (Red Hat)  */
28868c4f3c3fSSteven Rostedt (Red Hat) static inline bool
28878c4f3c3fSSteven Rostedt (Red Hat) ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
28888c4f3c3fSSteven Rostedt (Red Hat) {
28898c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops isn't enabled, ignore it */
28908c4f3c3fSSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
28918c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28928c4f3c3fSSteven Rostedt (Red Hat) 
2893b7ffffbbSSteven Rostedt (Red Hat) 	/* If ops traces all then it includes this function */
28948c4f3c3fSSteven Rostedt (Red Hat) 	if (ops_traces_mod(ops))
2895b7ffffbbSSteven Rostedt (Red Hat) 		return 1;
28968c4f3c3fSSteven Rostedt (Red Hat) 
28978c4f3c3fSSteven Rostedt (Red Hat) 	/* The function must be in the filter */
289833b7f99cSSteven Rostedt (Red Hat) 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
28992b2c279cSSteven Rostedt (VMware) 	    !__ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))
29008c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
29018c4f3c3fSSteven Rostedt (Red Hat) 
29028c4f3c3fSSteven Rostedt (Red Hat) 	/* If in notrace hash, we ignore it too */
290333b7f99cSSteven Rostedt (Red Hat) 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
29048c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
29058c4f3c3fSSteven Rostedt (Red Hat) 
29068c4f3c3fSSteven Rostedt (Red Hat) 	return 1;
29078c4f3c3fSSteven Rostedt (Red Hat) }
29088c4f3c3fSSteven Rostedt (Red Hat) 
29091dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
29103d083395SSteven Rostedt {
291185ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2912e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2913a5a1d1c2SThomas Gleixner 	u64 start, stop;
29141dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
2915b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
291685ae32aeSSteven Rostedt 	int i;
2917f7bc8b61SSteven Rostedt 
2918750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
29193d083395SSteven Rostedt 
2920b7ffffbbSSteven Rostedt (Red Hat) 	/*
2921b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
2922b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
2923b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
2924b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
2925b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
2926b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
2927b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
2928b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
2929b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
2930b7ffffbbSSteven Rostedt (Red Hat) 	 */
2931b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
2932b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
2933b7ffffbbSSteven Rostedt (Red Hat) 
29341dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
2935f22f9a89SAbhishek Sagar 
293685ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
29378c4f3c3fSSteven Rostedt (Red Hat) 
293808f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
293908f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
294008f5ac90SSteven Rostedt 				return -1;
29413d083395SSteven Rostedt 
294285ae32aeSSteven Rostedt 			p = &pg->records[i];
2943b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
2944f22f9a89SAbhishek Sagar 
29455cb084bbSJiri Olsa 			/*
294625985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
29475cb084bbSJiri Olsa 			 * to the NOP instructions.
29485cb084bbSJiri Olsa 			 */
294932082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2950d2c8c3eaSSteven Rostedt 				break;
29515cb084bbSJiri Olsa 
29521dc43cf0SJiri Slaby 			update_cnt++;
29535cb084bbSJiri Olsa 		}
295485ae32aeSSteven Rostedt 	}
295585ae32aeSSteven Rostedt 
2956750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
29573d083395SSteven Rostedt 	ftrace_update_time = stop - start;
29581dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
29593d083395SSteven Rostedt 
296016444a8aSArnaldo Carvalho de Melo 	return 0;
296116444a8aSArnaldo Carvalho de Melo }
296216444a8aSArnaldo Carvalho de Melo 
2963a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
29643c1720f0SSteven Rostedt {
2965a7900875SSteven Rostedt 	int order;
29663c1720f0SSteven Rostedt 	int cnt;
29673c1720f0SSteven Rostedt 
2968a7900875SSteven Rostedt 	if (WARN_ON(!count))
2969a7900875SSteven Rostedt 		return -EINVAL;
2970a7900875SSteven Rostedt 
2971a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
29723c1720f0SSteven Rostedt 
29733c1720f0SSteven Rostedt 	/*
2974a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2975a7900875SSteven Rostedt 	 * may be empty.
29763c1720f0SSteven Rostedt 	 */
2977a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2978a7900875SSteven Rostedt 		order--;
29793c1720f0SSteven Rostedt 
2980a7900875SSteven Rostedt  again:
2981a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2982a7900875SSteven Rostedt 
2983a7900875SSteven Rostedt 	if (!pg->records) {
2984a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2985a7900875SSteven Rostedt 		if (!order)
2986a7900875SSteven Rostedt 			return -ENOMEM;
2987a7900875SSteven Rostedt 		order >>= 1;
2988a7900875SSteven Rostedt 		goto again;
2989a7900875SSteven Rostedt 	}
2990a7900875SSteven Rostedt 
2991a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2992a7900875SSteven Rostedt 	pg->size = cnt;
2993a7900875SSteven Rostedt 
2994a7900875SSteven Rostedt 	if (cnt > count)
2995a7900875SSteven Rostedt 		cnt = count;
2996a7900875SSteven Rostedt 
2997a7900875SSteven Rostedt 	return cnt;
2998a7900875SSteven Rostedt }
2999a7900875SSteven Rostedt 
3000a7900875SSteven Rostedt static struct ftrace_page *
3001a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
3002a7900875SSteven Rostedt {
3003a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
3004a7900875SSteven Rostedt 	struct ftrace_page *pg;
3005a7900875SSteven Rostedt 	int order;
3006a7900875SSteven Rostedt 	int cnt;
3007a7900875SSteven Rostedt 
3008a7900875SSteven Rostedt 	if (!num_to_init)
3009a7900875SSteven Rostedt 		return 0;
3010a7900875SSteven Rostedt 
3011a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3012a7900875SSteven Rostedt 	if (!pg)
3013a7900875SSteven Rostedt 		return NULL;
3014a7900875SSteven Rostedt 
3015a7900875SSteven Rostedt 	/*
3016a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3017a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3018a7900875SSteven Rostedt 	 * waste as little space as possible.
3019a7900875SSteven Rostedt 	 */
3020a7900875SSteven Rostedt 	for (;;) {
3021a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3022a7900875SSteven Rostedt 		if (cnt < 0)
3023a7900875SSteven Rostedt 			goto free_pages;
3024a7900875SSteven Rostedt 
3025a7900875SSteven Rostedt 		num_to_init -= cnt;
3026a7900875SSteven Rostedt 		if (!num_to_init)
3027a7900875SSteven Rostedt 			break;
3028a7900875SSteven Rostedt 
3029a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3030a7900875SSteven Rostedt 		if (!pg->next)
3031a7900875SSteven Rostedt 			goto free_pages;
3032a7900875SSteven Rostedt 
3033a7900875SSteven Rostedt 		pg = pg->next;
3034a7900875SSteven Rostedt 	}
3035a7900875SSteven Rostedt 
3036a7900875SSteven Rostedt 	return start_pg;
3037a7900875SSteven Rostedt 
3038a7900875SSteven Rostedt  free_pages:
30391f61be00SNamhyung Kim 	pg = start_pg;
30401f61be00SNamhyung Kim 	while (pg) {
3041a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3042a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
3043a7900875SSteven Rostedt 		start_pg = pg->next;
3044a7900875SSteven Rostedt 		kfree(pg);
3045a7900875SSteven Rostedt 		pg = start_pg;
3046a7900875SSteven Rostedt 	}
3047a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3048a7900875SSteven Rostedt 	return NULL;
3049a7900875SSteven Rostedt }
3050a7900875SSteven Rostedt 
30515072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
30525072c59fSSteven Rostedt 
30535072c59fSSteven Rostedt struct ftrace_iterator {
305498c4fd04SSteven Rostedt 	loff_t				pos;
30552bccfffdSSteven Rostedt 	loff_t				func_pos;
30565072c59fSSteven Rostedt 	struct ftrace_page		*pg;
30574aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
30584aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
30594aeb6967SSteven Rostedt 	struct trace_parser		parser;
30601cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
306133dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
30628fc0c701SSteven Rostedt 	int				hidx;
3063431aa3fbSSteven Rostedt 	int				idx;
30645072c59fSSteven Rostedt 	unsigned			flags;
30655072c59fSSteven Rostedt };
30665072c59fSSteven Rostedt 
3067e309b41dSIngo Molnar static void *
30684aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
30698fc0c701SSteven Rostedt {
30708fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
30714aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
30728fc0c701SSteven Rostedt 	struct hlist_head *hhd;
30738fc0c701SSteven Rostedt 
30748fc0c701SSteven Rostedt 	(*pos)++;
307598c4fd04SSteven Rostedt 	iter->pos = *pos;
30768fc0c701SSteven Rostedt 
30774aeb6967SSteven Rostedt 	if (iter->probe)
30784aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
30798fc0c701SSteven Rostedt  retry:
30808fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
30818fc0c701SSteven Rostedt 		return NULL;
30828fc0c701SSteven Rostedt 
30838fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
30848fc0c701SSteven Rostedt 
30858fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
30868fc0c701SSteven Rostedt 		iter->hidx++;
30878fc0c701SSteven Rostedt 		hnd = NULL;
30888fc0c701SSteven Rostedt 		goto retry;
30898fc0c701SSteven Rostedt 	}
30908fc0c701SSteven Rostedt 
30918fc0c701SSteven Rostedt 	if (!hnd)
30928fc0c701SSteven Rostedt 		hnd = hhd->first;
30938fc0c701SSteven Rostedt 	else {
30948fc0c701SSteven Rostedt 		hnd = hnd->next;
30958fc0c701SSteven Rostedt 		if (!hnd) {
30968fc0c701SSteven Rostedt 			iter->hidx++;
30978fc0c701SSteven Rostedt 			goto retry;
30988fc0c701SSteven Rostedt 		}
30998fc0c701SSteven Rostedt 	}
31008fc0c701SSteven Rostedt 
31014aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
31024aeb6967SSteven Rostedt 		return NULL;
31034aeb6967SSteven Rostedt 
31044aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
31054aeb6967SSteven Rostedt 
31064aeb6967SSteven Rostedt 	return iter;
31078fc0c701SSteven Rostedt }
31088fc0c701SSteven Rostedt 
31098fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
31108fc0c701SSteven Rostedt {
31118fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
31128fc0c701SSteven Rostedt 	void *p = NULL;
3113d82d6244SLi Zefan 	loff_t l;
3114d82d6244SLi Zefan 
311569a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
311669a3083cSSteven Rostedt 		return NULL;
311769a3083cSSteven Rostedt 
31182bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
31192bccfffdSSteven Rostedt 		return NULL;
31208fc0c701SSteven Rostedt 
3121d82d6244SLi Zefan 	iter->hidx = 0;
31222bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
31234aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
3124d82d6244SLi Zefan 		if (!p)
3125d82d6244SLi Zefan 			break;
3126d82d6244SLi Zefan 	}
31274aeb6967SSteven Rostedt 	if (!p)
31284aeb6967SSteven Rostedt 		return NULL;
31294aeb6967SSteven Rostedt 
313098c4fd04SSteven Rostedt 	/* Only set this if we have an item */
313198c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
313298c4fd04SSteven Rostedt 
31334aeb6967SSteven Rostedt 	return iter;
31348fc0c701SSteven Rostedt }
31358fc0c701SSteven Rostedt 
31364aeb6967SSteven Rostedt static int
31374aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
31388fc0c701SSteven Rostedt {
3139b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
31408fc0c701SSteven Rostedt 
31414aeb6967SSteven Rostedt 	rec = iter->probe;
31424aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
31434aeb6967SSteven Rostedt 		return -EIO;
31448fc0c701SSteven Rostedt 
3145809dcf29SSteven Rostedt 	if (rec->ops->print)
3146809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
3147809dcf29SSteven Rostedt 
3148b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
31498fc0c701SSteven Rostedt 
31508fc0c701SSteven Rostedt 	if (rec->data)
31518fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
31528fc0c701SSteven Rostedt 	seq_putc(m, '\n');
31538fc0c701SSteven Rostedt 
31548fc0c701SSteven Rostedt 	return 0;
31558fc0c701SSteven Rostedt }
31568fc0c701SSteven Rostedt 
31578fc0c701SSteven Rostedt static void *
31585bd84629SSteven Rostedt (VMware) t_func_next(struct seq_file *m, loff_t *pos)
31595072c59fSSteven Rostedt {
31605072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
31615072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
31625072c59fSSteven Rostedt 
31635072c59fSSteven Rostedt 	(*pos)++;
31640c75a3edSSteven Rostedt 
31655072c59fSSteven Rostedt  retry:
31665072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
31675072c59fSSteven Rostedt 		if (iter->pg->next) {
31685072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
31695072c59fSSteven Rostedt 			iter->idx = 0;
31705072c59fSSteven Rostedt 			goto retry;
31715072c59fSSteven Rostedt 		}
31725072c59fSSteven Rostedt 	} else {
31735072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
3174c20489daSSteven Rostedt (VMware) 		if (((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3175c20489daSSteven Rostedt (VMware) 		     !ftrace_lookup_ip(iter->hash, rec->ip)) ||
3176647bcd03SSteven Rostedt 
3177647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
317823ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3179647bcd03SSteven Rostedt 
31805072c59fSSteven Rostedt 			rec = NULL;
31815072c59fSSteven Rostedt 			goto retry;
31825072c59fSSteven Rostedt 		}
31835072c59fSSteven Rostedt 	}
31845072c59fSSteven Rostedt 
31854aeb6967SSteven Rostedt 	if (!rec)
31865bd84629SSteven Rostedt (VMware) 		return NULL;
31874aeb6967SSteven Rostedt 
31885bd84629SSteven Rostedt (VMware) 	iter->pos = iter->func_pos = *pos;
31894aeb6967SSteven Rostedt 	iter->func = rec;
31904aeb6967SSteven Rostedt 
31914aeb6967SSteven Rostedt 	return iter;
31925072c59fSSteven Rostedt }
31935072c59fSSteven Rostedt 
31945bd84629SSteven Rostedt (VMware) static void *
31955bd84629SSteven Rostedt (VMware) t_next(struct seq_file *m, void *v, loff_t *pos)
31965bd84629SSteven Rostedt (VMware) {
31975bd84629SSteven Rostedt (VMware) 	struct ftrace_iterator *iter = m->private;
31985bd84629SSteven Rostedt (VMware) 	void *ret;
31995bd84629SSteven Rostedt (VMware) 
32005bd84629SSteven Rostedt (VMware) 	if (unlikely(ftrace_disabled))
32015bd84629SSteven Rostedt (VMware) 		return NULL;
32025bd84629SSteven Rostedt (VMware) 
32035bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_HASH)
32045bd84629SSteven Rostedt (VMware) 		return t_hash_next(m, pos);
32055bd84629SSteven Rostedt (VMware) 
32065bd84629SSteven Rostedt (VMware) 	if (iter->flags & FTRACE_ITER_PRINTALL) {
32075bd84629SSteven Rostedt (VMware) 		/* next must increment pos, and t_hash_start does not */
32085bd84629SSteven Rostedt (VMware) 		(*pos)++;
32095bd84629SSteven Rostedt (VMware) 		return t_hash_start(m, pos);
32105bd84629SSteven Rostedt (VMware) 	}
32115bd84629SSteven Rostedt (VMware) 
32125bd84629SSteven Rostedt (VMware) 	ret = t_func_next(m, pos);
32135bd84629SSteven Rostedt (VMware) 
32145bd84629SSteven Rostedt (VMware) 	if (!ret)
32155bd84629SSteven Rostedt (VMware) 		return t_hash_start(m, pos);
32165bd84629SSteven Rostedt (VMware) 
32175bd84629SSteven Rostedt (VMware) 	return ret;
32185bd84629SSteven Rostedt (VMware) }
32195bd84629SSteven Rostedt (VMware) 
322098c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
322198c4fd04SSteven Rostedt {
322298c4fd04SSteven Rostedt 	iter->pos = 0;
322398c4fd04SSteven Rostedt 	iter->func_pos = 0;
322470f77b3fSDan Carpenter 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_HASH);
32255072c59fSSteven Rostedt }
32265072c59fSSteven Rostedt 
32275072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
32285072c59fSSteven Rostedt {
32295072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
32305072c59fSSteven Rostedt 	void *p = NULL;
3231694ce0a5SLi Zefan 	loff_t l;
32325072c59fSSteven Rostedt 
32338fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
323445a4a237SSteven Rostedt 
323545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
323645a4a237SSteven Rostedt 		return NULL;
323745a4a237SSteven Rostedt 
32380c75a3edSSteven Rostedt 	/*
323998c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
324098c4fd04SSteven Rostedt 	 */
324198c4fd04SSteven Rostedt 	if (*pos < iter->pos)
324298c4fd04SSteven Rostedt 		reset_iter_read(iter);
324398c4fd04SSteven Rostedt 
324498c4fd04SSteven Rostedt 	/*
32450c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
32460c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
32470c75a3edSSteven Rostedt 	 * functions are enabled.
32480c75a3edSSteven Rostedt 	 */
3249c20489daSSteven Rostedt (VMware) 	if ((iter->flags & (FTRACE_ITER_FILTER | FTRACE_ITER_NOTRACE)) &&
3250c20489daSSteven Rostedt (VMware) 	    ftrace_hash_empty(iter->hash)) {
325143ff926aSSteven Rostedt (VMware) 		iter->func_pos = 1; /* Account for the message */
32520c75a3edSSteven Rostedt 		if (*pos > 0)
32538fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
32540c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3255df091625SChris Wright 		/* reset in case of seek/pread */
3256df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
32570c75a3edSSteven Rostedt 		return iter;
32580c75a3edSSteven Rostedt 	}
32590c75a3edSSteven Rostedt 
32608fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
32618fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
32628fc0c701SSteven Rostedt 
326398c4fd04SSteven Rostedt 	/*
326498c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
326598c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
326698c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
326798c4fd04SSteven Rostedt 	 */
3268694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3269694ce0a5SLi Zefan 	iter->idx = 0;
3270694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
32715bd84629SSteven Rostedt (VMware) 		p = t_func_next(m, &l);
3272694ce0a5SLi Zefan 		if (!p)
3273694ce0a5SLi Zefan 			break;
327450cdaf08SLiming Wang 	}
32755821e1b7Swalimis 
327669a3083cSSteven Rostedt 	if (!p)
32775bd84629SSteven Rostedt (VMware) 		return t_hash_start(m, pos);
32788fc0c701SSteven Rostedt 
32794aeb6967SSteven Rostedt 	return iter;
32805072c59fSSteven Rostedt }
32815072c59fSSteven Rostedt 
32825072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
32835072c59fSSteven Rostedt {
32848fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
32855072c59fSSteven Rostedt }
32865072c59fSSteven Rostedt 
328715d5b02cSSteven Rostedt (Red Hat) void * __weak
328815d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
328915d5b02cSSteven Rostedt (Red Hat) {
329015d5b02cSSteven Rostedt (Red Hat) 	return NULL;
329115d5b02cSSteven Rostedt (Red Hat) }
329215d5b02cSSteven Rostedt (Red Hat) 
329315d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
329415d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
329515d5b02cSSteven Rostedt (Red Hat) {
329615d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
329715d5b02cSSteven Rostedt (Red Hat) 
329815d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
329915d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
330015d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
330115d5b02cSSteven Rostedt (Red Hat) }
330215d5b02cSSteven Rostedt (Red Hat) 
33035072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
33045072c59fSSteven Rostedt {
33050c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
33064aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
33075072c59fSSteven Rostedt 
33088fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
33094aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
33108fc0c701SSteven Rostedt 
33110c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
33128c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3313fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
33148c006cf7SNamhyung Kim 		else
3315fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
33160c75a3edSSteven Rostedt 		return 0;
33170c75a3edSSteven Rostedt 	}
33180c75a3edSSteven Rostedt 
33194aeb6967SSteven Rostedt 	rec = iter->func;
33204aeb6967SSteven Rostedt 
33215072c59fSSteven Rostedt 	if (!rec)
33225072c59fSSteven Rostedt 		return 0;
33235072c59fSSteven Rostedt 
3324647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
33259674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3326030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
332715d5b02cSSteven Rostedt (Red Hat) 
3328f8b8be8aSMasami Hiramatsu 		seq_printf(m, " (%ld)%s%s",
33290376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3330f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3331f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ");
33329674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
33335fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
333439daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
333539daa7b9SSteven Rostedt (Red Hat) 				do {
333639daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
333739daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
333839daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3339030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
334039daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
334139daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
334239daa7b9SSteven Rostedt (Red Hat) 			} else
3343fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3344030f4e1cSSteven Rostedt (Red Hat) 		} else {
3345030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
33469674b2faSSteven Rostedt (Red Hat) 		}
33479674b2faSSteven Rostedt (Red Hat) 	}
33489674b2faSSteven Rostedt (Red Hat) 
3349fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
33505072c59fSSteven Rostedt 
33515072c59fSSteven Rostedt 	return 0;
33525072c59fSSteven Rostedt }
33535072c59fSSteven Rostedt 
335488e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
33555072c59fSSteven Rostedt 	.start = t_start,
33565072c59fSSteven Rostedt 	.next = t_next,
33575072c59fSSteven Rostedt 	.stop = t_stop,
33585072c59fSSteven Rostedt 	.show = t_show,
33595072c59fSSteven Rostedt };
33605072c59fSSteven Rostedt 
3361e309b41dSIngo Molnar static int
33625072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
33635072c59fSSteven Rostedt {
33645072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
33655072c59fSSteven Rostedt 
33664eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
33674eebcc81SSteven Rostedt 		return -ENODEV;
33684eebcc81SSteven Rostedt 
336950e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3370c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3371c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3372c1bc5919SSteven Rostedt (VMware) 
33735072c59fSSteven Rostedt 	iter->pg = ftrace_pages_start;
3374fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
33755072c59fSSteven Rostedt 
3376c1bc5919SSteven Rostedt (VMware) 	return 0;
33775072c59fSSteven Rostedt }
33785072c59fSSteven Rostedt 
3379647bcd03SSteven Rostedt static int
3380647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3381647bcd03SSteven Rostedt {
3382647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3383647bcd03SSteven Rostedt 
338450e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
3385c1bc5919SSteven Rostedt (VMware) 	if (!iter)
3386c1bc5919SSteven Rostedt (VMware) 		return -ENOMEM;
3387c1bc5919SSteven Rostedt (VMware) 
3388647bcd03SSteven Rostedt 	iter->pg = ftrace_pages_start;
3389647bcd03SSteven Rostedt 	iter->flags = FTRACE_ITER_ENABLED;
3390fc13cb0cSSteven Rostedt 	iter->ops = &global_ops;
3391647bcd03SSteven Rostedt 
3392c1bc5919SSteven Rostedt (VMware) 	return 0;
3393647bcd03SSteven Rostedt }
3394647bcd03SSteven Rostedt 
3395fc13cb0cSSteven Rostedt /**
3396fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3397fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3398fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3399fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3400fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3401fc13cb0cSSteven Rostedt  *
3402fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3403fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3404fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3405fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3406fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3407fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3408098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3409fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3410fc13cb0cSSteven Rostedt  */
3411fc13cb0cSSteven Rostedt int
3412f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
34131cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
34145072c59fSSteven Rostedt {
34155072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3416f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
34175072c59fSSteven Rostedt 	int ret = 0;
34185072c59fSSteven Rostedt 
3419f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3420f04f24fbSMasami Hiramatsu 
34214eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
34224eebcc81SSteven Rostedt 		return -ENODEV;
34234eebcc81SSteven Rostedt 
34245072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
34255072c59fSSteven Rostedt 	if (!iter)
34265072c59fSSteven Rostedt 		return -ENOMEM;
34275072c59fSSteven Rostedt 
3428689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
3429689fd8b6S[email protected] 		kfree(iter);
3430689fd8b6S[email protected] 		return -ENOMEM;
3431689fd8b6S[email protected] 	}
3432689fd8b6S[email protected] 
34333f2367baSMasami Hiramatsu 	iter->ops = ops;
34343f2367baSMasami Hiramatsu 	iter->flags = flag;
34353f2367baSMasami Hiramatsu 
343633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
34373f2367baSMasami Hiramatsu 
3438f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
343933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
3440f45948e8SSteven Rostedt 	else
344133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
3442f45948e8SSteven Rostedt 
344333dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3444ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3445ef2fbe16SNamhyung Kim 
3446ef2fbe16SNamhyung Kim 		if (file->f_flags & O_TRUNC)
3447ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3448ef2fbe16SNamhyung Kim 		else
3449ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3450ef2fbe16SNamhyung Kim 
345133dc9b12SSteven Rostedt 		if (!iter->hash) {
345233dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
345333dc9b12SSteven Rostedt 			kfree(iter);
34543f2367baSMasami Hiramatsu 			ret = -ENOMEM;
34553f2367baSMasami Hiramatsu 			goto out_unlock;
345633dc9b12SSteven Rostedt 		}
3457c20489daSSteven Rostedt (VMware) 	} else
3458c20489daSSteven Rostedt (VMware) 		iter->hash = hash;
34591cf41dd7SSteven Rostedt 
34605072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
34615072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
34625072c59fSSteven Rostedt 
34635072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
34645072c59fSSteven Rostedt 		if (!ret) {
34655072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
34665072c59fSSteven Rostedt 			m->private = iter;
346779fe249cSLi Zefan 		} else {
346833dc9b12SSteven Rostedt 			/* Failed */
346933dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
347079fe249cSLi Zefan 			trace_parser_put(&iter->parser);
34715072c59fSSteven Rostedt 			kfree(iter);
347279fe249cSLi Zefan 		}
34735072c59fSSteven Rostedt 	} else
34745072c59fSSteven Rostedt 		file->private_data = iter;
34753f2367baSMasami Hiramatsu 
34763f2367baSMasami Hiramatsu  out_unlock:
347733b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
34785072c59fSSteven Rostedt 
34795072c59fSSteven Rostedt 	return ret;
34805072c59fSSteven Rostedt }
34815072c59fSSteven Rostedt 
348241c52c0dSSteven Rostedt static int
348341c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
348441c52c0dSSteven Rostedt {
3485e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3486e3b3e2e8SSteven Rostedt (Red Hat) 
3487e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
348869a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
34891cf41dd7SSteven Rostedt 			inode, file);
349041c52c0dSSteven Rostedt }
349141c52c0dSSteven Rostedt 
349241c52c0dSSteven Rostedt static int
349341c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
349441c52c0dSSteven Rostedt {
3495e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3496e3b3e2e8SSteven Rostedt (Red Hat) 
3497e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
34981cf41dd7SSteven Rostedt 				 inode, file);
349941c52c0dSSteven Rostedt }
350041c52c0dSSteven Rostedt 
35013ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
35023ba00929SDmitry Safonov struct ftrace_glob {
35033ba00929SDmitry Safonov 	char *search;
35043ba00929SDmitry Safonov 	unsigned len;
35053ba00929SDmitry Safonov 	int type;
35063ba00929SDmitry Safonov };
35073ba00929SDmitry Safonov 
35087132e2d6SThiago Jung Bauermann /*
35097132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
35107132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
35117132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
35127132e2d6SThiago Jung Bauermann */
35137132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
35147132e2d6SThiago Jung Bauermann {
35157132e2d6SThiago Jung Bauermann 	return str;
35167132e2d6SThiago Jung Bauermann }
35177132e2d6SThiago Jung Bauermann 
35183ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
35199f4801e3SSteven Rostedt {
35209f4801e3SSteven Rostedt 	int matched = 0;
3521751e9983SLi Zefan 	int slen;
35229f4801e3SSteven Rostedt 
35237132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
35247132e2d6SThiago Jung Bauermann 
35253ba00929SDmitry Safonov 	switch (g->type) {
35269f4801e3SSteven Rostedt 	case MATCH_FULL:
35273ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
35289f4801e3SSteven Rostedt 			matched = 1;
35299f4801e3SSteven Rostedt 		break;
35309f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
35313ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
35329f4801e3SSteven Rostedt 			matched = 1;
35339f4801e3SSteven Rostedt 		break;
35349f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
35353ba00929SDmitry Safonov 		if (strstr(str, g->search))
35369f4801e3SSteven Rostedt 			matched = 1;
35379f4801e3SSteven Rostedt 		break;
35389f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
3539751e9983SLi Zefan 		slen = strlen(str);
35403ba00929SDmitry Safonov 		if (slen >= g->len &&
35413ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
35429f4801e3SSteven Rostedt 			matched = 1;
35439f4801e3SSteven Rostedt 		break;
354460f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
354560f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
354660f1d5e3SMasami Hiramatsu 			matched = 1;
354760f1d5e3SMasami Hiramatsu 		break;
35489f4801e3SSteven Rostedt 	}
35499f4801e3SSteven Rostedt 
35509f4801e3SSteven Rostedt 	return matched;
35519f4801e3SSteven Rostedt }
35529f4801e3SSteven Rostedt 
3553b448c4e3SSteven Rostedt static int
3554f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
355564e7c440SSteven Rostedt {
3556b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
3557b448c4e3SSteven Rostedt 	int ret = 0;
3558b448c4e3SSteven Rostedt 
35591cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
3560f0a3b154SDmitry Safonov 	if (clear_filter) {
3561b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
3562b448c4e3SSteven Rostedt 		if (!entry)
3563b448c4e3SSteven Rostedt 			return 0;
3564b448c4e3SSteven Rostedt 
356533dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
3566b448c4e3SSteven Rostedt 	} else {
3567b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
3568b448c4e3SSteven Rostedt 		if (entry)
3569b448c4e3SSteven Rostedt 			return 0;
3570b448c4e3SSteven Rostedt 
3571b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
3572b448c4e3SSteven Rostedt 	}
3573b448c4e3SSteven Rostedt 	return ret;
3574996e87beSSteven Rostedt }
3575996e87beSSteven Rostedt 
357664e7c440SSteven Rostedt static int
35770b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
35780b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
357964e7c440SSteven Rostedt {
358064e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
3581b9df92d2SSteven Rostedt 	char *modname;
358264e7c440SSteven Rostedt 
3583b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
3584b9df92d2SSteven Rostedt 
35850b507e1eSDmitry Safonov 	if (mod_g) {
35860b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
35870b507e1eSDmitry Safonov 
35880b507e1eSDmitry Safonov 		/* blank module name to match all modules */
35890b507e1eSDmitry Safonov 		if (!mod_g->len) {
35900b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
35910b507e1eSDmitry Safonov 			if ((!exclude_mod) != (!modname))
35920b507e1eSDmitry Safonov 				goto func_match;
35930b507e1eSDmitry Safonov 			return 0;
35940b507e1eSDmitry Safonov 		}
35950b507e1eSDmitry Safonov 
35960b507e1eSDmitry Safonov 		/* not matching the module */
35970b507e1eSDmitry Safonov 		if (!modname || !mod_matches) {
35980b507e1eSDmitry Safonov 			if (exclude_mod)
35990b507e1eSDmitry Safonov 				goto func_match;
36000b507e1eSDmitry Safonov 			else
36010b507e1eSDmitry Safonov 				return 0;
36020b507e1eSDmitry Safonov 		}
36030b507e1eSDmitry Safonov 
36040b507e1eSDmitry Safonov 		if (mod_matches && exclude_mod)
3605b9df92d2SSteven Rostedt 			return 0;
3606b9df92d2SSteven Rostedt 
36070b507e1eSDmitry Safonov func_match:
3608b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
36093ba00929SDmitry Safonov 		if (!func_g->len)
3610b9df92d2SSteven Rostedt 			return 1;
3611b9df92d2SSteven Rostedt 	}
3612b9df92d2SSteven Rostedt 
36133ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
361464e7c440SSteven Rostedt }
361564e7c440SSteven Rostedt 
36161cf41dd7SSteven Rostedt static int
36173ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
36189f4801e3SSteven Rostedt {
36199f4801e3SSteven Rostedt 	struct ftrace_page *pg;
36209f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
36213ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
36220b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
36230b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
36240b507e1eSDmitry Safonov 	int exclude_mod = 0;
3625311d16daSLi Zefan 	int found = 0;
3626b448c4e3SSteven Rostedt 	int ret;
3627f0a3b154SDmitry Safonov 	int clear_filter;
36289f4801e3SSteven Rostedt 
36290b507e1eSDmitry Safonov 	if (func) {
36303ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
36313ba00929SDmitry Safonov 						 &clear_filter);
36323ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
3633b9df92d2SSteven Rostedt 	}
3634b9df92d2SSteven Rostedt 
36350b507e1eSDmitry Safonov 	if (mod) {
36360b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
36370b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
36380b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
3639b9df92d2SSteven Rostedt 	}
3640b9df92d2SSteven Rostedt 
364152baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
3642b9df92d2SSteven Rostedt 
3643b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
3644b9df92d2SSteven Rostedt 		goto out_unlock;
3645b9df92d2SSteven Rostedt 
3646265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3647546fece4SSteven Rostedt (Red Hat) 
3648546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
3649546fece4SSteven Rostedt (Red Hat) 			continue;
3650546fece4SSteven Rostedt (Red Hat) 
36510b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
3652f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
3653b448c4e3SSteven Rostedt 			if (ret < 0) {
3654b448c4e3SSteven Rostedt 				found = ret;
3655b448c4e3SSteven Rostedt 				goto out_unlock;
3656b448c4e3SSteven Rostedt 			}
3657311d16daSLi Zefan 			found = 1;
36585072c59fSSteven Rostedt 		}
3659265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3660b9df92d2SSteven Rostedt  out_unlock:
366152baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3662311d16daSLi Zefan 
3663311d16daSLi Zefan 	return found;
36645072c59fSSteven Rostedt }
36655072c59fSSteven Rostedt 
366664e7c440SSteven Rostedt static int
36671cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
366864e7c440SSteven Rostedt {
3669f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
367064e7c440SSteven Rostedt }
367164e7c440SSteven Rostedt 
367264e7c440SSteven Rostedt 
3673f6180773SSteven Rostedt /*
3674f6180773SSteven Rostedt  * We register the module command as a template to show others how
3675f6180773SSteven Rostedt  * to register the a command as well.
3676f6180773SSteven Rostedt  */
3677f6180773SSteven Rostedt 
3678f6180773SSteven Rostedt static int
367943dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
3680f0a3b154SDmitry Safonov 		    char *func, char *cmd, char *module, int enable)
3681f6180773SSteven Rostedt {
36825e3949f0SDmitry Safonov 	int ret;
3683f6180773SSteven Rostedt 
3684f6180773SSteven Rostedt 	/*
3685f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
3686f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
3687f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
3688f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
3689f6180773SSteven Rostedt 	 * parameter.
3690f6180773SSteven Rostedt 	 */
3691f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
3692b448c4e3SSteven Rostedt 	if (!ret)
36935e3949f0SDmitry Safonov 		return -EINVAL;
3694b448c4e3SSteven Rostedt 	if (ret < 0)
3695b448c4e3SSteven Rostedt 		return ret;
3696f6180773SSteven Rostedt 	return 0;
3697f6180773SSteven Rostedt }
3698f6180773SSteven Rostedt 
3699f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
3700f6180773SSteven Rostedt 	.name			= "mod",
3701f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
3702f6180773SSteven Rostedt };
3703f6180773SSteven Rostedt 
3704f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
3705f6180773SSteven Rostedt {
3706f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
3707f6180773SSteven Rostedt }
37086f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
3709f6180773SSteven Rostedt 
37102f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
3711a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
371259df055fSSteven Rostedt {
3713b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
371459df055fSSteven Rostedt 	struct hlist_head *hhd;
371559df055fSSteven Rostedt 	unsigned long key;
371659df055fSSteven Rostedt 
371759df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
371859df055fSSteven Rostedt 
371959df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
372059df055fSSteven Rostedt 
372159df055fSSteven Rostedt 	if (hlist_empty(hhd))
372259df055fSSteven Rostedt 		return;
372359df055fSSteven Rostedt 
372459df055fSSteven Rostedt 	/*
372559df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
372659df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
372759df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
372859df055fSSteven Rostedt 	 */
37295168ae50SSteven Rostedt 	preempt_disable_notrace();
37301bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, node) {
373159df055fSSteven Rostedt 		if (entry->ip == ip)
373259df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
373359df055fSSteven Rostedt 	}
37345168ae50SSteven Rostedt 	preempt_enable_notrace();
373559df055fSSteven Rostedt }
373659df055fSSteven Rostedt 
3737b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
373859df055fSSteven Rostedt {
3739b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
3740f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_INITIALIZED,
374133b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(trace_probe_ops)
374259df055fSSteven Rostedt };
374359df055fSSteven Rostedt 
3744b6887d79SSteven Rostedt static int ftrace_probe_registered;
374559df055fSSteven Rostedt 
37467485058eSSteven Rostedt (Red Hat) static void __enable_ftrace_function_probe(struct ftrace_ops_hash *old_hash)
374759df055fSSteven Rostedt {
3748b848914cSSteven Rostedt 	int ret;
374959df055fSSteven Rostedt 	int i;
375059df055fSSteven Rostedt 
375119dd603eSSteven Rostedt (Red Hat) 	if (ftrace_probe_registered) {
375219dd603eSSteven Rostedt (Red Hat) 		/* still need to update the function call sites */
375319dd603eSSteven Rostedt (Red Hat) 		if (ftrace_enabled)
37548252ecf3SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(&trace_probe_ops, FTRACE_UPDATE_CALLS,
37558252ecf3SSteven Rostedt (Red Hat) 					       old_hash);
375659df055fSSteven Rostedt 		return;
375719dd603eSSteven Rostedt (Red Hat) 	}
375859df055fSSteven Rostedt 
375959df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
376059df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
376159df055fSSteven Rostedt 		if (hhd->first)
376259df055fSSteven Rostedt 			break;
376359df055fSSteven Rostedt 	}
376459df055fSSteven Rostedt 	/* Nothing registered? */
376559df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
376659df055fSSteven Rostedt 		return;
376759df055fSSteven Rostedt 
3768a1cd6173SSteven Rostedt 	ret = ftrace_startup(&trace_probe_ops, 0);
3769b848914cSSteven Rostedt 
3770b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
377159df055fSSteven Rostedt }
377259df055fSSteven Rostedt 
3773b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
377459df055fSSteven Rostedt {
377559df055fSSteven Rostedt 	int i;
377659df055fSSteven Rostedt 
3777b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
377859df055fSSteven Rostedt 		return;
377959df055fSSteven Rostedt 
378059df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
378159df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
378259df055fSSteven Rostedt 		if (hhd->first)
378359df055fSSteven Rostedt 			return;
378459df055fSSteven Rostedt 	}
378559df055fSSteven Rostedt 
378659df055fSSteven Rostedt 	/* no more funcs left */
3787b848914cSSteven Rostedt 	ftrace_shutdown(&trace_probe_ops, 0);
3788b848914cSSteven Rostedt 
3789b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
379059df055fSSteven Rostedt }
379159df055fSSteven Rostedt 
379259df055fSSteven Rostedt 
37937818b388SSteven Rostedt (Red Hat) static void ftrace_free_entry(struct ftrace_func_probe *entry)
379459df055fSSteven Rostedt {
379559df055fSSteven Rostedt 	if (entry->ops->free)
3796e67efb93SSteven Rostedt (Red Hat) 		entry->ops->free(entry->ops, entry->ip, &entry->data);
379759df055fSSteven Rostedt 	kfree(entry);
379859df055fSSteven Rostedt }
379959df055fSSteven Rostedt 
380059df055fSSteven Rostedt int
3801b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
380259df055fSSteven Rostedt 			      void *data)
380359df055fSSteven Rostedt {
38047485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
3805b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
38063ba00929SDmitry Safonov 	struct ftrace_glob func_g;
380733b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
38083296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
3809e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
381059df055fSSteven Rostedt 	struct ftrace_page *pg;
381159df055fSSteven Rostedt 	struct dyn_ftrace *rec;
38123ba00929SDmitry Safonov 	int not;
38136a24a244SSteven Rostedt 	unsigned long key;
381459df055fSSteven Rostedt 	int count = 0;
3815e1df4cb6SSteven Rostedt (Red Hat) 	int ret;
381659df055fSSteven Rostedt 
38173ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(glob, strlen(glob),
38183ba00929SDmitry Safonov 			&func_g.search, &not);
38193ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
382059df055fSSteven Rostedt 
3821b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
382259df055fSSteven Rostedt 	if (WARN_ON(not))
382359df055fSSteven Rostedt 		return -EINVAL;
382459df055fSSteven Rostedt 
382533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
382659df055fSSteven Rostedt 
38277485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = old_hash;
38287485058eSSteven Rostedt (Red Hat) 	/* Probes only have filters */
38297485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = NULL;
38307485058eSSteven Rostedt (Red Hat) 
38313296fc4eSSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
3832e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash) {
3833e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENOMEM;
38345ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3835e1df4cb6SSteven Rostedt (Red Hat) 	}
3836e1df4cb6SSteven Rostedt (Red Hat) 
3837e1df4cb6SSteven Rostedt (Red Hat) 	if (unlikely(ftrace_disabled)) {
3838e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENODEV;
38395ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3840e1df4cb6SSteven Rostedt (Red Hat) 	}
384145a4a237SSteven Rostedt 
38425ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
38435ae0bf59SSteven Rostedt (Red Hat) 
384459df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
384559df055fSSteven Rostedt 
3846546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
3847546fece4SSteven Rostedt (Red Hat) 			continue;
3848546fece4SSteven Rostedt (Red Hat) 
38490b507e1eSDmitry Safonov 		if (!ftrace_match_record(rec, &func_g, NULL, 0))
385059df055fSSteven Rostedt 			continue;
385159df055fSSteven Rostedt 
385259df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
385359df055fSSteven Rostedt 		if (!entry) {
3854b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
385559df055fSSteven Rostedt 			if (!count)
385659df055fSSteven Rostedt 				count = -ENOMEM;
385759df055fSSteven Rostedt 			goto out_unlock;
385859df055fSSteven Rostedt 		}
385959df055fSSteven Rostedt 
386059df055fSSteven Rostedt 		count++;
386159df055fSSteven Rostedt 
386259df055fSSteven Rostedt 		entry->data = data;
386359df055fSSteven Rostedt 
386459df055fSSteven Rostedt 		/*
386559df055fSSteven Rostedt 		 * The caller might want to do something special
386659df055fSSteven Rostedt 		 * for each function we find. We call the callback
386759df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
386859df055fSSteven Rostedt 		 */
3869e67efb93SSteven Rostedt (Red Hat) 		if (ops->init) {
3870e67efb93SSteven Rostedt (Red Hat) 			if (ops->init(ops, rec->ip, &entry->data) < 0) {
387159df055fSSteven Rostedt 				/* caller does not like this func */
387259df055fSSteven Rostedt 				kfree(entry);
387359df055fSSteven Rostedt 				continue;
387459df055fSSteven Rostedt 			}
387559df055fSSteven Rostedt 		}
387659df055fSSteven Rostedt 
3877e1df4cb6SSteven Rostedt (Red Hat) 		ret = enter_record(hash, rec, 0);
3878e1df4cb6SSteven Rostedt (Red Hat) 		if (ret < 0) {
3879e1df4cb6SSteven Rostedt (Red Hat) 			kfree(entry);
3880e1df4cb6SSteven Rostedt (Red Hat) 			count = ret;
3881e1df4cb6SSteven Rostedt (Red Hat) 			goto out_unlock;
3882e1df4cb6SSteven Rostedt (Red Hat) 		}
3883e1df4cb6SSteven Rostedt (Red Hat) 
388459df055fSSteven Rostedt 		entry->ops = ops;
388559df055fSSteven Rostedt 		entry->ip = rec->ip;
388659df055fSSteven Rostedt 
388759df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
388859df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
388959df055fSSteven Rostedt 
389059df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
3891e1df4cb6SSteven Rostedt (Red Hat) 
3892e1df4cb6SSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
38938252ecf3SSteven Rostedt (Red Hat) 
38947485058eSSteven Rostedt (Red Hat) 	__enable_ftrace_function_probe(&old_hash_ops);
38958252ecf3SSteven Rostedt (Red Hat) 
38963296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
38973296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
38983296fc4eSSteven Rostedt (Red Hat) 	else
3899e1df4cb6SSteven Rostedt (Red Hat) 		count = ret;
3900e1df4cb6SSteven Rostedt (Red Hat) 
390159df055fSSteven Rostedt  out_unlock:
39025ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
39035ae0bf59SSteven Rostedt (Red Hat)  out:
390433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3905e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
390659df055fSSteven Rostedt 
390759df055fSSteven Rostedt 	return count;
390859df055fSSteven Rostedt }
390959df055fSSteven Rostedt 
391059df055fSSteven Rostedt enum {
3911b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
3912b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
391359df055fSSteven Rostedt };
391459df055fSSteven Rostedt 
391559df055fSSteven Rostedt static void
3916b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
391759df055fSSteven Rostedt 				  void *data, int flags)
391859df055fSSteven Rostedt {
3919e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_func_entry *rec_entry;
3920b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
39217818b388SSteven Rostedt (Red Hat) 	struct ftrace_func_probe *p;
39223ba00929SDmitry Safonov 	struct ftrace_glob func_g;
392333b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
39243296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
39257818b388SSteven Rostedt (Red Hat) 	struct list_head free_list;
3926e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
3927b67bfe0dSSasha Levin 	struct hlist_node *tmp;
392859df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
39293ba00929SDmitry Safonov 	int i, ret;
393059df055fSSteven Rostedt 
3931b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
39323ba00929SDmitry Safonov 		func_g.search = NULL;
3933b36461daSAtsushi Tsuji 	else if (glob) {
393459df055fSSteven Rostedt 		int not;
393559df055fSSteven Rostedt 
39363ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
39373ba00929SDmitry Safonov 						 &func_g.search, &not);
39383ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
39393ba00929SDmitry Safonov 		func_g.search = glob;
394059df055fSSteven Rostedt 
3941b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
394259df055fSSteven Rostedt 		if (WARN_ON(not))
394359df055fSSteven Rostedt 			return;
394459df055fSSteven Rostedt 	}
394559df055fSSteven Rostedt 
394633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
3947e1df4cb6SSteven Rostedt (Red Hat) 
3948e1df4cb6SSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3949e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
3950e1df4cb6SSteven Rostedt (Red Hat) 		/* Hmm, should report this somehow */
3951e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
3952e1df4cb6SSteven Rostedt (Red Hat) 
39537818b388SSteven Rostedt (Red Hat) 	INIT_LIST_HEAD(&free_list);
39547818b388SSteven Rostedt (Red Hat) 
395559df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
395659df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
395759df055fSSteven Rostedt 
3958b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tmp, hhd, node) {
395959df055fSSteven Rostedt 
396059df055fSSteven Rostedt 			/* break up if statements for readability */
3961b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
396259df055fSSteven Rostedt 				continue;
396359df055fSSteven Rostedt 
3964b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
396559df055fSSteven Rostedt 				continue;
396659df055fSSteven Rostedt 
396759df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
39683ba00929SDmitry Safonov 			if (func_g.search) {
396959df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
397059df055fSSteven Rostedt 						NULL, str);
39713ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
397259df055fSSteven Rostedt 					continue;
397359df055fSSteven Rostedt 			}
397459df055fSSteven Rostedt 
3975e1df4cb6SSteven Rostedt (Red Hat) 			rec_entry = ftrace_lookup_ip(hash, entry->ip);
3976e1df4cb6SSteven Rostedt (Red Hat) 			/* It is possible more than one entry had this ip */
3977e1df4cb6SSteven Rostedt (Red Hat) 			if (rec_entry)
3978e1df4cb6SSteven Rostedt (Red Hat) 				free_hash_entry(hash, rec_entry);
3979e1df4cb6SSteven Rostedt (Red Hat) 
3980740466bcSSteven Rostedt (Red Hat) 			hlist_del_rcu(&entry->node);
39817818b388SSteven Rostedt (Red Hat) 			list_add(&entry->free_list, &free_list);
398259df055fSSteven Rostedt 		}
398359df055fSSteven Rostedt 	}
39843f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
3985b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
3986e1df4cb6SSteven Rostedt (Red Hat) 	/*
3987e1df4cb6SSteven Rostedt (Red Hat) 	 * Remove after the disable is called. Otherwise, if the last
3988e1df4cb6SSteven Rostedt (Red Hat) 	 * probe is removed, a null hash means *all enabled*.
3989e1df4cb6SSteven Rostedt (Red Hat) 	 */
39903296fc4eSSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
39917818b388SSteven Rostedt (Red Hat) 	synchronize_sched();
39923296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
39933296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
39943296fc4eSSteven Rostedt (Red Hat) 
39957818b388SSteven Rostedt (Red Hat) 	list_for_each_entry_safe(entry, p, &free_list, free_list) {
39967818b388SSteven Rostedt (Red Hat) 		list_del(&entry->free_list);
39977818b388SSteven Rostedt (Red Hat) 		ftrace_free_entry(entry);
39987818b388SSteven Rostedt (Red Hat) 	}
39993f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
40007818b388SSteven Rostedt (Red Hat) 
4001e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
400233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
4003e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
400459df055fSSteven Rostedt }
400559df055fSSteven Rostedt 
400659df055fSSteven Rostedt void
4007b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
400859df055fSSteven Rostedt 				void *data)
400959df055fSSteven Rostedt {
4010b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
4011b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
401259df055fSSteven Rostedt }
401359df055fSSteven Rostedt 
401459df055fSSteven Rostedt void
4015b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
401659df055fSSteven Rostedt {
4017b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
401859df055fSSteven Rostedt }
401959df055fSSteven Rostedt 
4020b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
402159df055fSSteven Rostedt {
4022b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
402359df055fSSteven Rostedt }
402459df055fSSteven Rostedt 
4025f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4026f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4027f6180773SSteven Rostedt 
402838de93abSTom Zanussi /*
402938de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
403038de93abSTom Zanussi  * __init too.
403138de93abSTom Zanussi  */
403238de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4033f6180773SSteven Rostedt {
4034f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4035f6180773SSteven Rostedt 	int ret = 0;
4036f6180773SSteven Rostedt 
4037f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4038f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4039f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4040f6180773SSteven Rostedt 			ret = -EBUSY;
4041f6180773SSteven Rostedt 			goto out_unlock;
4042f6180773SSteven Rostedt 		}
4043f6180773SSteven Rostedt 	}
4044f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4045f6180773SSteven Rostedt  out_unlock:
4046f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4047f6180773SSteven Rostedt 
4048f6180773SSteven Rostedt 	return ret;
4049f6180773SSteven Rostedt }
4050f6180773SSteven Rostedt 
405138de93abSTom Zanussi /*
405238de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
405338de93abSTom Zanussi  * this __init too.
405438de93abSTom Zanussi  */
405538de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4056f6180773SSteven Rostedt {
4057f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4058f6180773SSteven Rostedt 	int ret = -ENODEV;
4059f6180773SSteven Rostedt 
4060f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4061f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4062f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4063f6180773SSteven Rostedt 			ret = 0;
4064f6180773SSteven Rostedt 			list_del_init(&p->list);
4065f6180773SSteven Rostedt 			goto out_unlock;
4066f6180773SSteven Rostedt 		}
4067f6180773SSteven Rostedt 	}
4068f6180773SSteven Rostedt  out_unlock:
4069f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4070f6180773SSteven Rostedt 
4071f6180773SSteven Rostedt 	return ret;
4072f6180773SSteven Rostedt }
4073f6180773SSteven Rostedt 
407433dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
407533dc9b12SSteven Rostedt 				char *buff, int len, int enable)
407664e7c440SSteven Rostedt {
4077f6180773SSteven Rostedt 	char *func, *command, *next = buff;
40786a24a244SSteven Rostedt 	struct ftrace_func_command *p;
40790aff1c0cSGuoWen Li 	int ret = -EINVAL;
408064e7c440SSteven Rostedt 
408164e7c440SSteven Rostedt 	func = strsep(&next, ":");
408264e7c440SSteven Rostedt 
408364e7c440SSteven Rostedt 	if (!next) {
40841cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
4085b448c4e3SSteven Rostedt 		if (!ret)
4086b448c4e3SSteven Rostedt 			ret = -EINVAL;
4087b448c4e3SSteven Rostedt 		if (ret < 0)
4088311d16daSLi Zefan 			return ret;
4089b448c4e3SSteven Rostedt 		return 0;
409064e7c440SSteven Rostedt 	}
409164e7c440SSteven Rostedt 
4092f6180773SSteven Rostedt 	/* command found */
409364e7c440SSteven Rostedt 
409464e7c440SSteven Rostedt 	command = strsep(&next, ":");
409564e7c440SSteven Rostedt 
4096f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4097f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4098f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
409943dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
4100f6180773SSteven Rostedt 			goto out_unlock;
410164e7c440SSteven Rostedt 		}
4102f6180773SSteven Rostedt 	}
4103f6180773SSteven Rostedt  out_unlock:
4104f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
410564e7c440SSteven Rostedt 
4106f6180773SSteven Rostedt 	return ret;
410764e7c440SSteven Rostedt }
410864e7c440SSteven Rostedt 
4109e309b41dSIngo Molnar static ssize_t
411041c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
411141c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
41125072c59fSSteven Rostedt {
41135072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
4114689fd8b6S[email protected] 	struct trace_parser *parser;
4115689fd8b6S[email protected] 	ssize_t ret, read;
41165072c59fSSteven Rostedt 
41174ba7978eSLi Zefan 	if (!cnt)
41185072c59fSSteven Rostedt 		return 0;
41195072c59fSSteven Rostedt 
41205072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
41215072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
41225072c59fSSteven Rostedt 		iter = m->private;
41235072c59fSSteven Rostedt 	} else
41245072c59fSSteven Rostedt 		iter = file->private_data;
41255072c59fSSteven Rostedt 
4126f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
41273f2367baSMasami Hiramatsu 		return -ENODEV;
41283f2367baSMasami Hiramatsu 
41293f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
4130f04f24fbSMasami Hiramatsu 
4131689fd8b6S[email protected] 	parser = &iter->parser;
4132689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
41335072c59fSSteven Rostedt 
41344ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
4135689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
413633dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
4137689fd8b6S[email protected] 					   parser->idx, enable);
4138313254a9SLi Zefan 		trace_parser_clear(parser);
41397c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
41403f2367baSMasami Hiramatsu 			goto out;
41415072c59fSSteven Rostedt 	}
41425072c59fSSteven Rostedt 
41435072c59fSSteven Rostedt 	ret = read;
41443f2367baSMasami Hiramatsu  out:
41455072c59fSSteven Rostedt 	return ret;
41465072c59fSSteven Rostedt }
41475072c59fSSteven Rostedt 
4148fc13cb0cSSteven Rostedt ssize_t
414941c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
415041c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
415141c52c0dSSteven Rostedt {
415241c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
415341c52c0dSSteven Rostedt }
415441c52c0dSSteven Rostedt 
4155fc13cb0cSSteven Rostedt ssize_t
415641c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
415741c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
415841c52c0dSSteven Rostedt {
415941c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
416041c52c0dSSteven Rostedt }
416141c52c0dSSteven Rostedt 
416233dc9b12SSteven Rostedt static int
4163647664eaSMasami Hiramatsu ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
4164647664eaSMasami Hiramatsu {
4165647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
4166647664eaSMasami Hiramatsu 
4167647664eaSMasami Hiramatsu 	if (!ftrace_location(ip))
4168647664eaSMasami Hiramatsu 		return -EINVAL;
4169647664eaSMasami Hiramatsu 
4170647664eaSMasami Hiramatsu 	if (remove) {
4171647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
4172647664eaSMasami Hiramatsu 		if (!entry)
4173647664eaSMasami Hiramatsu 			return -ENOENT;
4174647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
4175647664eaSMasami Hiramatsu 		return 0;
4176647664eaSMasami Hiramatsu 	}
4177647664eaSMasami Hiramatsu 
4178647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
4179647664eaSMasami Hiramatsu }
4180647664eaSMasami Hiramatsu 
41818252ecf3SSteven Rostedt (Red Hat) static void ftrace_ops_update_code(struct ftrace_ops *ops,
41827485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
41831c80c432SSteven Rostedt (Red Hat) {
41848f86f837SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
41858f86f837SSteven Rostedt (Red Hat) 
41868f86f837SSteven Rostedt (Red Hat) 	if (!ftrace_enabled)
41878f86f837SSteven Rostedt (Red Hat) 		return;
41888f86f837SSteven Rostedt (Red Hat) 
41898f86f837SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
41908252ecf3SSteven Rostedt (Red Hat) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
41918f86f837SSteven Rostedt (Red Hat) 		return;
41928f86f837SSteven Rostedt (Red Hat) 	}
41938f86f837SSteven Rostedt (Red Hat) 
41948f86f837SSteven Rostedt (Red Hat) 	/*
41958f86f837SSteven Rostedt (Red Hat) 	 * If this is the shared global_ops filter, then we need to
41968f86f837SSteven Rostedt (Red Hat) 	 * check if there is another ops that shares it, is enabled.
41978f86f837SSteven Rostedt (Red Hat) 	 * If so, we still need to run the modify code.
41988f86f837SSteven Rostedt (Red Hat) 	 */
41998f86f837SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
42008f86f837SSteven Rostedt (Red Hat) 		return;
42018f86f837SSteven Rostedt (Red Hat) 
42028f86f837SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
42038f86f837SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash &&
42048f86f837SSteven Rostedt (Red Hat) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
42058f86f837SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
42068f86f837SSteven Rostedt (Red Hat) 			/* Only need to do this once */
42078f86f837SSteven Rostedt (Red Hat) 			return;
42088f86f837SSteven Rostedt (Red Hat) 		}
42098f86f837SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
42101c80c432SSteven Rostedt (Red Hat) }
42111c80c432SSteven Rostedt (Red Hat) 
4212647664eaSMasami Hiramatsu static int
4213647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
4214647664eaSMasami Hiramatsu 		unsigned long ip, int remove, int reset, int enable)
421541c52c0dSSteven Rostedt {
421633dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
42177485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
42183296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4219f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
422033dc9b12SSteven Rostedt 	int ret;
4221f45948e8SSteven Rostedt 
422241c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
422333dc9b12SSteven Rostedt 		return -ENODEV;
422441c52c0dSSteven Rostedt 
422533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
42263f2367baSMasami Hiramatsu 
4227f45948e8SSteven Rostedt 	if (enable)
422833b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
4229f45948e8SSteven Rostedt 	else
423033b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
423133dc9b12SSteven Rostedt 
4232b972cc58SWang Nan 	if (reset)
4233b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
4234b972cc58SWang Nan 	else
423533dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
4236b972cc58SWang Nan 
42373f2367baSMasami Hiramatsu 	if (!hash) {
42383f2367baSMasami Hiramatsu 		ret = -ENOMEM;
42393f2367baSMasami Hiramatsu 		goto out_regex_unlock;
42403f2367baSMasami Hiramatsu 	}
4241f45948e8SSteven Rostedt 
4242ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
4243ac483c44SJiri Olsa 		ret = -EINVAL;
4244ac483c44SJiri Olsa 		goto out_regex_unlock;
4245ac483c44SJiri Olsa 	}
4246647664eaSMasami Hiramatsu 	if (ip) {
4247647664eaSMasami Hiramatsu 		ret = ftrace_match_addr(hash, ip, remove);
4248647664eaSMasami Hiramatsu 		if (ret < 0)
4249647664eaSMasami Hiramatsu 			goto out_regex_unlock;
4250647664eaSMasami Hiramatsu 	}
425133dc9b12SSteven Rostedt 
425233dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
42533296fc4eSSteven Rostedt (Red Hat) 	old_hash = *orig_hash;
42547485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
42557485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
425641fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
42573296fc4eSSteven Rostedt (Red Hat) 	if (!ret) {
42587485058eSSteven Rostedt (Red Hat) 		ftrace_ops_update_code(ops, &old_hash_ops);
42593296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
42603296fc4eSSteven Rostedt (Red Hat) 	}
426133dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
426233dc9b12SSteven Rostedt 
4263ac483c44SJiri Olsa  out_regex_unlock:
426433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
426533dc9b12SSteven Rostedt 
426633dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
426733dc9b12SSteven Rostedt 	return ret;
426841c52c0dSSteven Rostedt }
426941c52c0dSSteven Rostedt 
4270647664eaSMasami Hiramatsu static int
4271647664eaSMasami Hiramatsu ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
4272647664eaSMasami Hiramatsu 		int reset, int enable)
4273647664eaSMasami Hiramatsu {
4274647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
4275647664eaSMasami Hiramatsu }
4276647664eaSMasami Hiramatsu 
4277647664eaSMasami Hiramatsu /**
4278647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
4279647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
4280647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
4281647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
4282647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
4283647664eaSMasami Hiramatsu  *
4284647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
4285647664eaSMasami Hiramatsu  * If @ip is NULL, it failes to update filter.
4286647664eaSMasami Hiramatsu  */
4287647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
4288647664eaSMasami Hiramatsu 			 int remove, int reset)
4289647664eaSMasami Hiramatsu {
4290f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4291647664eaSMasami Hiramatsu 	return ftrace_set_addr(ops, ip, remove, reset, 1);
4292647664eaSMasami Hiramatsu }
4293647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
4294647664eaSMasami Hiramatsu 
4295d032ae89SJoel Fernandes /**
4296d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
4297d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
4298d032ae89SJoel Fernandes  *
4299d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
4300d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
4301d032ae89SJoel Fernandes  */
4302d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
4303d032ae89SJoel Fernandes {
4304d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
4305d032ae89SJoel Fernandes 		return;
4306d032ae89SJoel Fernandes 
4307d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
4308d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
4309d032ae89SJoel Fernandes }
4310d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
4311d032ae89SJoel Fernandes 
4312647664eaSMasami Hiramatsu static int
4313647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4314647664eaSMasami Hiramatsu 		 int reset, int enable)
4315647664eaSMasami Hiramatsu {
4316647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
4317647664eaSMasami Hiramatsu }
4318647664eaSMasami Hiramatsu 
431977a2b37dSSteven Rostedt /**
432077a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
4321936e074bSSteven Rostedt  * @ops - the ops to set the filter with
432277a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
432377a2b37dSSteven Rostedt  * @len - the length of the string.
432477a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
432577a2b37dSSteven Rostedt  *
432677a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
432777a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
432877a2b37dSSteven Rostedt  */
4329ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
4330936e074bSSteven Rostedt 		       int len, int reset)
433177a2b37dSSteven Rostedt {
4332f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4333ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
433441c52c0dSSteven Rostedt }
4335936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
43364eebcc81SSteven Rostedt 
433741c52c0dSSteven Rostedt /**
433841c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
4339936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
434041c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
434141c52c0dSSteven Rostedt  * @len - the length of the string.
434241c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
434341c52c0dSSteven Rostedt  *
434441c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
434541c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
434641c52c0dSSteven Rostedt  * for tracing.
434741c52c0dSSteven Rostedt  */
4348ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
4349936e074bSSteven Rostedt 			int len, int reset)
4350936e074bSSteven Rostedt {
4351f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4352ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
4353936e074bSSteven Rostedt }
4354936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
4355936e074bSSteven Rostedt /**
43568d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
4357936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
4358936e074bSSteven Rostedt  * @len - the length of the string.
4359936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4360936e074bSSteven Rostedt  *
4361936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
4362936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
4363936e074bSSteven Rostedt  */
4364936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
4365936e074bSSteven Rostedt {
4366936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
4367936e074bSSteven Rostedt }
4368936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
4369936e074bSSteven Rostedt 
4370936e074bSSteven Rostedt /**
43718d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
4372936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
4373936e074bSSteven Rostedt  * @len - the length of the string.
4374936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4375936e074bSSteven Rostedt  *
4376936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
4377936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
4378936e074bSSteven Rostedt  * for tracing.
4379936e074bSSteven Rostedt  */
4380936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
438141c52c0dSSteven Rostedt {
4382f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
438377a2b37dSSteven Rostedt }
4384936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
438577a2b37dSSteven Rostedt 
43862af15d6aSSteven Rostedt /*
43872af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
43882af15d6aSSteven Rostedt  */
43892af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
43902af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
43912af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
43922af15d6aSSteven Rostedt 
4393f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
4394f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
4395f1ed7c74SSteven Rostedt (Red Hat) 
43962af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
43972af15d6aSSteven Rostedt {
4398f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
439975761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
44002af15d6aSSteven Rostedt 	return 1;
44012af15d6aSSteven Rostedt }
44022af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
44032af15d6aSSteven Rostedt 
44042af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
44052af15d6aSSteven Rostedt {
4406f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
440775761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
44082af15d6aSSteven Rostedt 	return 1;
44092af15d6aSSteven Rostedt }
44102af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
44112af15d6aSSteven Rostedt 
4412369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4413f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
44140d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
4415b9b0c831SNamhyung Kim static int ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer);
4416801c29fdSSteven Rostedt 
4417f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_trampoline;
4418f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_flags;
4419f3bea491SSteven Rostedt (Red Hat) 
4420369bc18fSStefan Assmann static int __init set_graph_function(char *str)
4421369bc18fSStefan Assmann {
442206f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
4423369bc18fSStefan Assmann 	return 1;
4424369bc18fSStefan Assmann }
4425369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
4426369bc18fSStefan Assmann 
44270d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
44280d7d9a16SNamhyung Kim {
44290d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
44300d7d9a16SNamhyung Kim 	return 1;
44310d7d9a16SNamhyung Kim }
44320d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
44330d7d9a16SNamhyung Kim 
443465a50c65STodd Brandt static int __init set_graph_max_depth_function(char *str)
443565a50c65STodd Brandt {
443665a50c65STodd Brandt 	if (!str)
443765a50c65STodd Brandt 		return 0;
443865a50c65STodd Brandt 	fgraph_max_depth = simple_strtoul(str, NULL, 0);
443965a50c65STodd Brandt 	return 1;
444065a50c65STodd Brandt }
444165a50c65STodd Brandt __setup("ftrace_graph_max_depth=", set_graph_max_depth_function);
444265a50c65STodd Brandt 
44430d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
4444369bc18fSStefan Assmann {
4445369bc18fSStefan Assmann 	int ret;
4446369bc18fSStefan Assmann 	char *func;
4447b9b0c831SNamhyung Kim 	struct ftrace_hash *hash;
44480d7d9a16SNamhyung Kim 
444992ad18ecSSteven Rostedt (VMware) 	hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
445092ad18ecSSteven Rostedt (VMware) 	if (WARN_ON(!hash))
445192ad18ecSSteven Rostedt (VMware) 		return;
4452369bc18fSStefan Assmann 
4453369bc18fSStefan Assmann 	while (buf) {
4454369bc18fSStefan Assmann 		func = strsep(&buf, ",");
4455369bc18fSStefan Assmann 		/* we allow only one expression at a time */
4456b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(hash, func);
4457369bc18fSStefan Assmann 		if (ret)
4458369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
4459369bc18fSStefan Assmann 					  "traceable\n", func);
4460369bc18fSStefan Assmann 	}
446192ad18ecSSteven Rostedt (VMware) 
446292ad18ecSSteven Rostedt (VMware) 	if (enable)
446392ad18ecSSteven Rostedt (VMware) 		ftrace_graph_hash = hash;
446492ad18ecSSteven Rostedt (VMware) 	else
446592ad18ecSSteven Rostedt (VMware) 		ftrace_graph_notrace_hash = hash;
4466369bc18fSStefan Assmann }
4467369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4468369bc18fSStefan Assmann 
44692a85a37fSSteven Rostedt void __init
44702a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
44712af15d6aSSteven Rostedt {
44722af15d6aSSteven Rostedt 	char *func;
44732af15d6aSSteven Rostedt 
4474f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4475f04f24fbSMasami Hiramatsu 
44762af15d6aSSteven Rostedt 	while (buf) {
44772af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
4478f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
44792af15d6aSSteven Rostedt 	}
44802af15d6aSSteven Rostedt }
44812af15d6aSSteven Rostedt 
44822af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
44832af15d6aSSteven Rostedt {
44842af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
44852a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
44862af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
44872a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
4488369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4489369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
44900d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
44910d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
44920d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
4493369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
44942af15d6aSSteven Rostedt }
44952af15d6aSSteven Rostedt 
4496fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
44975072c59fSSteven Rostedt {
44985072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
44997485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
45005072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
450133dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
45023296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4503689fd8b6S[email protected] 	struct trace_parser *parser;
4504ed926f9bSSteven Rostedt 	int filter_hash;
450533dc9b12SSteven Rostedt 	int ret;
45065072c59fSSteven Rostedt 
45075072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
45085072c59fSSteven Rostedt 		iter = m->private;
45095072c59fSSteven Rostedt 		seq_release(inode, file);
45105072c59fSSteven Rostedt 	} else
45115072c59fSSteven Rostedt 		iter = file->private_data;
45125072c59fSSteven Rostedt 
4513689fd8b6S[email protected] 	parser = &iter->parser;
4514689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
4515689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
45161cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
45175072c59fSSteven Rostedt 	}
45185072c59fSSteven Rostedt 
4519058e297dSSteven Rostedt 	trace_parser_put(parser);
4520058e297dSSteven Rostedt 
452133b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
45223f2367baSMasami Hiramatsu 
4523058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4524ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
4525ed926f9bSSteven Rostedt 
4526ed926f9bSSteven Rostedt 		if (filter_hash)
452733b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
4528ed926f9bSSteven Rostedt 		else
452933b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
453033dc9b12SSteven Rostedt 
4531e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
45323296fc4eSSteven Rostedt (Red Hat) 		old_hash = *orig_hash;
45337485058eSSteven Rostedt (Red Hat) 		old_hash_ops.filter_hash = iter->ops->func_hash->filter_hash;
45347485058eSSteven Rostedt (Red Hat) 		old_hash_ops.notrace_hash = iter->ops->func_hash->notrace_hash;
453541fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
453641fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
45373296fc4eSSteven Rostedt (Red Hat) 		if (!ret) {
45387485058eSSteven Rostedt (Red Hat) 			ftrace_ops_update_code(iter->ops, &old_hash_ops);
45393296fc4eSSteven Rostedt (Red Hat) 			free_ftrace_hash_rcu(old_hash);
45403296fc4eSSteven Rostedt (Red Hat) 		}
4541e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
4542c20489daSSteven Rostedt (VMware) 	} else {
4543c20489daSSteven Rostedt (VMware) 		/* For read only, the hash is the ops hash */
4544c20489daSSteven Rostedt (VMware) 		iter->hash = NULL;
4545058e297dSSteven Rostedt 	}
45463f2367baSMasami Hiramatsu 
454733b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
454833dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
454933dc9b12SSteven Rostedt 	kfree(iter);
4550689fd8b6S[email protected] 
45515072c59fSSteven Rostedt 	return 0;
45525072c59fSSteven Rostedt }
45535072c59fSSteven Rostedt 
45545e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
45555072c59fSSteven Rostedt 	.open = ftrace_avail_open,
45565072c59fSSteven Rostedt 	.read = seq_read,
45575072c59fSSteven Rostedt 	.llseek = seq_lseek,
45583be04b47SLi Zefan 	.release = seq_release_private,
45595072c59fSSteven Rostedt };
45605072c59fSSteven Rostedt 
4561647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
4562647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
4563647bcd03SSteven Rostedt 	.read = seq_read,
4564647bcd03SSteven Rostedt 	.llseek = seq_lseek,
4565647bcd03SSteven Rostedt 	.release = seq_release_private,
4566647bcd03SSteven Rostedt };
4567647bcd03SSteven Rostedt 
45685e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
45695072c59fSSteven Rostedt 	.open = ftrace_filter_open,
4570850a80cfSLai Jiangshan 	.read = seq_read,
45715072c59fSSteven Rostedt 	.write = ftrace_filter_write,
4572098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
45731cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
45745072c59fSSteven Rostedt };
45755072c59fSSteven Rostedt 
45765e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
457741c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
4578850a80cfSLai Jiangshan 	.read = seq_read,
457941c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
4580098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
45811cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
458241c52c0dSSteven Rostedt };
458341c52c0dSSteven Rostedt 
4584ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4585ea4e2bc4SSteven Rostedt 
4586ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
4587ea4e2bc4SSteven Rostedt 
4588b9b0c831SNamhyung Kim struct ftrace_hash *ftrace_graph_hash = EMPTY_HASH;
4589b9b0c831SNamhyung Kim struct ftrace_hash *ftrace_graph_notrace_hash = EMPTY_HASH;
4590b9b0c831SNamhyung Kim 
4591b9b0c831SNamhyung Kim enum graph_filter_type {
4592b9b0c831SNamhyung Kim 	GRAPH_FILTER_NOTRACE	= 0,
4593b9b0c831SNamhyung Kim 	GRAPH_FILTER_FUNCTION,
4594b9b0c831SNamhyung Kim };
4595ea4e2bc4SSteven Rostedt 
4596555fc781SSteven Rostedt (VMware) #define FTRACE_GRAPH_EMPTY	((void *)1)
4597555fc781SSteven Rostedt (VMware) 
4598faf982a6SNamhyung Kim struct ftrace_graph_data {
4599b9b0c831SNamhyung Kim 	struct ftrace_hash		*hash;
4600b9b0c831SNamhyung Kim 	struct ftrace_func_entry	*entry;
4601b9b0c831SNamhyung Kim 	int				idx;   /* for hash table iteration */
4602b9b0c831SNamhyung Kim 	enum graph_filter_type		type;
4603b9b0c831SNamhyung Kim 	struct ftrace_hash		*new_hash;
4604faf982a6SNamhyung Kim 	const struct seq_operations	*seq_ops;
4605e704eff3SSteven Rostedt (VMware) 	struct trace_parser		parser;
4606faf982a6SNamhyung Kim };
4607faf982a6SNamhyung Kim 
4608ea4e2bc4SSteven Rostedt static void *
460985951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
4610ea4e2bc4SSteven Rostedt {
4611faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4612b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = fgd->entry;
4613b9b0c831SNamhyung Kim 	struct hlist_head *head;
4614b9b0c831SNamhyung Kim 	int i, idx = fgd->idx;
4615faf982a6SNamhyung Kim 
4616b9b0c831SNamhyung Kim 	if (*pos >= fgd->hash->count)
4617ea4e2bc4SSteven Rostedt 		return NULL;
4618b9b0c831SNamhyung Kim 
4619b9b0c831SNamhyung Kim 	if (entry) {
4620b9b0c831SNamhyung Kim 		hlist_for_each_entry_continue(entry, hlist) {
4621b9b0c831SNamhyung Kim 			fgd->entry = entry;
4622b9b0c831SNamhyung Kim 			return entry;
4623b9b0c831SNamhyung Kim 		}
4624b9b0c831SNamhyung Kim 
4625b9b0c831SNamhyung Kim 		idx++;
4626b9b0c831SNamhyung Kim 	}
4627b9b0c831SNamhyung Kim 
4628b9b0c831SNamhyung Kim 	for (i = idx; i < 1 << fgd->hash->size_bits; i++) {
4629b9b0c831SNamhyung Kim 		head = &fgd->hash->buckets[i];
4630b9b0c831SNamhyung Kim 		hlist_for_each_entry(entry, head, hlist) {
4631b9b0c831SNamhyung Kim 			fgd->entry = entry;
4632b9b0c831SNamhyung Kim 			fgd->idx = i;
4633b9b0c831SNamhyung Kim 			return entry;
4634b9b0c831SNamhyung Kim 		}
4635b9b0c831SNamhyung Kim 	}
4636b9b0c831SNamhyung Kim 	return NULL;
463785951842SLi Zefan }
4638ea4e2bc4SSteven Rostedt 
463985951842SLi Zefan static void *
464085951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
464185951842SLi Zefan {
464285951842SLi Zefan 	(*pos)++;
464385951842SLi Zefan 	return __g_next(m, pos);
4644ea4e2bc4SSteven Rostedt }
4645ea4e2bc4SSteven Rostedt 
4646ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
4647ea4e2bc4SSteven Rostedt {
4648faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4649faf982a6SNamhyung Kim 
4650ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4651ea4e2bc4SSteven Rostedt 
4652649b988bSSteven Rostedt (VMware) 	if (fgd->type == GRAPH_FILTER_FUNCTION)
4653649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
4654649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4655649b988bSSteven Rostedt (VMware) 	else
4656649b988bSSteven Rostedt (VMware) 		fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
4657649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4658649b988bSSteven Rostedt (VMware) 
4659f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
4660b9b0c831SNamhyung Kim 	if (ftrace_hash_empty(fgd->hash) && !*pos)
4661555fc781SSteven Rostedt (VMware) 		return FTRACE_GRAPH_EMPTY;
4662f9349a8fSFrederic Weisbecker 
4663b9b0c831SNamhyung Kim 	fgd->idx = 0;
4664b9b0c831SNamhyung Kim 	fgd->entry = NULL;
466585951842SLi Zefan 	return __g_next(m, pos);
4666ea4e2bc4SSteven Rostedt }
4667ea4e2bc4SSteven Rostedt 
4668ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
4669ea4e2bc4SSteven Rostedt {
4670ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4671ea4e2bc4SSteven Rostedt }
4672ea4e2bc4SSteven Rostedt 
4673ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
4674ea4e2bc4SSteven Rostedt {
4675b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry = v;
4676ea4e2bc4SSteven Rostedt 
4677b9b0c831SNamhyung Kim 	if (!entry)
4678ea4e2bc4SSteven Rostedt 		return 0;
4679ea4e2bc4SSteven Rostedt 
4680555fc781SSteven Rostedt (VMware) 	if (entry == FTRACE_GRAPH_EMPTY) {
4681280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
4682280d1429SNamhyung Kim 
4683b9b0c831SNamhyung Kim 		if (fgd->type == GRAPH_FILTER_FUNCTION)
4684fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
4685280d1429SNamhyung Kim 		else
4686fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
4687f9349a8fSFrederic Weisbecker 		return 0;
4688f9349a8fSFrederic Weisbecker 	}
4689f9349a8fSFrederic Weisbecker 
4690b9b0c831SNamhyung Kim 	seq_printf(m, "%ps\n", (void *)entry->ip);
4691ea4e2bc4SSteven Rostedt 
4692ea4e2bc4SSteven Rostedt 	return 0;
4693ea4e2bc4SSteven Rostedt }
4694ea4e2bc4SSteven Rostedt 
469588e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
4696ea4e2bc4SSteven Rostedt 	.start = g_start,
4697ea4e2bc4SSteven Rostedt 	.next = g_next,
4698ea4e2bc4SSteven Rostedt 	.stop = g_stop,
4699ea4e2bc4SSteven Rostedt 	.show = g_show,
4700ea4e2bc4SSteven Rostedt };
4701ea4e2bc4SSteven Rostedt 
4702ea4e2bc4SSteven Rostedt static int
4703faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
4704faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
4705ea4e2bc4SSteven Rostedt {
4706ea4e2bc4SSteven Rostedt 	int ret = 0;
4707b9b0c831SNamhyung Kim 	struct ftrace_hash *new_hash = NULL;
4708ea4e2bc4SSteven Rostedt 
4709b9b0c831SNamhyung Kim 	if (file->f_mode & FMODE_WRITE) {
4710b9b0c831SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
4711b9b0c831SNamhyung Kim 
4712e704eff3SSteven Rostedt (VMware) 		if (trace_parser_get_init(&fgd->parser, FTRACE_BUFF_MAX))
4713e704eff3SSteven Rostedt (VMware) 			return -ENOMEM;
4714e704eff3SSteven Rostedt (VMware) 
4715b9b0c831SNamhyung Kim 		if (file->f_flags & O_TRUNC)
4716b9b0c831SNamhyung Kim 			new_hash = alloc_ftrace_hash(size_bits);
4717b9b0c831SNamhyung Kim 		else
4718b9b0c831SNamhyung Kim 			new_hash = alloc_and_copy_ftrace_hash(size_bits,
4719b9b0c831SNamhyung Kim 							      fgd->hash);
4720b9b0c831SNamhyung Kim 		if (!new_hash) {
4721b9b0c831SNamhyung Kim 			ret = -ENOMEM;
4722b9b0c831SNamhyung Kim 			goto out;
4723ea4e2bc4SSteven Rostedt 		}
4724b9b0c831SNamhyung Kim 	}
4725ea4e2bc4SSteven Rostedt 
4726faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4727b9b0c831SNamhyung Kim 		ret = seq_open(file, &ftrace_graph_seq_ops);
4728faf982a6SNamhyung Kim 		if (!ret) {
4729faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
4730faf982a6SNamhyung Kim 			m->private = fgd;
4731b9b0c831SNamhyung Kim 		} else {
4732b9b0c831SNamhyung Kim 			/* Failed */
4733b9b0c831SNamhyung Kim 			free_ftrace_hash(new_hash);
4734b9b0c831SNamhyung Kim 			new_hash = NULL;
4735faf982a6SNamhyung Kim 		}
4736faf982a6SNamhyung Kim 	} else
4737faf982a6SNamhyung Kim 		file->private_data = fgd;
4738a4ec5e0cSLi Zefan 
4739b9b0c831SNamhyung Kim out:
4740e704eff3SSteven Rostedt (VMware) 	if (ret < 0 && file->f_mode & FMODE_WRITE)
4741e704eff3SSteven Rostedt (VMware) 		trace_parser_put(&fgd->parser);
4742e704eff3SSteven Rostedt (VMware) 
4743b9b0c831SNamhyung Kim 	fgd->new_hash = new_hash;
4744649b988bSSteven Rostedt (VMware) 
4745649b988bSSteven Rostedt (VMware) 	/*
4746649b988bSSteven Rostedt (VMware) 	 * All uses of fgd->hash must be taken with the graph_lock
4747649b988bSSteven Rostedt (VMware) 	 * held. The graph_lock is going to be released, so force
4748649b988bSSteven Rostedt (VMware) 	 * fgd->hash to be reinitialized when it is taken again.
4749649b988bSSteven Rostedt (VMware) 	 */
4750649b988bSSteven Rostedt (VMware) 	fgd->hash = NULL;
4751649b988bSSteven Rostedt (VMware) 
4752ea4e2bc4SSteven Rostedt 	return ret;
4753ea4e2bc4SSteven Rostedt }
4754ea4e2bc4SSteven Rostedt 
4755ea4e2bc4SSteven Rostedt static int
4756faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
4757faf982a6SNamhyung Kim {
4758faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
4759b9b0c831SNamhyung Kim 	int ret;
4760faf982a6SNamhyung Kim 
4761faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
4762faf982a6SNamhyung Kim 		return -ENODEV;
4763faf982a6SNamhyung Kim 
4764faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
4765faf982a6SNamhyung Kim 	if (fgd == NULL)
4766faf982a6SNamhyung Kim 		return -ENOMEM;
4767faf982a6SNamhyung Kim 
4768b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
4769b9b0c831SNamhyung Kim 
4770649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_hash,
4771649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4772b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_FUNCTION;
4773faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
4774faf982a6SNamhyung Kim 
4775b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
4776b9b0c831SNamhyung Kim 	if (ret < 0)
4777b9b0c831SNamhyung Kim 		kfree(fgd);
4778b9b0c831SNamhyung Kim 
4779b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
4780b9b0c831SNamhyung Kim 	return ret;
4781faf982a6SNamhyung Kim }
4782faf982a6SNamhyung Kim 
4783faf982a6SNamhyung Kim static int
478429ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
478529ad23b0SNamhyung Kim {
478629ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
4787b9b0c831SNamhyung Kim 	int ret;
478829ad23b0SNamhyung Kim 
478929ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
479029ad23b0SNamhyung Kim 		return -ENODEV;
479129ad23b0SNamhyung Kim 
479229ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
479329ad23b0SNamhyung Kim 	if (fgd == NULL)
479429ad23b0SNamhyung Kim 		return -ENOMEM;
479529ad23b0SNamhyung Kim 
4796b9b0c831SNamhyung Kim 	mutex_lock(&graph_lock);
4797b9b0c831SNamhyung Kim 
4798649b988bSSteven Rostedt (VMware) 	fgd->hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
4799649b988bSSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4800b9b0c831SNamhyung Kim 	fgd->type = GRAPH_FILTER_NOTRACE;
480129ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
480229ad23b0SNamhyung Kim 
4803b9b0c831SNamhyung Kim 	ret = __ftrace_graph_open(inode, file, fgd);
4804b9b0c831SNamhyung Kim 	if (ret < 0)
4805b9b0c831SNamhyung Kim 		kfree(fgd);
4806b9b0c831SNamhyung Kim 
4807b9b0c831SNamhyung Kim 	mutex_unlock(&graph_lock);
4808b9b0c831SNamhyung Kim 	return ret;
480929ad23b0SNamhyung Kim }
481029ad23b0SNamhyung Kim 
481129ad23b0SNamhyung Kim static int
481287827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
481387827111SLi Zefan {
4814b9b0c831SNamhyung Kim 	struct ftrace_graph_data *fgd;
4815e704eff3SSteven Rostedt (VMware) 	struct ftrace_hash *old_hash, *new_hash;
4816e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
4817e704eff3SSteven Rostedt (VMware) 	int ret = 0;
4818b9b0c831SNamhyung Kim 
4819faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4820faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
4821faf982a6SNamhyung Kim 
4822b9b0c831SNamhyung Kim 		fgd = m->private;
482387827111SLi Zefan 		seq_release(inode, file);
4824faf982a6SNamhyung Kim 	} else {
4825b9b0c831SNamhyung Kim 		fgd = file->private_data;
4826faf982a6SNamhyung Kim 	}
4827faf982a6SNamhyung Kim 
4828e704eff3SSteven Rostedt (VMware) 
4829e704eff3SSteven Rostedt (VMware) 	if (file->f_mode & FMODE_WRITE) {
4830e704eff3SSteven Rostedt (VMware) 
4831e704eff3SSteven Rostedt (VMware) 		parser = &fgd->parser;
4832e704eff3SSteven Rostedt (VMware) 
4833e704eff3SSteven Rostedt (VMware) 		if (trace_parser_loaded((parser))) {
4834e704eff3SSteven Rostedt (VMware) 			parser->buffer[parser->idx] = 0;
4835e704eff3SSteven Rostedt (VMware) 			ret = ftrace_graph_set_hash(fgd->new_hash,
4836e704eff3SSteven Rostedt (VMware) 						    parser->buffer);
4837e704eff3SSteven Rostedt (VMware) 		}
4838e704eff3SSteven Rostedt (VMware) 
4839e704eff3SSteven Rostedt (VMware) 		trace_parser_put(parser);
4840e704eff3SSteven Rostedt (VMware) 
4841e704eff3SSteven Rostedt (VMware) 		new_hash = __ftrace_hash_move(fgd->new_hash);
4842e704eff3SSteven Rostedt (VMware) 		if (!new_hash) {
4843e704eff3SSteven Rostedt (VMware) 			ret = -ENOMEM;
4844e704eff3SSteven Rostedt (VMware) 			goto out;
4845e704eff3SSteven Rostedt (VMware) 		}
4846e704eff3SSteven Rostedt (VMware) 
4847e704eff3SSteven Rostedt (VMware) 		mutex_lock(&graph_lock);
4848e704eff3SSteven Rostedt (VMware) 
4849e704eff3SSteven Rostedt (VMware) 		if (fgd->type == GRAPH_FILTER_FUNCTION) {
4850e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_hash,
4851e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4852e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_hash, new_hash);
4853e704eff3SSteven Rostedt (VMware) 		} else {
4854e704eff3SSteven Rostedt (VMware) 			old_hash = rcu_dereference_protected(ftrace_graph_notrace_hash,
4855e704eff3SSteven Rostedt (VMware) 					lockdep_is_held(&graph_lock));
4856e704eff3SSteven Rostedt (VMware) 			rcu_assign_pointer(ftrace_graph_notrace_hash, new_hash);
4857e704eff3SSteven Rostedt (VMware) 		}
4858e704eff3SSteven Rostedt (VMware) 
4859e704eff3SSteven Rostedt (VMware) 		mutex_unlock(&graph_lock);
4860e704eff3SSteven Rostedt (VMware) 
4861e704eff3SSteven Rostedt (VMware) 		/* Wait till all users are no longer using the old hash */
4862e704eff3SSteven Rostedt (VMware) 		synchronize_sched();
4863e704eff3SSteven Rostedt (VMware) 
4864e704eff3SSteven Rostedt (VMware) 		free_ftrace_hash(old_hash);
4865e704eff3SSteven Rostedt (VMware) 	}
4866e704eff3SSteven Rostedt (VMware) 
4867e704eff3SSteven Rostedt (VMware)  out:
4868b9b0c831SNamhyung Kim 	kfree(fgd->new_hash);
4869b9b0c831SNamhyung Kim 	kfree(fgd);
4870b9b0c831SNamhyung Kim 
4871e704eff3SSteven Rostedt (VMware) 	return ret;
487287827111SLi Zefan }
487387827111SLi Zefan 
487487827111SLi Zefan static int
4875b9b0c831SNamhyung Kim ftrace_graph_set_hash(struct ftrace_hash *hash, char *buffer)
4876ea4e2bc4SSteven Rostedt {
48773ba00929SDmitry Safonov 	struct ftrace_glob func_g;
4878ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
4879ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
4880b9b0c831SNamhyung Kim 	struct ftrace_func_entry *entry;
4881c7c6b1feSLi Zefan 	int fail = 1;
48823ba00929SDmitry Safonov 	int not;
4883ea4e2bc4SSteven Rostedt 
4884f9349a8fSFrederic Weisbecker 	/* decode regex */
48853ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
48863ba00929SDmitry Safonov 					 &func_g.search, &not);
4887f9349a8fSFrederic Weisbecker 
48883ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
4889f9349a8fSFrederic Weisbecker 
489052baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
489145a4a237SSteven Rostedt 
489245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
489345a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
489445a4a237SSteven Rostedt 		return -ENODEV;
489545a4a237SSteven Rostedt 	}
489645a4a237SSteven Rostedt 
4897265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4898ea4e2bc4SSteven Rostedt 
4899546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4900546fece4SSteven Rostedt (Red Hat) 			continue;
4901546fece4SSteven Rostedt (Red Hat) 
49020b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
4903b9b0c831SNamhyung Kim 			entry = ftrace_lookup_ip(hash, rec->ip);
4904c7c6b1feSLi Zefan 
4905c7c6b1feSLi Zefan 			if (!not) {
4906c7c6b1feSLi Zefan 				fail = 0;
4907b9b0c831SNamhyung Kim 
4908b9b0c831SNamhyung Kim 				if (entry)
4909b9b0c831SNamhyung Kim 					continue;
4910b9b0c831SNamhyung Kim 				if (add_hash_entry(hash, rec->ip) < 0)
4911c7c6b1feSLi Zefan 					goto out;
4912c7c6b1feSLi Zefan 			} else {
4913b9b0c831SNamhyung Kim 				if (entry) {
4914b9b0c831SNamhyung Kim 					free_hash_entry(hash, entry);
4915c7c6b1feSLi Zefan 					fail = 0;
4916c7c6b1feSLi Zefan 				}
4917c7c6b1feSLi Zefan 			}
4918f9349a8fSFrederic Weisbecker 		}
4919265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4920c7c6b1feSLi Zefan out:
492152baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4922ea4e2bc4SSteven Rostedt 
4923c7c6b1feSLi Zefan 	if (fail)
4924c7c6b1feSLi Zefan 		return -EINVAL;
4925c7c6b1feSLi Zefan 
4926c7c6b1feSLi Zefan 	return 0;
4927ea4e2bc4SSteven Rostedt }
4928ea4e2bc4SSteven Rostedt 
4929ea4e2bc4SSteven Rostedt static ssize_t
4930ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
4931ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4932ea4e2bc4SSteven Rostedt {
49336a10108bSNamhyung Kim 	ssize_t read, ret = 0;
4934faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
4935e704eff3SSteven Rostedt (VMware) 	struct trace_parser *parser;
4936ea4e2bc4SSteven Rostedt 
4937c7c6b1feSLi Zefan 	if (!cnt)
4938ea4e2bc4SSteven Rostedt 		return 0;
4939ea4e2bc4SSteven Rostedt 
4940ae98d27aSSteven Rostedt (VMware) 	/* Read mode uses seq functions */
4941ae98d27aSSteven Rostedt (VMware) 	if (file->f_mode & FMODE_READ) {
4942ae98d27aSSteven Rostedt (VMware) 		struct seq_file *m = file->private_data;
4943ae98d27aSSteven Rostedt (VMware) 		fgd = m->private;
4944ae98d27aSSteven Rostedt (VMware) 	}
4945ae98d27aSSteven Rostedt (VMware) 
4946e704eff3SSteven Rostedt (VMware) 	parser = &fgd->parser;
4947689fd8b6S[email protected] 
4948e704eff3SSteven Rostedt (VMware) 	read = trace_get_user(parser, ubuf, cnt, ppos);
4949ea4e2bc4SSteven Rostedt 
4950e704eff3SSteven Rostedt (VMware) 	if (read >= 0 && trace_parser_loaded(parser) &&
4951e704eff3SSteven Rostedt (VMware) 	    !trace_parser_cont(parser)) {
49526a10108bSNamhyung Kim 
4953b9b0c831SNamhyung Kim 		ret = ftrace_graph_set_hash(fgd->new_hash,
4954e704eff3SSteven Rostedt (VMware) 					    parser->buffer);
4955e704eff3SSteven Rostedt (VMware) 		trace_parser_clear(parser);
4956689fd8b6S[email protected] 	}
4957ea4e2bc4SSteven Rostedt 
49586a10108bSNamhyung Kim 	if (!ret)
4959ea4e2bc4SSteven Rostedt 		ret = read;
49601eb90f13SLi Zefan 
4961ea4e2bc4SSteven Rostedt 	return ret;
4962ea4e2bc4SSteven Rostedt }
4963ea4e2bc4SSteven Rostedt 
4964ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
4965ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
4966850a80cfSLai Jiangshan 	.read		= seq_read,
4967ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
4968098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
496987827111SLi Zefan 	.release	= ftrace_graph_release,
4970ea4e2bc4SSteven Rostedt };
497129ad23b0SNamhyung Kim 
497229ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
497329ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
497429ad23b0SNamhyung Kim 	.read		= seq_read,
497529ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
4976098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
497729ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
497829ad23b0SNamhyung Kim };
4979ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4980ea4e2bc4SSteven Rostedt 
4981591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
4982591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
4983591dffdaSSteven Rostedt (Red Hat) {
4984591dffdaSSteven Rostedt (Red Hat) 
4985591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_filter", 0644, parent,
4986591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
4987591dffdaSSteven Rostedt (Red Hat) 
4988591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_notrace", 0644, parent,
4989591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
4990591dffdaSSteven Rostedt (Red Hat) }
4991591dffdaSSteven Rostedt (Red Hat) 
4992591dffdaSSteven Rostedt (Red Hat) /*
4993591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
4994591dffdaSSteven Rostedt (Red Hat)  * in the future, it may actualy delete the files, but this is
4995591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
4996591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
4997591dffdaSSteven Rostedt (Red Hat)  * free the ops.
4998591dffdaSSteven Rostedt (Red Hat)  *
4999591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
5000591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
5001591dffdaSSteven Rostedt (Red Hat)  */
5002591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
5003591dffdaSSteven Rostedt (Red Hat) {
5004591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5005591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
5006591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
5007591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
5008591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5009591dffdaSSteven Rostedt (Red Hat) }
5010591dffdaSSteven Rostedt (Red Hat) 
50118434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
50125072c59fSSteven Rostedt {
50135072c59fSSteven Rostedt 
50145452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
50155072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
50165072c59fSSteven Rostedt 
5017647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
5018647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
5019647bcd03SSteven Rostedt 
5020591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
5021ad90c0e3SSteven Rostedt 
5022ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
50235452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
5024ea4e2bc4SSteven Rostedt 				    NULL,
5025ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
502629ad23b0SNamhyung Kim 	trace_create_file("set_graph_notrace", 0444, d_tracer,
502729ad23b0SNamhyung Kim 				    NULL,
502829ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
5029ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
5030ea4e2bc4SSteven Rostedt 
50315072c59fSSteven Rostedt 	return 0;
50325072c59fSSteven Rostedt }
50335072c59fSSteven Rostedt 
50349fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
503568950619SSteven Rostedt {
50369fd49328SSteven Rostedt 	const unsigned long *ipa = a;
50379fd49328SSteven Rostedt 	const unsigned long *ipb = b;
503868950619SSteven Rostedt 
50399fd49328SSteven Rostedt 	if (*ipa > *ipb)
50409fd49328SSteven Rostedt 		return 1;
50419fd49328SSteven Rostedt 	if (*ipa < *ipb)
50429fd49328SSteven Rostedt 		return -1;
50439fd49328SSteven Rostedt 	return 0;
50449fd49328SSteven Rostedt }
50459fd49328SSteven Rostedt 
50465cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
504731e88909SSteven Rostedt 			       unsigned long *start,
504868bf21aaSSteven Rostedt 			       unsigned long *end)
504968bf21aaSSteven Rostedt {
5050706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
5051a7900875SSteven Rostedt 	struct ftrace_page *pg;
5052706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
5053a7900875SSteven Rostedt 	unsigned long count;
505468bf21aaSSteven Rostedt 	unsigned long *p;
505568bf21aaSSteven Rostedt 	unsigned long addr;
50564376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
5057a7900875SSteven Rostedt 	int ret = -ENOMEM;
5058a7900875SSteven Rostedt 
5059a7900875SSteven Rostedt 	count = end - start;
5060a7900875SSteven Rostedt 
5061a7900875SSteven Rostedt 	if (!count)
5062a7900875SSteven Rostedt 		return 0;
5063a7900875SSteven Rostedt 
50649fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
50656db02903SRasmus Villemoes 	     ftrace_cmp_ips, NULL);
50669fd49328SSteven Rostedt 
5067706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
5068706c81f8SSteven Rostedt 	if (!start_pg)
5069a7900875SSteven Rostedt 		return -ENOMEM;
507068bf21aaSSteven Rostedt 
5071e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5072a7900875SSteven Rostedt 
507332082309SSteven Rostedt 	/*
507432082309SSteven Rostedt 	 * Core and each module needs their own pages, as
507532082309SSteven Rostedt 	 * modules will free them when they are removed.
507632082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
507732082309SSteven Rostedt 	 */
5078a7900875SSteven Rostedt 	if (!mod) {
5079a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
5080a7900875SSteven Rostedt 		/* First initialization */
5081706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
5082a7900875SSteven Rostedt 	} else {
508332082309SSteven Rostedt 		if (!ftrace_pages)
5084a7900875SSteven Rostedt 			goto out;
508532082309SSteven Rostedt 
5086a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
5087a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
5088a7900875SSteven Rostedt 			while (ftrace_pages->next)
508932082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
509032082309SSteven Rostedt 		}
5091a7900875SSteven Rostedt 
5092706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
509332082309SSteven Rostedt 	}
509432082309SSteven Rostedt 
509568bf21aaSSteven Rostedt 	p = start;
5096706c81f8SSteven Rostedt 	pg = start_pg;
509768bf21aaSSteven Rostedt 	while (p < end) {
509868bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
509920e5227eSSteven Rostedt 		/*
510020e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
510120e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
510220e5227eSSteven Rostedt 		 * object files to satisfy alignments.
510320e5227eSSteven Rostedt 		 * Skip any NULL pointers.
510420e5227eSSteven Rostedt 		 */
510520e5227eSSteven Rostedt 		if (!addr)
510620e5227eSSteven Rostedt 			continue;
5107706c81f8SSteven Rostedt 
5108706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
5109706c81f8SSteven Rostedt 			/* We should have allocated enough */
5110706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
5111a7900875SSteven Rostedt 				break;
5112706c81f8SSteven Rostedt 			pg = pg->next;
511368bf21aaSSteven Rostedt 		}
511468bf21aaSSteven Rostedt 
5115706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
5116706c81f8SSteven Rostedt 		rec->ip = addr;
5117706c81f8SSteven Rostedt 	}
5118706c81f8SSteven Rostedt 
5119706c81f8SSteven Rostedt 	/* We should have used all pages */
5120706c81f8SSteven Rostedt 	WARN_ON(pg->next);
5121706c81f8SSteven Rostedt 
5122706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
5123706c81f8SSteven Rostedt 	ftrace_pages = pg;
5124706c81f8SSteven Rostedt 
5125a4f18ed1SSteven Rostedt 	/*
51264376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
51274376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
51284376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
51294376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
51304376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
51314376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
5132a4f18ed1SSteven Rostedt 	 */
51334376cac6SSteven Rostedt 	if (!mod)
5134a4f18ed1SSteven Rostedt 		local_irq_save(flags);
51351dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
51364376cac6SSteven Rostedt 	if (!mod)
5137a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
5138a7900875SSteven Rostedt 	ret = 0;
5139a7900875SSteven Rostedt  out:
5140e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
514168bf21aaSSteven Rostedt 
5142a7900875SSteven Rostedt 	return ret;
514368bf21aaSSteven Rostedt }
514468bf21aaSSteven Rostedt 
514593eb677dSSteven Rostedt #ifdef CONFIG_MODULES
514632082309SSteven Rostedt 
514732082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
514832082309SSteven Rostedt 
5149b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
5150b7ffffbbSSteven Rostedt (Red Hat) {
5151b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
5152b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
5153b7ffffbbSSteven Rostedt (Red Hat) 
5154b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
5155b7ffffbbSSteven Rostedt (Red Hat) 		if (ops_references_rec(ops, rec))
5156b7ffffbbSSteven Rostedt (Red Hat) 		    cnt++;
5157b7ffffbbSSteven Rostedt (Red Hat) 	}
5158b7ffffbbSSteven Rostedt (Red Hat) 
5159b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
5160b7ffffbbSSteven Rostedt (Red Hat) }
5161b7ffffbbSSteven Rostedt (Red Hat) 
5162e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
516393eb677dSSteven Rostedt {
516493eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
516532082309SSteven Rostedt 	struct ftrace_page **last_pg;
516693eb677dSSteven Rostedt 	struct ftrace_page *pg;
5167a7900875SSteven Rostedt 	int order;
516893eb677dSSteven Rostedt 
516993eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
517045a4a237SSteven Rostedt 
517145a4a237SSteven Rostedt 	if (ftrace_disabled)
517245a4a237SSteven Rostedt 		goto out_unlock;
517345a4a237SSteven Rostedt 
517432082309SSteven Rostedt 	/*
517532082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
517632082309SSteven Rostedt 	 * them from the list.
517732082309SSteven Rostedt 	 */
517832082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
517932082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
518032082309SSteven Rostedt 		rec = &pg->records[0];
5181e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
518293eb677dSSteven Rostedt 			/*
518332082309SSteven Rostedt 			 * As core pages are first, the first
518432082309SSteven Rostedt 			 * page should never be a module page.
518593eb677dSSteven Rostedt 			 */
518632082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
518732082309SSteven Rostedt 				goto out_unlock;
518832082309SSteven Rostedt 
518932082309SSteven Rostedt 			/* Check if we are deleting the last page */
519032082309SSteven Rostedt 			if (pg == ftrace_pages)
519132082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
519232082309SSteven Rostedt 
519332082309SSteven Rostedt 			*last_pg = pg->next;
5194a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
5195a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
5196a7900875SSteven Rostedt 			kfree(pg);
519732082309SSteven Rostedt 		} else
519832082309SSteven Rostedt 			last_pg = &pg->next;
519993eb677dSSteven Rostedt 	}
520045a4a237SSteven Rostedt  out_unlock:
520193eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
520293eb677dSSteven Rostedt }
520393eb677dSSteven Rostedt 
52047dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
5205b7ffffbbSSteven Rostedt (Red Hat) {
5206b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
5207b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
5208b7ffffbbSSteven Rostedt (Red Hat) 
5209b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5210b7ffffbbSSteven Rostedt (Red Hat) 
5211b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
5212b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
5213b7ffffbbSSteven Rostedt (Red Hat) 
5214b7ffffbbSSteven Rostedt (Red Hat) 	/*
5215b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
5216b7ffffbbSSteven Rostedt (Red Hat) 	 *
5217b7ffffbbSSteven Rostedt (Red Hat) 	 * The reason not to enable the record immediatelly is the
5218b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
5219b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
5220b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
5221b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
5222b7ffffbbSSteven Rostedt (Red Hat) 	 *
5223b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
5224b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
5225b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
5226b7ffffbbSSteven Rostedt (Red Hat) 	 */
5227b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5228b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
5229b7ffffbbSSteven Rostedt (Red Hat) 
5230b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
5231b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
5232b7ffffbbSSteven Rostedt (Red Hat) 		/*
5233b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
5234b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
5235b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
5236b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
5237b7ffffbbSSteven Rostedt (Red Hat) 		 */
5238b7ffffbbSSteven Rostedt (Red Hat) 		if (!within_module_core(rec->ip, mod))
5239b7ffffbbSSteven Rostedt (Red Hat) 			break;
5240b7ffffbbSSteven Rostedt (Red Hat) 
5241b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
5242b7ffffbbSSteven Rostedt (Red Hat) 
5243b7ffffbbSSteven Rostedt (Red Hat) 		/*
5244b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
5245b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
5246b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
5247b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
5248b7ffffbbSSteven Rostedt (Red Hat) 		 */
5249b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
5250b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
5251b7ffffbbSSteven Rostedt (Red Hat) 
5252b7ffffbbSSteven Rostedt (Red Hat) 		/* This clears FTRACE_FL_DISABLED */
5253b7ffffbbSSteven Rostedt (Red Hat) 		rec->flags = cnt;
5254b7ffffbbSSteven Rostedt (Red Hat) 
5255b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
5256b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
5257b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
5258b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
5259b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
5260b7ffffbbSSteven Rostedt (Red Hat) 			}
5261b7ffffbbSSteven Rostedt (Red Hat) 		}
5262b7ffffbbSSteven Rostedt (Red Hat) 
5263b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
5264b7ffffbbSSteven Rostedt (Red Hat) 
5265b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
5266b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5267b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
5268b7ffffbbSSteven Rostedt (Red Hat) 
5269b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
5270b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5271b7ffffbbSSteven Rostedt (Red Hat) }
5272b7ffffbbSSteven Rostedt (Red Hat) 
5273a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
527493eb677dSSteven Rostedt {
527597e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
5276b6b71f66SAbel Vesa 		return;
5277b6b71f66SAbel Vesa 
527897e9b4fcSSteven Rostedt (Red Hat) 	ftrace_process_locs(mod, mod->ftrace_callsites,
527997e9b4fcSSteven Rostedt (Red Hat) 			    mod->ftrace_callsites + mod->num_ftrace_callsites);
528093eb677dSSteven Rostedt }
528193eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
528293eb677dSSteven Rostedt 
5283*b80f0f6cSSteven Rostedt (VMware) void __init ftrace_free_init_mem(void)
528442c269c8SSteven Rostedt (VMware) {
5285*b80f0f6cSSteven Rostedt (VMware) 	unsigned long start = (unsigned long)(&__init_begin);
5286*b80f0f6cSSteven Rostedt (VMware) 	unsigned long end = (unsigned long)(&__init_end);
528742c269c8SSteven Rostedt (VMware) 	struct ftrace_page **last_pg = &ftrace_pages_start;
528842c269c8SSteven Rostedt (VMware) 	struct ftrace_page *pg;
528942c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace *rec;
529042c269c8SSteven Rostedt (VMware) 	struct dyn_ftrace key;
529142c269c8SSteven Rostedt (VMware) 	int order;
529242c269c8SSteven Rostedt (VMware) 
529342c269c8SSteven Rostedt (VMware) 	key.ip = start;
529442c269c8SSteven Rostedt (VMware) 	key.flags = end;	/* overload flags, as it is unsigned long */
529542c269c8SSteven Rostedt (VMware) 
529642c269c8SSteven Rostedt (VMware) 	mutex_lock(&ftrace_lock);
529742c269c8SSteven Rostedt (VMware) 
529842c269c8SSteven Rostedt (VMware) 	for (pg = ftrace_pages_start; pg; last_pg = &pg->next, pg = *last_pg) {
529942c269c8SSteven Rostedt (VMware) 		if (end < pg->records[0].ip ||
530042c269c8SSteven Rostedt (VMware) 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
530142c269c8SSteven Rostedt (VMware) 			continue;
530242c269c8SSteven Rostedt (VMware)  again:
530342c269c8SSteven Rostedt (VMware) 		rec = bsearch(&key, pg->records, pg->index,
530442c269c8SSteven Rostedt (VMware) 			      sizeof(struct dyn_ftrace),
530542c269c8SSteven Rostedt (VMware) 			      ftrace_cmp_recs);
530642c269c8SSteven Rostedt (VMware) 		if (!rec)
530742c269c8SSteven Rostedt (VMware) 			continue;
530842c269c8SSteven Rostedt (VMware) 		pg->index--;
530942c269c8SSteven Rostedt (VMware) 		if (!pg->index) {
531042c269c8SSteven Rostedt (VMware) 			*last_pg = pg->next;
531142c269c8SSteven Rostedt (VMware) 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
531242c269c8SSteven Rostedt (VMware) 			free_pages((unsigned long)pg->records, order);
531342c269c8SSteven Rostedt (VMware) 			kfree(pg);
531442c269c8SSteven Rostedt (VMware) 			pg = container_of(last_pg, struct ftrace_page, next);
531542c269c8SSteven Rostedt (VMware) 			if (!(*last_pg))
531642c269c8SSteven Rostedt (VMware) 				ftrace_pages = pg;
531742c269c8SSteven Rostedt (VMware) 			continue;
531842c269c8SSteven Rostedt (VMware) 		}
531942c269c8SSteven Rostedt (VMware) 		memmove(rec, rec + 1,
532042c269c8SSteven Rostedt (VMware) 			(pg->index - (rec - pg->records)) * sizeof(*rec));
532142c269c8SSteven Rostedt (VMware) 		/* More than one function may be in this block */
532242c269c8SSteven Rostedt (VMware) 		goto again;
532342c269c8SSteven Rostedt (VMware) 	}
532442c269c8SSteven Rostedt (VMware) 	mutex_unlock(&ftrace_lock);
532542c269c8SSteven Rostedt (VMware) }
532642c269c8SSteven Rostedt (VMware) 
532768bf21aaSSteven Rostedt void __init ftrace_init(void)
532868bf21aaSSteven Rostedt {
53291dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
53301dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
53313a36cb11SJiri Slaby 	unsigned long count, flags;
533268bf21aaSSteven Rostedt 	int ret;
533368bf21aaSSteven Rostedt 
533468bf21aaSSteven Rostedt 	local_irq_save(flags);
53353a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
533668bf21aaSSteven Rostedt 	local_irq_restore(flags);
5337af64a7cbSJiri Slaby 	if (ret)
533868bf21aaSSteven Rostedt 		goto failed;
533968bf21aaSSteven Rostedt 
534068bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
5341c867ccd8SJiri Slaby 	if (!count) {
5342c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
534368bf21aaSSteven Rostedt 		goto failed;
5344c867ccd8SJiri Slaby 	}
5345c867ccd8SJiri Slaby 
5346c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
5347c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
534868bf21aaSSteven Rostedt 
534968bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
535068bf21aaSSteven Rostedt 
53515cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
535231e88909SSteven Rostedt 				  __start_mcount_loc,
535368bf21aaSSteven Rostedt 				  __stop_mcount_loc);
535468bf21aaSSteven Rostedt 
53552af15d6aSSteven Rostedt 	set_ftrace_early_filters();
53562af15d6aSSteven Rostedt 
535768bf21aaSSteven Rostedt 	return;
535868bf21aaSSteven Rostedt  failed:
535968bf21aaSSteven Rostedt 	ftrace_disabled = 1;
536068bf21aaSSteven Rostedt }
536168bf21aaSSteven Rostedt 
5362f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
5363f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
5364f3bea491SSteven Rostedt (Red Hat) {
5365f3bea491SSteven Rostedt (Red Hat) }
5366f3bea491SSteven Rostedt (Red Hat) 
5367f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5368f3bea491SSteven Rostedt (Red Hat) {
536912cce594SSteven Rostedt (Red Hat) 
537012cce594SSteven Rostedt (Red Hat) /*
537112cce594SSteven Rostedt (Red Hat)  * Currently there's no safe way to free a trampoline when the kernel
537212cce594SSteven Rostedt (Red Hat)  * is configured with PREEMPT. That is because a task could be preempted
537312cce594SSteven Rostedt (Red Hat)  * when it jumped to the trampoline, it may be preempted for a long time
537412cce594SSteven Rostedt (Red Hat)  * depending on the system load, and currently there's no way to know
537512cce594SSteven Rostedt (Red Hat)  * when it will be off the trampoline. If the trampoline is freed
537612cce594SSteven Rostedt (Red Hat)  * too early, when the task runs again, it will be executing on freed
537712cce594SSteven Rostedt (Red Hat)  * memory and crash.
537812cce594SSteven Rostedt (Red Hat)  */
537912cce594SSteven Rostedt (Red Hat) #ifdef CONFIG_PREEMPT
5380f3bea491SSteven Rostedt (Red Hat) 	/* Currently, only non dynamic ops can have a trampoline */
5381f3bea491SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
5382f3bea491SSteven Rostedt (Red Hat) 		return;
538312cce594SSteven Rostedt (Red Hat) #endif
5384f3bea491SSteven Rostedt (Red Hat) 
5385f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
5386f3bea491SSteven Rostedt (Red Hat) }
5387f3bea491SSteven Rostedt (Red Hat) 
53883d083395SSteven Rostedt #else
53890b6e4d56SFrederic Weisbecker 
53902b499381SSteven Rostedt static struct ftrace_ops global_ops = {
5391bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
5392e3eea140SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
5393e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_INITIALIZED |
5394e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
5395bd69c30bSSteven Rostedt };
5396bd69c30bSSteven Rostedt 
53970b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
53980b6e4d56SFrederic Weisbecker {
53990b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
54000b6e4d56SFrederic Weisbecker 	return 0;
54010b6e4d56SFrederic Weisbecker }
54026f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
54030b6e4d56SFrederic Weisbecker 
54048434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
5405df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
5406e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
54075a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
54083b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)					\
54093b6cfdb1SSteven Rostedt 	({								\
54108a56d776SSteven Rostedt (Red Hat) 		int ___ret = __register_ftrace_function(ops);		\
54118a56d776SSteven Rostedt (Red Hat) 		if (!___ret)						\
54123b6cfdb1SSteven Rostedt 			(ops)->flags |= FTRACE_OPS_FL_ENABLED;		\
54138a56d776SSteven Rostedt (Red Hat) 		___ret;							\
54143b6cfdb1SSteven Rostedt 	})
54151fcc1553SSteven Rostedt (Red Hat) # define ftrace_shutdown(ops, command)					\
54161fcc1553SSteven Rostedt (Red Hat) 	({								\
54171fcc1553SSteven Rostedt (Red Hat) 		int ___ret = __unregister_ftrace_function(ops);		\
54181fcc1553SSteven Rostedt (Red Hat) 		if (!___ret)						\
54191fcc1553SSteven Rostedt (Red Hat) 			(ops)->flags &= ~FTRACE_OPS_FL_ENABLED;		\
54201fcc1553SSteven Rostedt (Red Hat) 		___ret;							\
54211fcc1553SSteven Rostedt (Red Hat) 	})
54228a56d776SSteven Rostedt (Red Hat) 
5423b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
5424b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
5425b848914cSSteven Rostedt 
5426b848914cSSteven Rostedt static inline int
5427195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
5428b848914cSSteven Rostedt {
5429b848914cSSteven Rostedt 	return 1;
5430b848914cSSteven Rostedt }
5431b848914cSSteven Rostedt 
5432f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5433f3bea491SSteven Rostedt (Red Hat) {
5434f3bea491SSteven Rostedt (Red Hat) }
5435f3bea491SSteven Rostedt (Red Hat) 
54363d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
54373d083395SSteven Rostedt 
54384104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
54394104d326SSteven Rostedt (Red Hat) {
54404104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
54414104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
54424104d326SSteven Rostedt (Red Hat) }
54434104d326SSteven Rostedt (Red Hat) 
54444104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
54454104d326SSteven Rostedt (Red Hat) {
54464104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
54474104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
54484104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
54494104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
54504104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
54514104d326SSteven Rostedt (Red Hat) 	}
54524104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
54534104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
54544104d326SSteven Rostedt (Red Hat) }
54554104d326SSteven Rostedt (Red Hat) 
54564104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
54574104d326SSteven Rostedt (Red Hat) {
54584104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
54594104d326SSteven Rostedt (Red Hat) }
54604104d326SSteven Rostedt (Red Hat) 
54612f5f6ad9SSteven Rostedt static inline void
54622f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5463a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
5464b848914cSSteven Rostedt {
5465cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
5466edc15cafSSteven Rostedt 	int bit;
5467b848914cSSteven Rostedt 
5468edc15cafSSteven Rostedt 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5469edc15cafSSteven Rostedt 	if (bit < 0)
5470b1cff0adSSteven Rostedt 		return;
5471b1cff0adSSteven Rostedt 
5472cdbe61bfSSteven Rostedt 	/*
5473cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
5474cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
5475cdbe61bfSSteven Rostedt 	 */
5476cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
5477ba27f2bcSSteven Rostedt (Red Hat) 
54780a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
5479ba27f2bcSSteven Rostedt (Red Hat) 		/*
5480ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
5481ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
5482ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
5483ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
5484ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
5485ba27f2bcSSteven Rostedt (Red Hat) 		 *
5486ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
5487ba27f2bcSSteven Rostedt (Red Hat) 		 */
5488ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
5489ba27f2bcSSteven Rostedt (Red Hat) 		    (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5490ba27f2bcSSteven Rostedt (Red Hat) 		     !ftrace_function_local_disabled(op)) &&
5491ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
5492ba27f2bcSSteven Rostedt (Red Hat) 
54931d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
54941d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
54954104d326SSteven Rostedt (Red Hat) 				goto out;
54964104d326SSteven Rostedt (Red Hat) 			}
5497a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
54984104d326SSteven Rostedt (Red Hat) 		}
54990a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
55004104d326SSteven Rostedt (Red Hat) out:
5501cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
5502edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
5503b848914cSSteven Rostedt }
5504b848914cSSteven Rostedt 
55052f5f6ad9SSteven Rostedt /*
55062f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
55072f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
55082f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
55092f5f6ad9SSteven Rostedt  * sending a third parameter.
5510a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
5511a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
5512a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
551306aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
551406aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
5515a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
5516b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
55172f5f6ad9SSteven Rostedt  */
55182f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
55192f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5520a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
55212f5f6ad9SSteven Rostedt {
5522a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
55232f5f6ad9SSteven Rostedt }
55242f5f6ad9SSteven Rostedt #else
55252f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
55262f5f6ad9SSteven Rostedt {
5527a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
55282f5f6ad9SSteven Rostedt }
55292f5f6ad9SSteven Rostedt #endif
55302f5f6ad9SSteven Rostedt 
5531f1ff6348SSteven Rostedt (Red Hat) /*
5532f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
5533c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
5534c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
5535f1ff6348SSteven Rostedt (Red Hat)  */
5536c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
5537f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs)
5538f1ff6348SSteven Rostedt (Red Hat) {
5539f1ff6348SSteven Rostedt (Red Hat) 	int bit;
5540f1ff6348SSteven Rostedt (Red Hat) 
5541c68c0fa2SSteven Rostedt (Red Hat) 	if ((op->flags & FTRACE_OPS_FL_RCU) && !rcu_is_watching())
5542c68c0fa2SSteven Rostedt (Red Hat) 		return;
5543c68c0fa2SSteven Rostedt (Red Hat) 
5544f1ff6348SSteven Rostedt (Red Hat) 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5545f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
5546f1ff6348SSteven Rostedt (Red Hat) 		return;
5547f1ff6348SSteven Rostedt (Red Hat) 
5548c68c0fa2SSteven Rostedt (Red Hat) 	preempt_disable_notrace();
5549f1ff6348SSteven Rostedt (Red Hat) 
5550c68c0fa2SSteven Rostedt (Red Hat) 	if (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5551c68c0fa2SSteven Rostedt (Red Hat) 	    !ftrace_function_local_disabled(op)) {
5552c68c0fa2SSteven Rostedt (Red Hat) 		op->func(ip, parent_ip, op, regs);
5553c68c0fa2SSteven Rostedt (Red Hat) 	}
5554c68c0fa2SSteven Rostedt (Red Hat) 
5555c68c0fa2SSteven Rostedt (Red Hat) 	preempt_enable_notrace();
5556f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
5557f1ff6348SSteven Rostedt (Red Hat) }
5558f1ff6348SSteven Rostedt (Red Hat) 
555987354059SSteven Rostedt (Red Hat) /**
556087354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
556187354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
556287354059SSteven Rostedt (Red Hat)  *
556387354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
556487354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
556587354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
55663a150df9SChunyu Hu  * ftrace_ops_assist_func() instead.
556787354059SSteven Rostedt (Red Hat)  *
556887354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
556987354059SSteven Rostedt (Red Hat)  */
557087354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
557187354059SSteven Rostedt (Red Hat) {
557287354059SSteven Rostedt (Red Hat) 	/*
5573c68c0fa2SSteven Rostedt (Red Hat) 	 * If the function does not handle recursion, needs to be RCU safe,
5574c68c0fa2SSteven Rostedt (Red Hat) 	 * or does per cpu logic, then we need to call the assist handler.
557587354059SSteven Rostedt (Red Hat) 	 */
5576c68c0fa2SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_RECURSION_SAFE) ||
5577c68c0fa2SSteven Rostedt (Red Hat) 	    ops->flags & (FTRACE_OPS_FL_RCU | FTRACE_OPS_FL_PER_CPU))
5578c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
557987354059SSteven Rostedt (Red Hat) 
558087354059SSteven Rostedt (Red Hat) 	return ops->func;
558187354059SSteven Rostedt (Red Hat) }
558287354059SSteven Rostedt (Red Hat) 
5583345ddcc8SSteven Rostedt (Red Hat) static void
5584345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
5585345ddcc8SSteven Rostedt (Red Hat) 		    struct task_struct *prev, struct task_struct *next)
5586e32d8956SSteven Rostedt {
5587345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
5588345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5589345ddcc8SSteven Rostedt (Red Hat) 
5590345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
5591345ddcc8SSteven Rostedt (Red Hat) 
5592345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
5593345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, next));
5594345ddcc8SSteven Rostedt (Red Hat) }
5595345ddcc8SSteven Rostedt (Red Hat) 
5596345ddcc8SSteven Rostedt (Red Hat) static void clear_ftrace_pids(struct trace_array *tr)
5597345ddcc8SSteven Rostedt (Red Hat) {
5598345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5599e32d8956SSteven Rostedt 	int cpu;
5600e32d8956SSteven Rostedt 
5601345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
5602345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
5603345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
5604345ddcc8SSteven Rostedt (Red Hat) 		return;
5605345ddcc8SSteven Rostedt (Red Hat) 
5606345ddcc8SSteven Rostedt (Red Hat) 	unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
5607345ddcc8SSteven Rostedt (Red Hat) 
5608345ddcc8SSteven Rostedt (Red Hat) 	for_each_possible_cpu(cpu)
5609345ddcc8SSteven Rostedt (Red Hat) 		per_cpu_ptr(tr->trace_buffer.data, cpu)->ftrace_ignore_pid = false;
5610345ddcc8SSteven Rostedt (Red Hat) 
5611345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, NULL);
5612345ddcc8SSteven Rostedt (Red Hat) 
5613345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
5614345ddcc8SSteven Rostedt (Red Hat) 	synchronize_sched();
5615345ddcc8SSteven Rostedt (Red Hat) 
5616345ddcc8SSteven Rostedt (Red Hat) 	trace_free_pid_list(pid_list);
5617e32d8956SSteven Rostedt }
5618e32d8956SSteven Rostedt 
5619345ddcc8SSteven Rostedt (Red Hat) static void ftrace_pid_reset(struct trace_array *tr)
5620e32d8956SSteven Rostedt {
5621756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5622345ddcc8SSteven Rostedt (Red Hat) 	clear_ftrace_pids(tr);
5623756d17eeS[email protected] 
5624756d17eeS[email protected] 	ftrace_update_pid_func();
5625e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5626756d17eeS[email protected] 
5627756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5628756d17eeS[email protected] }
5629756d17eeS[email protected] 
5630345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
5631345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
5632345ddcc8SSteven Rostedt (Red Hat) 
5633756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
5634345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
5635756d17eeS[email protected] {
5636345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5637345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5638345ddcc8SSteven Rostedt (Red Hat) 
5639756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5640345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
5641756d17eeS[email protected] 
5642345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
5643756d17eeS[email protected] 
5644345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
5645345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
5646345ddcc8SSteven Rostedt (Red Hat) 
5647345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
5648756d17eeS[email protected] }
5649756d17eeS[email protected] 
5650756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
5651756d17eeS[email protected] {
5652345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5653345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
5654345ddcc8SSteven Rostedt (Red Hat) 
5655345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS)
5656756d17eeS[email protected] 		return NULL;
5657756d17eeS[email protected] 
5658345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
5659756d17eeS[email protected] }
5660756d17eeS[email protected] 
5661756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
5662345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
5663756d17eeS[email protected] {
5664345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
5665756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5666756d17eeS[email protected] }
5667756d17eeS[email protected] 
5668756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
5669756d17eeS[email protected] {
5670345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
5671fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
5672756d17eeS[email protected] 		return 0;
5673756d17eeS[email protected] 	}
5674756d17eeS[email protected] 
5675345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
5676756d17eeS[email protected] }
5677756d17eeS[email protected] 
5678756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
5679756d17eeS[email protected] 	.start = fpid_start,
5680756d17eeS[email protected] 	.next = fpid_next,
5681756d17eeS[email protected] 	.stop = fpid_stop,
5682756d17eeS[email protected] 	.show = fpid_show,
5683756d17eeS[email protected] };
5684756d17eeS[email protected] 
5685756d17eeS[email protected] static int
5686756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
5687756d17eeS[email protected] {
5688345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
5689345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
5690756d17eeS[email protected] 	int ret = 0;
5691756d17eeS[email protected] 
5692345ddcc8SSteven Rostedt (Red Hat) 	if (trace_array_get(tr) < 0)
5693345ddcc8SSteven Rostedt (Red Hat) 		return -ENODEV;
5694345ddcc8SSteven Rostedt (Red Hat) 
5695756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
5696756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
5697345ddcc8SSteven Rostedt (Red Hat) 		ftrace_pid_reset(tr);
5698756d17eeS[email protected] 
5699756d17eeS[email protected] 	ret = seq_open(file, &ftrace_pid_sops);
5700345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
5701345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
5702345ddcc8SSteven Rostedt (Red Hat) 	} else {
5703345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
5704345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
5705345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
5706345ddcc8SSteven Rostedt (Red Hat) 	}
5707756d17eeS[email protected] 
5708756d17eeS[email protected] 	return ret;
5709756d17eeS[email protected] }
5710756d17eeS[email protected] 
5711345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
5712345ddcc8SSteven Rostedt (Red Hat) {
5713345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
5714345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5715345ddcc8SSteven Rostedt (Red Hat) 
5716345ddcc8SSteven Rostedt (Red Hat) 	/*
5717345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
5718345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
5719345ddcc8SSteven Rostedt (Red Hat) 	 */
5720345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
5721345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
5722345ddcc8SSteven Rostedt (Red Hat) 
5723345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
5724345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, current));
5725345ddcc8SSteven Rostedt (Red Hat) }
5726345ddcc8SSteven Rostedt (Red Hat) 
5727df4fc315SSteven Rostedt static ssize_t
5728df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
5729df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
5730df4fc315SSteven Rostedt {
5731345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
5732345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5733345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *filtered_pids = NULL;
5734345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5735345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
5736df4fc315SSteven Rostedt 
5737345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
5738345ddcc8SSteven Rostedt (Red Hat) 		return 0;
5739df4fc315SSteven Rostedt 
5740345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5741df4fc315SSteven Rostedt 
5742345ddcc8SSteven Rostedt (Red Hat) 	filtered_pids = rcu_dereference_protected(tr->function_pids,
5743345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
5744345ddcc8SSteven Rostedt (Red Hat) 
5745345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
5746345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
5747345ddcc8SSteven Rostedt (Red Hat) 		goto out;
5748345ddcc8SSteven Rostedt (Red Hat) 
5749345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, pid_list);
5750345ddcc8SSteven Rostedt (Red Hat) 
5751345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
5752345ddcc8SSteven Rostedt (Red Hat) 		synchronize_sched();
5753345ddcc8SSteven Rostedt (Red Hat) 		trace_free_pid_list(filtered_pids);
5754345ddcc8SSteven Rostedt (Red Hat) 	} else if (pid_list) {
5755345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
5756345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
5757345ddcc8SSteven Rostedt (Red Hat) 	}
5758df4fc315SSteven Rostedt 
5759756d17eeS[email protected] 	/*
5760345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
5761345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
5762345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
5763756d17eeS[email protected] 	 */
5764345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
5765756d17eeS[email protected] 
5766345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
5767345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5768345ddcc8SSteven Rostedt (Red Hat)  out:
5769345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5770345ddcc8SSteven Rostedt (Red Hat) 
5771345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
5772345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
5773345ddcc8SSteven Rostedt (Red Hat) 
5774df4fc315SSteven Rostedt 	return ret;
5775e32d8956SSteven Rostedt }
5776978f3a45SSteven Rostedt 
5777756d17eeS[email protected] static int
5778756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
5779756d17eeS[email protected] {
5780345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
5781978f3a45SSteven Rostedt 
5782345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
5783345ddcc8SSteven Rostedt (Red Hat) 
5784345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
5785df4fc315SSteven Rostedt }
5786df4fc315SSteven Rostedt 
57875e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
5788756d17eeS[email protected] 	.open		= ftrace_pid_open,
5789df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
5790756d17eeS[email protected] 	.read		= seq_read,
5791098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
5792756d17eeS[email protected] 	.release	= ftrace_pid_release,
5793df4fc315SSteven Rostedt };
5794df4fc315SSteven Rostedt 
5795345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
5796df4fc315SSteven Rostedt {
57975452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
5798345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
5799df4fc315SSteven Rostedt }
5800df4fc315SSteven Rostedt 
5801501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
5802501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
5803501c2375SSteven Rostedt (Red Hat) {
5804501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
5805501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
5806501c2375SSteven Rostedt (Red Hat) 
5807501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
5808501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
5809501c2375SSteven Rostedt (Red Hat) }
5810501c2375SSteven Rostedt (Red Hat) 
58113d083395SSteven Rostedt /**
581281adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
5813a2bb6a3dSSteven Rostedt  *
5814a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
5815a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
5816a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
5817a2bb6a3dSSteven Rostedt  */
581881adbdc0SSteven Rostedt void ftrace_kill(void)
5819a2bb6a3dSSteven Rostedt {
5820a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
5821a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
5822a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
5823a2bb6a3dSSteven Rostedt }
5824a2bb6a3dSSteven Rostedt 
5825a2bb6a3dSSteven Rostedt /**
5826e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
5827e0a413f6SSteven Rostedt  */
5828e0a413f6SSteven Rostedt int ftrace_is_dead(void)
5829e0a413f6SSteven Rostedt {
5830e0a413f6SSteven Rostedt 	return ftrace_disabled;
5831e0a413f6SSteven Rostedt }
5832e0a413f6SSteven Rostedt 
5833e0a413f6SSteven Rostedt /**
58343d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
58353d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
58363d083395SSteven Rostedt  *
58373d083395SSteven Rostedt  * Register a function to be called by all functions in the
58383d083395SSteven Rostedt  * kernel.
58393d083395SSteven Rostedt  *
58403d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
58413d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
58423d083395SSteven Rostedt  *       recursive loop.
58433d083395SSteven Rostedt  */
58443d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
58453d083395SSteven Rostedt {
584645a4a237SSteven Rostedt 	int ret = -1;
58474eebcc81SSteven Rostedt 
5848f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5849f04f24fbSMasami Hiramatsu 
5850e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5851e7d3737eSFrederic Weisbecker 
5852a1cd6173SSteven Rostedt 	ret = ftrace_startup(ops, 0);
5853b848914cSSteven Rostedt 
5854e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
58558d240dd8SBorislav Petkov 
5856b0fc494fSSteven Rostedt 	return ret;
58573d083395SSteven Rostedt }
5858cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
58593d083395SSteven Rostedt 
58603d083395SSteven Rostedt /**
586132632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
58623d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
58633d083395SSteven Rostedt  *
58643d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
58653d083395SSteven Rostedt  */
58663d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
58673d083395SSteven Rostedt {
58683d083395SSteven Rostedt 	int ret;
58693d083395SSteven Rostedt 
5870e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
58718a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
5872e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5873b0fc494fSSteven Rostedt 
5874b0fc494fSSteven Rostedt 	return ret;
5875b0fc494fSSteven Rostedt }
5876cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
5877b0fc494fSSteven Rostedt 
5878e309b41dSIngo Molnar int
5879b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
58808d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
5881b0fc494fSSteven Rostedt 		     loff_t *ppos)
5882b0fc494fSSteven Rostedt {
588345a4a237SSteven Rostedt 	int ret = -ENODEV;
58844eebcc81SSteven Rostedt 
5885e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5886b0fc494fSSteven Rostedt 
588745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
588845a4a237SSteven Rostedt 		goto out;
588945a4a237SSteven Rostedt 
58908d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
5891b0fc494fSSteven Rostedt 
5892a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
5893b0fc494fSSteven Rostedt 		goto out;
5894b0fc494fSSteven Rostedt 
5895a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
5896b0fc494fSSteven Rostedt 
5897b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
5898b0fc494fSSteven Rostedt 
5899b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
59005000c418SJan Kiszka 		if (ftrace_ops_list != &ftrace_list_end)
59015000c418SJan Kiszka 			update_ftrace_function();
5902b0fc494fSSteven Rostedt 
5903524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
5904524a3868SSteven Rostedt (Red Hat) 
5905b0fc494fSSteven Rostedt 	} else {
5906b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
5907b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
5908b0fc494fSSteven Rostedt 
5909b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
5910b0fc494fSSteven Rostedt 	}
5911b0fc494fSSteven Rostedt 
5912b0fc494fSSteven Rostedt  out:
5913e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
59143d083395SSteven Rostedt 	return ret;
591516444a8aSArnaldo Carvalho de Melo }
5916f17845e5SIngo Molnar 
5917fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5918e7d3737eSFrederic Weisbecker 
59195f151b24SSteven Rostedt (Red Hat) static struct ftrace_ops graph_ops = {
59205f151b24SSteven Rostedt (Red Hat) 	.func			= ftrace_stub,
59215f151b24SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
59225f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_INITIALIZED |
5923e3eea140SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_PID |
59245f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_STUB,
59255f151b24SSteven Rostedt (Red Hat) #ifdef FTRACE_GRAPH_TRAMP_ADDR
59265f151b24SSteven Rostedt (Red Hat) 	.trampoline		= FTRACE_GRAPH_TRAMP_ADDR,
5927aec0be2dSSteven Rostedt (Red Hat) 	/* trampoline_size is only needed for dynamically allocated tramps */
59285f151b24SSteven Rostedt (Red Hat) #endif
59295f151b24SSteven Rostedt (Red Hat) 	ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
59305f151b24SSteven Rostedt (Red Hat) };
59315f151b24SSteven Rostedt (Red Hat) 
593255577204SSteven Rostedt (Red Hat) void ftrace_graph_sleep_time_control(bool enable)
593355577204SSteven Rostedt (Red Hat) {
593455577204SSteven Rostedt (Red Hat) 	fgraph_sleep_time = enable;
593555577204SSteven Rostedt (Red Hat) }
593655577204SSteven Rostedt (Red Hat) 
593755577204SSteven Rostedt (Red Hat) void ftrace_graph_graph_time_control(bool enable)
593855577204SSteven Rostedt (Red Hat) {
593955577204SSteven Rostedt (Red Hat) 	fgraph_graph_time = enable;
594055577204SSteven Rostedt (Red Hat) }
594155577204SSteven Rostedt (Red Hat) 
5942e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
5943e49dc19cSSteven Rostedt {
5944e49dc19cSSteven Rostedt 	return 0;
5945e49dc19cSSteven Rostedt }
5946e49dc19cSSteven Rostedt 
5947287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
5948287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
5949287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
5950e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
595123a8e844SSteven Rostedt (Red Hat) static trace_func_graph_ent_t __ftrace_graph_entry = ftrace_graph_entry_stub;
5952f201ae23SFrederic Weisbecker 
5953f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
5954f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
5955f201ae23SFrederic Weisbecker {
5956f201ae23SFrederic Weisbecker 	int i;
5957f201ae23SFrederic Weisbecker 	int ret = 0;
5958f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
5959f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
5960f201ae23SFrederic Weisbecker 
5961f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
5962f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
5963f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
5964f201ae23SFrederic Weisbecker 					GFP_KERNEL);
5965f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
5966f201ae23SFrederic Weisbecker 			start = 0;
5967f201ae23SFrederic Weisbecker 			end = i;
5968f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
5969f201ae23SFrederic Weisbecker 			goto free;
5970f201ae23SFrederic Weisbecker 		}
5971f201ae23SFrederic Weisbecker 	}
5972f201ae23SFrederic Weisbecker 
59736112a300SSoumya PN 	read_lock(&tasklist_lock);
5974f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
5975f201ae23SFrederic Weisbecker 		if (start == end) {
5976f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
5977f201ae23SFrederic Weisbecker 			goto unlock;
5978f201ae23SFrederic Weisbecker 		}
5979f201ae23SFrederic Weisbecker 
5980f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
5981380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
5982f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
598326c01624SSteven Rostedt 			t->curr_ret_stack = -1;
598426c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
598526c01624SSteven Rostedt 			smp_wmb();
598626c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
5987f201ae23SFrederic Weisbecker 		}
5988f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
5989f201ae23SFrederic Weisbecker 
5990f201ae23SFrederic Weisbecker unlock:
59916112a300SSoumya PN 	read_unlock(&tasklist_lock);
5992f201ae23SFrederic Weisbecker free:
5993f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
5994f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
5995f201ae23SFrederic Weisbecker 	return ret;
5996f201ae23SFrederic Weisbecker }
5997f201ae23SFrederic Weisbecker 
59988aef2d28SSteven Rostedt static void
5999c73464b1SPeter Zijlstra ftrace_graph_probe_sched_switch(void *ignore, bool preempt,
600038516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
60018aef2d28SSteven Rostedt {
60028aef2d28SSteven Rostedt 	unsigned long long timestamp;
60038aef2d28SSteven Rostedt 	int index;
60048aef2d28SSteven Rostedt 
6005be6f164aSSteven Rostedt 	/*
6006be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
6007be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
6008be6f164aSSteven Rostedt 	 */
600955577204SSteven Rostedt (Red Hat) 	if (fgraph_sleep_time)
6010be6f164aSSteven Rostedt 		return;
6011be6f164aSSteven Rostedt 
60128aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
60138aef2d28SSteven Rostedt 
60148aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
60158aef2d28SSteven Rostedt 
60168aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
60178aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
60188aef2d28SSteven Rostedt 		return;
60198aef2d28SSteven Rostedt 
60208aef2d28SSteven Rostedt 	/*
60218aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
60228aef2d28SSteven Rostedt 	 * time next was sleeping.
60238aef2d28SSteven Rostedt 	 */
60248aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
60258aef2d28SSteven Rostedt 
60268aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
60278aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
60288aef2d28SSteven Rostedt }
60298aef2d28SSteven Rostedt 
6030f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
6031fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
6032f201ae23SFrederic Weisbecker {
6033f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
60345b058bcdSFrederic Weisbecker 	int ret, cpu;
6035f201ae23SFrederic Weisbecker 
6036f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
6037f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
6038f201ae23SFrederic Weisbecker 				GFP_KERNEL);
6039f201ae23SFrederic Weisbecker 
6040f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
6041f201ae23SFrederic Weisbecker 		return -ENOMEM;
6042f201ae23SFrederic Weisbecker 
60435b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
6044179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
6045179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
6046868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
6047179c498aSSteven Rostedt 	}
60485b058bcdSFrederic Weisbecker 
6049f201ae23SFrederic Weisbecker 	do {
6050f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
6051f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
6052f201ae23SFrederic Weisbecker 
60538aef2d28SSteven Rostedt 	if (!ret) {
605438516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
60558aef2d28SSteven Rostedt 		if (ret)
60568aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
60578aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
60588aef2d28SSteven Rostedt 	}
60598aef2d28SSteven Rostedt 
6060f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
6061f201ae23SFrederic Weisbecker 	return ret;
6062f201ae23SFrederic Weisbecker }
6063f201ae23SFrederic Weisbecker 
60644a2b8ddaSFrederic Weisbecker /*
60654a2b8ddaSFrederic Weisbecker  * Hibernation protection.
60664a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
60674a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
60684a2b8ddaSFrederic Weisbecker  */
60694a2b8ddaSFrederic Weisbecker static int
60704a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
60714a2b8ddaSFrederic Weisbecker 							void *unused)
60724a2b8ddaSFrederic Weisbecker {
60734a2b8ddaSFrederic Weisbecker 	switch (state) {
60744a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
60754a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
60764a2b8ddaSFrederic Weisbecker 		break;
60774a2b8ddaSFrederic Weisbecker 
60784a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
60794a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
60804a2b8ddaSFrederic Weisbecker 		break;
60814a2b8ddaSFrederic Weisbecker 	}
60824a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
60834a2b8ddaSFrederic Weisbecker }
60844a2b8ddaSFrederic Weisbecker 
608523a8e844SSteven Rostedt (Red Hat) static int ftrace_graph_entry_test(struct ftrace_graph_ent *trace)
608623a8e844SSteven Rostedt (Red Hat) {
608723a8e844SSteven Rostedt (Red Hat) 	if (!ftrace_ops_test(&global_ops, trace->func, NULL))
608823a8e844SSteven Rostedt (Red Hat) 		return 0;
608923a8e844SSteven Rostedt (Red Hat) 	return __ftrace_graph_entry(trace);
609023a8e844SSteven Rostedt (Red Hat) }
609123a8e844SSteven Rostedt (Red Hat) 
609223a8e844SSteven Rostedt (Red Hat) /*
609323a8e844SSteven Rostedt (Red Hat)  * The function graph tracer should only trace the functions defined
609423a8e844SSteven Rostedt (Red Hat)  * by set_ftrace_filter and set_ftrace_notrace. If another function
609523a8e844SSteven Rostedt (Red Hat)  * tracer ops is registered, the graph tracer requires testing the
609623a8e844SSteven Rostedt (Red Hat)  * function against the global ops, and not just trace any function
609723a8e844SSteven Rostedt (Red Hat)  * that any ftrace_ops registered.
609823a8e844SSteven Rostedt (Red Hat)  */
609923a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void)
610023a8e844SSteven Rostedt (Red Hat) {
61015f151b24SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
61025f151b24SSteven Rostedt (Red Hat) 	bool do_test = false;
61035f151b24SSteven Rostedt (Red Hat) 
61045f151b24SSteven Rostedt (Red Hat) 	/*
61055f151b24SSteven Rostedt (Red Hat) 	 * The graph and global ops share the same set of functions
61065f151b24SSteven Rostedt (Red Hat) 	 * to test. If any other ops is on the list, then
61075f151b24SSteven Rostedt (Red Hat) 	 * the graph tracing needs to test if its the function
61085f151b24SSteven Rostedt (Red Hat) 	 * it should call.
61095f151b24SSteven Rostedt (Red Hat) 	 */
61105f151b24SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
61115f151b24SSteven Rostedt (Red Hat) 		if (op != &global_ops && op != &graph_ops &&
61125f151b24SSteven Rostedt (Red Hat) 		    op != &ftrace_list_end) {
61135f151b24SSteven Rostedt (Red Hat) 			do_test = true;
61145f151b24SSteven Rostedt (Red Hat) 			/* in double loop, break out with goto */
61155f151b24SSteven Rostedt (Red Hat) 			goto out;
61165f151b24SSteven Rostedt (Red Hat) 		}
61175f151b24SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
61185f151b24SSteven Rostedt (Red Hat)  out:
61195f151b24SSteven Rostedt (Red Hat) 	if (do_test)
612023a8e844SSteven Rostedt (Red Hat) 		ftrace_graph_entry = ftrace_graph_entry_test;
61215f151b24SSteven Rostedt (Red Hat) 	else
61225f151b24SSteven Rostedt (Red Hat) 		ftrace_graph_entry = __ftrace_graph_entry;
612323a8e844SSteven Rostedt (Red Hat) }
612423a8e844SSteven Rostedt (Red Hat) 
61258275f69fSMathias Krause static struct notifier_block ftrace_suspend_notifier = {
61268275f69fSMathias Krause 	.notifier_call = ftrace_suspend_notifier_call,
61278275f69fSMathias Krause };
61288275f69fSMathias Krause 
6129287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
6130287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
613115e6cb36SFrederic Weisbecker {
6132e7d3737eSFrederic Weisbecker 	int ret = 0;
6133e7d3737eSFrederic Weisbecker 
6134e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6135e7d3737eSFrederic Weisbecker 
613605ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
6137597af815SSteven Rostedt 	if (ftrace_graph_active) {
613805ce5818SSteven Rostedt 		ret = -EBUSY;
613905ce5818SSteven Rostedt 		goto out;
614005ce5818SSteven Rostedt 	}
614105ce5818SSteven Rostedt 
61424a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
61434a2b8ddaSFrederic Weisbecker 
6144597af815SSteven Rostedt 	ftrace_graph_active++;
6145fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
6146f201ae23SFrederic Weisbecker 	if (ret) {
6147597af815SSteven Rostedt 		ftrace_graph_active--;
6148f201ae23SFrederic Weisbecker 		goto out;
6149f201ae23SFrederic Weisbecker 	}
6150e53a6319SSteven Rostedt 
6151287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
615223a8e844SSteven Rostedt (Red Hat) 
615323a8e844SSteven Rostedt (Red Hat) 	/*
615423a8e844SSteven Rostedt (Red Hat) 	 * Update the indirect function to the entryfunc, and the
615523a8e844SSteven Rostedt (Red Hat) 	 * function that gets called to the entry_test first. Then
615623a8e844SSteven Rostedt (Red Hat) 	 * call the update fgraph entry function to determine if
615723a8e844SSteven Rostedt (Red Hat) 	 * the entryfunc should be called directly or not.
615823a8e844SSteven Rostedt (Red Hat) 	 */
615923a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = entryfunc;
616023a8e844SSteven Rostedt (Red Hat) 	ftrace_graph_entry = ftrace_graph_entry_test;
616123a8e844SSteven Rostedt (Red Hat) 	update_function_graph_func();
6162e53a6319SSteven Rostedt 
61635f151b24SSteven Rostedt (Red Hat) 	ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
6164e7d3737eSFrederic Weisbecker out:
6165e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
6166e7d3737eSFrederic Weisbecker 	return ret;
616715e6cb36SFrederic Weisbecker }
616815e6cb36SFrederic Weisbecker 
6169fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
617015e6cb36SFrederic Weisbecker {
6171e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
6172e7d3737eSFrederic Weisbecker 
6173597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
61742aad1b76SSteven Rostedt 		goto out;
61752aad1b76SSteven Rostedt 
6176597af815SSteven Rostedt 	ftrace_graph_active--;
6177287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
6178e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
617923a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = ftrace_graph_entry_stub;
61805f151b24SSteven Rostedt (Red Hat) 	ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
61814a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
618238516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
6183e7d3737eSFrederic Weisbecker 
6184f3bea491SSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE
6185f3bea491SSteven Rostedt (Red Hat) 	/*
6186f3bea491SSteven Rostedt (Red Hat) 	 * Function graph does not allocate the trampoline, but
6187f3bea491SSteven Rostedt (Red Hat) 	 * other global_ops do. We need to reset the ALLOC_TRAMP flag
6188f3bea491SSteven Rostedt (Red Hat) 	 * if one was used.
6189f3bea491SSteven Rostedt (Red Hat) 	 */
6190f3bea491SSteven Rostedt (Red Hat) 	global_ops.trampoline = save_global_trampoline;
6191f3bea491SSteven Rostedt (Red Hat) 	if (save_global_flags & FTRACE_OPS_FL_ALLOC_TRAMP)
6192f3bea491SSteven Rostedt (Red Hat) 		global_ops.flags |= FTRACE_OPS_FL_ALLOC_TRAMP;
6193f3bea491SSteven Rostedt (Red Hat) #endif
6194f3bea491SSteven Rostedt (Red Hat) 
61952aad1b76SSteven Rostedt  out:
6196e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
619715e6cb36SFrederic Weisbecker }
6198f201ae23SFrederic Weisbecker 
6199868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
6200868baf07SSteven Rostedt 
6201868baf07SSteven Rostedt static void
6202868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
6203868baf07SSteven Rostedt {
6204868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
6205868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
6206868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
620725985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
6208868baf07SSteven Rostedt 	smp_wmb();
6209868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
6210868baf07SSteven Rostedt }
6211868baf07SSteven Rostedt 
6212868baf07SSteven Rostedt /*
6213868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
6214868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
6215868baf07SSteven Rostedt  */
6216868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
6217868baf07SSteven Rostedt {
6218868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
6219868baf07SSteven Rostedt 	/*
6220868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
6221868baf07SSteven Rostedt 	 * stack or no stack at all.
6222868baf07SSteven Rostedt 	 */
6223868baf07SSteven Rostedt 	if (t->ret_stack)
6224868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
6225868baf07SSteven Rostedt 
6226868baf07SSteven Rostedt 	if (ftrace_graph_active) {
6227868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
6228868baf07SSteven Rostedt 
6229868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
6230868baf07SSteven Rostedt 		if (!ret_stack) {
6231868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6232868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
6233868baf07SSteven Rostedt 					    GFP_KERNEL);
6234868baf07SSteven Rostedt 			if (!ret_stack)
6235868baf07SSteven Rostedt 				return;
6236868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
6237868baf07SSteven Rostedt 		}
6238868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
6239868baf07SSteven Rostedt 	}
6240868baf07SSteven Rostedt }
6241868baf07SSteven Rostedt 
6242f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
6243fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
6244f201ae23SFrederic Weisbecker {
624584047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
624684047e36SSteven Rostedt 	t->ret_stack = NULL;
6247ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
624884047e36SSteven Rostedt 
6249597af815SSteven Rostedt 	if (ftrace_graph_active) {
625082310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
625182310a32SSteven Rostedt 
625282310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6253f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
6254f201ae23SFrederic Weisbecker 				GFP_KERNEL);
625582310a32SSteven Rostedt 		if (!ret_stack)
6256f201ae23SFrederic Weisbecker 			return;
6257868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
625884047e36SSteven Rostedt 	}
6259f201ae23SFrederic Weisbecker }
6260f201ae23SFrederic Weisbecker 
6261fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
6262f201ae23SFrederic Weisbecker {
6263eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
6264eae849caSFrederic Weisbecker 
6265f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
6266eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
6267eae849caSFrederic Weisbecker 	barrier();
6268eae849caSFrederic Weisbecker 
6269eae849caSFrederic Weisbecker 	kfree(ret_stack);
6270f201ae23SFrederic Weisbecker }
627115e6cb36SFrederic Weisbecker #endif
6272