xref: /linux-6.15/kernel/trace/ftrace.c (revision 3e278c0d)
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>
183d083395SSteven Rostedt #include <linux/kallsyms.h>
195072c59fSSteven Rostedt #include <linux/seq_file.h>
204a2b8ddaSFrederic Weisbecker #include <linux/suspend.h>
218434dc93SSteven Rostedt (Red Hat) #include <linux/tracefs.h>
223d083395SSteven Rostedt #include <linux/hardirq.h>
232d8b820bSIngo Molnar #include <linux/kthread.h>
245072c59fSSteven Rostedt #include <linux/uaccess.h>
255855feadSSteven Rostedt #include <linux/bsearch.h>
2656d82e00SPaul Gortmaker #include <linux/module.h>
272d8b820bSIngo Molnar #include <linux/ftrace.h>
28b0fc494fSSteven Rostedt #include <linux/sysctl.h>
295a0e3ad6STejun Heo #include <linux/slab.h>
305072c59fSSteven Rostedt #include <linux/ctype.h>
3168950619SSteven Rostedt #include <linux/sort.h>
323d083395SSteven Rostedt #include <linux/list.h>
3359df055fSSteven Rostedt #include <linux/hash.h>
343f379b03SPaul E. McKenney #include <linux/rcupdate.h>
3516444a8aSArnaldo Carvalho de Melo 
36ad8d75ffSSteven Rostedt #include <trace/events/sched.h>
378aef2d28SSteven Rostedt 
382af15d6aSSteven Rostedt #include <asm/setup.h>
39395a59d0SAbhishek Sagar 
400706f1c4SSteven Rostedt #include "trace_output.h"
41bac429f0SSteven Rostedt #include "trace_stat.h"
423d083395SSteven Rostedt 
436912896eSSteven Rostedt #define FTRACE_WARN_ON(cond)			\
440778d9adSSteven Rostedt 	({					\
450778d9adSSteven Rostedt 		int ___r = cond;		\
460778d9adSSteven Rostedt 		if (WARN_ON(___r))		\
476912896eSSteven Rostedt 			ftrace_kill();		\
480778d9adSSteven Rostedt 		___r;				\
490778d9adSSteven Rostedt 	})
506912896eSSteven Rostedt 
516912896eSSteven Rostedt #define FTRACE_WARN_ON_ONCE(cond)		\
520778d9adSSteven Rostedt 	({					\
530778d9adSSteven Rostedt 		int ___r = cond;		\
540778d9adSSteven Rostedt 		if (WARN_ON_ONCE(___r))		\
556912896eSSteven Rostedt 			ftrace_kill();		\
560778d9adSSteven Rostedt 		___r;				\
570778d9adSSteven Rostedt 	})
586912896eSSteven Rostedt 
598fc0c701SSteven Rostedt /* hash bits for specific function selection */
608fc0c701SSteven Rostedt #define FTRACE_HASH_BITS 7
618fc0c701SSteven Rostedt #define FTRACE_FUNC_HASHSIZE (1 << FTRACE_HASH_BITS)
6233dc9b12SSteven Rostedt #define FTRACE_HASH_DEFAULT_BITS 10
6333dc9b12SSteven Rostedt #define FTRACE_HASH_MAX_BITS 12
648fc0c701SSteven Rostedt 
65f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
6633b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)	\
6733b7f99cSSteven Rostedt (Red Hat) 	.func_hash		= &opsname.local_hash,			\
6833b7f99cSSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
695f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val) \
705f151b24SSteven Rostedt (Red Hat) 	.func_hash		= val, \
715f151b24SSteven Rostedt (Red Hat) 	.local_hash.regex_lock	= __MUTEX_INITIALIZER(opsname.local_hash.regex_lock),
72f04f24fbSMasami Hiramatsu #else
7333b7f99cSSteven Rostedt (Red Hat) #define INIT_OPS_HASH(opsname)
745f151b24SSteven Rostedt (Red Hat) #define ASSIGN_OPS_HASH(opsname, val)
75f04f24fbSMasami Hiramatsu #endif
76f04f24fbSMasami Hiramatsu 
772f5f6ad9SSteven Rostedt static struct ftrace_ops ftrace_list_end __read_mostly = {
782f5f6ad9SSteven Rostedt 	.func		= ftrace_stub,
79395b97a3SSteven Rostedt (Red Hat) 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_STUB,
8033b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_list_end)
812f5f6ad9SSteven Rostedt };
822f5f6ad9SSteven Rostedt 
834eebcc81SSteven Rostedt /* ftrace_enabled is a method to turn ftrace on or off */
844eebcc81SSteven Rostedt int ftrace_enabled __read_mostly;
85d61f82d0SSteven Rostedt static int last_ftrace_enabled;
86b0fc494fSSteven Rostedt 
872f5f6ad9SSteven Rostedt /* Current function tracing op */
882f5f6ad9SSteven Rostedt struct ftrace_ops *function_trace_op __read_mostly = &ftrace_list_end;
89405e1d83SSteven Rostedt (Red Hat) /* What to set function_trace_op to */
90405e1d83SSteven Rostedt (Red Hat) static struct ftrace_ops *set_function_trace_op;
9160a7ecf4SSteven Rostedt 
92345ddcc8SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(struct ftrace_ops *ops)
93e3eea140SSteven Rostedt (Red Hat) {
94345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr;
95345ddcc8SSteven Rostedt (Red Hat) 
96345ddcc8SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_PID) || !ops->private)
97345ddcc8SSteven Rostedt (Red Hat) 		return false;
98345ddcc8SSteven Rostedt (Red Hat) 
99345ddcc8SSteven Rostedt (Red Hat) 	tr = ops->private;
100345ddcc8SSteven Rostedt (Red Hat) 
101345ddcc8SSteven Rostedt (Red Hat) 	return tr->function_pids != NULL;
102e3eea140SSteven Rostedt (Red Hat) }
103e3eea140SSteven Rostedt (Red Hat) 
104e3eea140SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
105e3eea140SSteven Rostedt (Red Hat) 
1064eebcc81SSteven Rostedt /*
1074eebcc81SSteven Rostedt  * ftrace_disabled is set when an anomaly is discovered.
1084eebcc81SSteven Rostedt  * ftrace_disabled is much stronger than ftrace_enabled.
1094eebcc81SSteven Rostedt  */
1104eebcc81SSteven Rostedt static int ftrace_disabled __read_mostly;
1114eebcc81SSteven Rostedt 
11252baf119SSteven Rostedt static DEFINE_MUTEX(ftrace_lock);
113b0fc494fSSteven Rostedt 
114b848914cSSteven Rostedt static struct ftrace_ops *ftrace_ops_list __read_mostly = &ftrace_list_end;
11516444a8aSArnaldo Carvalho de Melo ftrace_func_t ftrace_trace_function __read_mostly = ftrace_stub;
1162b499381SSteven Rostedt static struct ftrace_ops global_ops;
11716444a8aSArnaldo Carvalho de Melo 
1182f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
1192f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
120a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs);
1212f5f6ad9SSteven Rostedt #else
1222f5f6ad9SSteven Rostedt /* See comment below, where ftrace_ops_list_func is defined */
1232f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip);
1242f5f6ad9SSteven Rostedt #define ftrace_ops_list_func ((ftrace_func_t)ftrace_ops_no_ops)
1252f5f6ad9SSteven Rostedt #endif
126b848914cSSteven Rostedt 
1270a016409SSteven Rostedt /*
1280a016409SSteven Rostedt  * Traverse the ftrace_global_list, invoking all entries.  The reason that we
1291bb539caSSteven Rostedt  * can use rcu_dereference_raw_notrace() is that elements removed from this list
1300a016409SSteven Rostedt  * are simply leaked, so there is no need to interact with a grace-period
1311bb539caSSteven Rostedt  * mechanism.  The rcu_dereference_raw_notrace() calls are needed to handle
1320a016409SSteven Rostedt  * concurrent insertions into the ftrace_global_list.
1330a016409SSteven Rostedt  *
1340a016409SSteven Rostedt  * Silly Alpha and silly pointer-speculation compiler optimizations!
1350a016409SSteven Rostedt  */
1360a016409SSteven Rostedt #define do_for_each_ftrace_op(op, list)			\
1371bb539caSSteven Rostedt 	op = rcu_dereference_raw_notrace(list);			\
1380a016409SSteven Rostedt 	do
1390a016409SSteven Rostedt 
1400a016409SSteven Rostedt /*
1410a016409SSteven Rostedt  * Optimized for just a single item in the list (as that is the normal case).
1420a016409SSteven Rostedt  */
1430a016409SSteven Rostedt #define while_for_each_ftrace_op(op)				\
1441bb539caSSteven Rostedt 	while (likely(op = rcu_dereference_raw_notrace((op)->next)) &&	\
1450a016409SSteven Rostedt 	       unlikely((op) != &ftrace_list_end))
1460a016409SSteven Rostedt 
147f04f24fbSMasami Hiramatsu static inline void ftrace_ops_init(struct ftrace_ops *ops)
148f04f24fbSMasami Hiramatsu {
149f04f24fbSMasami Hiramatsu #ifdef CONFIG_DYNAMIC_FTRACE
150f04f24fbSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_INITIALIZED)) {
15133b7f99cSSteven Rostedt (Red Hat) 		mutex_init(&ops->local_hash.regex_lock);
15233b7f99cSSteven Rostedt (Red Hat) 		ops->func_hash = &ops->local_hash;
153f04f24fbSMasami Hiramatsu 		ops->flags |= FTRACE_OPS_FL_INITIALIZED;
154f04f24fbSMasami Hiramatsu 	}
155f04f24fbSMasami Hiramatsu #endif
156f04f24fbSMasami Hiramatsu }
157f04f24fbSMasami Hiramatsu 
158ea701f11SSteven Rostedt /**
159ea701f11SSteven Rostedt  * ftrace_nr_registered_ops - return number of ops registered
160ea701f11SSteven Rostedt  *
161ea701f11SSteven Rostedt  * Returns the number of ftrace_ops registered and tracing functions
162ea701f11SSteven Rostedt  */
163ea701f11SSteven Rostedt int ftrace_nr_registered_ops(void)
164ea701f11SSteven Rostedt {
165ea701f11SSteven Rostedt 	struct ftrace_ops *ops;
166ea701f11SSteven Rostedt 	int cnt = 0;
167ea701f11SSteven Rostedt 
168ea701f11SSteven Rostedt 	mutex_lock(&ftrace_lock);
169ea701f11SSteven Rostedt 
170ea701f11SSteven Rostedt 	for (ops = ftrace_ops_list;
171ea701f11SSteven Rostedt 	     ops != &ftrace_list_end; ops = ops->next)
172ea701f11SSteven Rostedt 		cnt++;
173ea701f11SSteven Rostedt 
174ea701f11SSteven Rostedt 	mutex_unlock(&ftrace_lock);
175ea701f11SSteven Rostedt 
176ea701f11SSteven Rostedt 	return cnt;
177ea701f11SSteven Rostedt }
178ea701f11SSteven Rostedt 
1792f5f6ad9SSteven Rostedt static void ftrace_pid_func(unsigned long ip, unsigned long parent_ip,
180a1e2e31dSSteven Rostedt 			    struct ftrace_ops *op, struct pt_regs *regs)
181df4fc315SSteven Rostedt {
182345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = op->private;
183345ddcc8SSteven Rostedt (Red Hat) 
184345ddcc8SSteven Rostedt (Red Hat) 	if (tr && this_cpu_read(tr->trace_buffer.data->ftrace_ignore_pid))
185df4fc315SSteven Rostedt 		return;
186df4fc315SSteven Rostedt 
187e3eea140SSteven Rostedt (Red Hat) 	op->saved_func(ip, parent_ip, op, regs);
188df4fc315SSteven Rostedt }
189df4fc315SSteven Rostedt 
19016444a8aSArnaldo Carvalho de Melo /**
1913d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
19216444a8aSArnaldo Carvalho de Melo  *
1933d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1943d083395SSteven Rostedt  * tracing.  There may be lag
19516444a8aSArnaldo Carvalho de Melo  */
1963d083395SSteven Rostedt void clear_ftrace_function(void)
19716444a8aSArnaldo Carvalho de Melo {
1983d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
1993d083395SSteven Rostedt }
20016444a8aSArnaldo Carvalho de Melo 
201ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_disable_all(struct ftrace_ops *ops)
202e248491aSJiri Olsa {
203e248491aSJiri Olsa 	int cpu;
204e248491aSJiri Olsa 
205e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
206e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
207e248491aSJiri Olsa }
208e248491aSJiri Olsa 
209ba27f2bcSSteven Rostedt (Red Hat) static int per_cpu_ops_alloc(struct ftrace_ops *ops)
210e248491aSJiri Olsa {
211e248491aSJiri Olsa 	int __percpu *disabled;
212e248491aSJiri Olsa 
213ba27f2bcSSteven Rostedt (Red Hat) 	if (WARN_ON_ONCE(!(ops->flags & FTRACE_OPS_FL_PER_CPU)))
214ba27f2bcSSteven Rostedt (Red Hat) 		return -EINVAL;
215ba27f2bcSSteven Rostedt (Red Hat) 
216e248491aSJiri Olsa 	disabled = alloc_percpu(int);
217e248491aSJiri Olsa 	if (!disabled)
218e248491aSJiri Olsa 		return -ENOMEM;
219e248491aSJiri Olsa 
220e248491aSJiri Olsa 	ops->disabled = disabled;
221ba27f2bcSSteven Rostedt (Red Hat) 	per_cpu_ops_disable_all(ops);
222e248491aSJiri Olsa 	return 0;
223e248491aSJiri Olsa }
224e248491aSJiri Olsa 
225405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync(struct work_struct *work)
226405e1d83SSteven Rostedt (Red Hat) {
227405e1d83SSteven Rostedt (Red Hat) 	/*
228405e1d83SSteven Rostedt (Red Hat) 	 * This function is just a stub to implement a hard force
229405e1d83SSteven Rostedt (Red Hat) 	 * of synchronize_sched(). This requires synchronizing
230405e1d83SSteven Rostedt (Red Hat) 	 * tasks even in userspace and idle.
231405e1d83SSteven Rostedt (Red Hat) 	 *
232405e1d83SSteven Rostedt (Red Hat) 	 * Yes, function tracing is rude.
233405e1d83SSteven Rostedt (Red Hat) 	 */
234405e1d83SSteven Rostedt (Red Hat) }
235405e1d83SSteven Rostedt (Red Hat) 
236405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
237405e1d83SSteven Rostedt (Red Hat) {
238405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
239405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
240405e1d83SSteven Rostedt (Red Hat) }
241405e1d83SSteven Rostedt (Red Hat) 
24223a8e844SSteven Rostedt (Red Hat) #ifdef CONFIG_FUNCTION_GRAPH_TRACER
24323a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void);
24455577204SSteven Rostedt (Red Hat) 
24555577204SSteven Rostedt (Red Hat) /* Both enabled by default (can be cleared by function_graph tracer flags */
24655577204SSteven Rostedt (Red Hat) static bool fgraph_sleep_time = true;
24755577204SSteven Rostedt (Red Hat) static bool fgraph_graph_time = true;
24855577204SSteven Rostedt (Red Hat) 
24923a8e844SSteven Rostedt (Red Hat) #else
25023a8e844SSteven Rostedt (Red Hat) static inline void update_function_graph_func(void) { }
25123a8e844SSteven Rostedt (Red Hat) #endif
25223a8e844SSteven Rostedt (Red Hat) 
25300ccbf2fSSteven Rostedt (Red Hat) 
25400ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
25500ccbf2fSSteven Rostedt (Red Hat) {
25600ccbf2fSSteven Rostedt (Red Hat) 	/*
257ba27f2bcSSteven Rostedt (Red Hat) 	 * If this is a dynamic, RCU, or per CPU ops, or we force list func,
25800ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
25900ccbf2fSSteven Rostedt (Red Hat) 	 */
260ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU |
261ba27f2bcSSteven Rostedt (Red Hat) 			  FTRACE_OPS_FL_RCU) || FTRACE_FORCE_LIST_FUNC)
26200ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
26300ccbf2fSSteven Rostedt (Red Hat) 
26400ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
26500ccbf2fSSteven Rostedt (Red Hat) }
26600ccbf2fSSteven Rostedt (Red Hat) 
2672b499381SSteven Rostedt static void update_ftrace_function(void)
2682b499381SSteven Rostedt {
2692b499381SSteven Rostedt 	ftrace_func_t func;
2702b499381SSteven Rostedt 
271cdbe61bfSSteven Rostedt 	/*
272f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
273f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
274f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
275f7aad4e1SSteven Rostedt (Red Hat) 	 */
276f7aad4e1SSteven Rostedt (Red Hat) 	set_function_trace_op = ftrace_ops_list;
277f7aad4e1SSteven Rostedt (Red Hat) 
278f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
279f7aad4e1SSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
280f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
281f7aad4e1SSteven Rostedt (Red Hat) 
282f7aad4e1SSteven Rostedt (Red Hat) 	/*
283cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2844740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2854740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
286cdbe61bfSSteven Rostedt 	 */
287f7aad4e1SSteven Rostedt (Red Hat) 	} else if (ftrace_ops_list->next == &ftrace_list_end) {
28800ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
289f7aad4e1SSteven Rostedt (Red Hat) 
2902f5f6ad9SSteven Rostedt 	} else {
2912f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
292405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
293b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2942f5f6ad9SSteven Rostedt 	}
2952b499381SSteven Rostedt 
2965f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2975f8bf2d2SSteven Rostedt (Red Hat) 
298405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
299405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
300405e1d83SSteven Rostedt (Red Hat) 		return;
301405e1d83SSteven Rostedt (Red Hat) 
302405e1d83SSteven Rostedt (Red Hat) 	/*
303405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
304405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
305405e1d83SSteven Rostedt (Red Hat) 	 */
306405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
307405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
308405e1d83SSteven Rostedt (Red Hat) 		/*
309405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
310405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
311405e1d83SSteven Rostedt (Red Hat) 		 */
312405e1d83SSteven Rostedt (Red Hat) 		return;
313405e1d83SSteven Rostedt (Red Hat) 	}
314405e1d83SSteven Rostedt (Red Hat) 
315405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
316405e1d83SSteven Rostedt (Red Hat) 	/*
317405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
318405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
319405e1d83SSteven Rostedt (Red Hat) 	 * we need to coorditate the setting of the function_trace_ops
320405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
321405e1d83SSteven Rostedt (Red Hat) 	 *
322405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
323405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
324405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
325405e1d83SSteven Rostedt (Red Hat) 	 */
326405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
327405e1d83SSteven Rostedt (Red Hat) 	/*
328405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
329405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
330405e1d83SSteven Rostedt (Red Hat) 	 */
331405e1d83SSteven Rostedt (Red Hat) 	schedule_on_each_cpu(ftrace_sync);
332405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
333405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
334405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
335405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
336405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
337405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
338405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
339405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
340405e1d83SSteven Rostedt (Red Hat) 
341491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
342491d0dcfSSteven Rostedt }
343491d0dcfSSteven Rostedt 
3447eea4fceSJiaxing Wang int using_ftrace_ops_list_func(void)
3457eea4fceSJiaxing Wang {
3467eea4fceSJiaxing Wang 	return ftrace_trace_function == ftrace_ops_list_func;
3477eea4fceSJiaxing Wang }
3487eea4fceSJiaxing Wang 
3492b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3503d083395SSteven Rostedt {
3512b499381SSteven Rostedt 	ops->next = *list;
35216444a8aSArnaldo Carvalho de Melo 	/*
353b848914cSSteven Rostedt 	 * We are entering ops into the list but another
35416444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
35516444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
356b848914cSSteven Rostedt 	 * the ops pointer included into the list.
35716444a8aSArnaldo Carvalho de Melo 	 */
3582b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
3592b499381SSteven Rostedt }
3603d083395SSteven Rostedt 
3612b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3622b499381SSteven Rostedt {
3632b499381SSteven Rostedt 	struct ftrace_ops **p;
3642b499381SSteven Rostedt 
3652b499381SSteven Rostedt 	/*
3662b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3672b499381SSteven Rostedt 	 * to the ftrace_stub.
3682b499381SSteven Rostedt 	 */
3692b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
3702b499381SSteven Rostedt 		*list = &ftrace_list_end;
3712b499381SSteven Rostedt 		return 0;
3722b499381SSteven Rostedt 	}
3732b499381SSteven Rostedt 
3742b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3752b499381SSteven Rostedt 		if (*p == ops)
3762b499381SSteven Rostedt 			break;
3772b499381SSteven Rostedt 
3782b499381SSteven Rostedt 	if (*p != ops)
3792b499381SSteven Rostedt 		return -1;
3802b499381SSteven Rostedt 
3812b499381SSteven Rostedt 	*p = (*p)->next;
3822b499381SSteven Rostedt 	return 0;
3832b499381SSteven Rostedt }
3842b499381SSteven Rostedt 
385f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
386f3bea491SSteven Rostedt (Red Hat) 
3872b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3882b499381SSteven Rostedt {
389591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
390591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
391591dffdaSSteven Rostedt (Red Hat) 
392b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
393b848914cSSteven Rostedt 		return -EBUSY;
394b848914cSSteven Rostedt 
39506aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
39608f6fba5SSteven Rostedt 	/*
39708f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
39808f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
39908f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
40008f6fba5SSteven Rostedt 	 */
40108f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
40208f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
40308f6fba5SSteven Rostedt 		return -EINVAL;
40408f6fba5SSteven Rostedt 
40508f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
40608f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
40708f6fba5SSteven Rostedt #endif
40808f6fba5SSteven Rostedt 
409cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
410cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
411cdbe61bfSSteven Rostedt 
412ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_PER_CPU) {
413ba27f2bcSSteven Rostedt (Red Hat) 		if (per_cpu_ops_alloc(ops))
414e248491aSJiri Olsa 			return -ENOMEM;
415ba27f2bcSSteven Rostedt (Red Hat) 	}
416ba27f2bcSSteven Rostedt (Red Hat) 
417b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
418b848914cSSteven Rostedt 
419e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
420e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
421e3eea140SSteven Rostedt (Red Hat) 
422345ddcc8SSteven Rostedt (Red Hat) 	if (ftrace_pids_enabled(ops))
423e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
424e3eea140SSteven Rostedt (Red Hat) 
425f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
426f3bea491SSteven Rostedt (Red Hat) 
427491d0dcfSSteven Rostedt 	if (ftrace_enabled)
428491d0dcfSSteven Rostedt 		update_ftrace_function();
4293d083395SSteven Rostedt 
43016444a8aSArnaldo Carvalho de Melo 	return 0;
43116444a8aSArnaldo Carvalho de Melo }
43216444a8aSArnaldo Carvalho de Melo 
433e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
43416444a8aSArnaldo Carvalho de Melo {
4352b499381SSteven Rostedt 	int ret;
43616444a8aSArnaldo Carvalho de Melo 
437b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
438b848914cSSteven Rostedt 		return -EBUSY;
439b848914cSSteven Rostedt 
440b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
441b848914cSSteven Rostedt 
4422b499381SSteven Rostedt 	if (ret < 0)
4432b499381SSteven Rostedt 		return ret;
444b848914cSSteven Rostedt 
445491d0dcfSSteven Rostedt 	if (ftrace_enabled)
446491d0dcfSSteven Rostedt 		update_ftrace_function();
44716444a8aSArnaldo Carvalho de Melo 
448e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
449e3eea140SSteven Rostedt (Red Hat) 
450e6ea44e9SSteven Rostedt 	return 0;
4513d083395SSteven Rostedt }
4523d083395SSteven Rostedt 
453df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
454df4fc315SSteven Rostedt {
455e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
456e3eea140SSteven Rostedt (Red Hat) 
457491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
458df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
45910dd3ebeSKOSAKI Motohiro 		return;
460df4fc315SSteven Rostedt 
461e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
462e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
463345ddcc8SSteven Rostedt (Red Hat) 			op->func = ftrace_pids_enabled(op) ?
464345ddcc8SSteven Rostedt (Red Hat) 				ftrace_pid_func : op->saved_func;
465e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
466e3eea140SSteven Rostedt (Red Hat) 		}
467e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
468e3eea140SSteven Rostedt (Red Hat) 
469491d0dcfSSteven Rostedt 	update_ftrace_function();
470df4fc315SSteven Rostedt }
471df4fc315SSteven Rostedt 
472493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
473493762fcSSteven Rostedt struct ftrace_profile {
474493762fcSSteven Rostedt 	struct hlist_node		node;
475493762fcSSteven Rostedt 	unsigned long			ip;
476493762fcSSteven Rostedt 	unsigned long			counter;
4770706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4780706f1c4SSteven Rostedt 	unsigned long long		time;
479e330b3bcSChase Douglas 	unsigned long long		time_squared;
4800706f1c4SSteven Rostedt #endif
481493762fcSSteven Rostedt };
482493762fcSSteven Rostedt 
483493762fcSSteven Rostedt struct ftrace_profile_page {
484493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
485493762fcSSteven Rostedt 	unsigned long			index;
486493762fcSSteven Rostedt 	struct ftrace_profile		records[];
487493762fcSSteven Rostedt };
488493762fcSSteven Rostedt 
489cafb168aSSteven Rostedt struct ftrace_profile_stat {
490cafb168aSSteven Rostedt 	atomic_t			disabled;
491cafb168aSSteven Rostedt 	struct hlist_head		*hash;
492cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
493cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
494cafb168aSSteven Rostedt 	struct tracer_stat		stat;
495cafb168aSSteven Rostedt };
496cafb168aSSteven Rostedt 
497493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
498493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
499493762fcSSteven Rostedt 
500493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
501493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
502493762fcSSteven Rostedt 
503fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
504fb9fb015SSteven Rostedt 
505fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
506493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
507493762fcSSteven Rostedt 
508cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
509493762fcSSteven Rostedt 
51020079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
51120079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
512493762fcSSteven Rostedt 
513493762fcSSteven Rostedt static void *
514493762fcSSteven Rostedt function_stat_next(void *v, int idx)
515493762fcSSteven Rostedt {
516493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
517493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
518493762fcSSteven Rostedt 
519493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
520493762fcSSteven Rostedt 
521493762fcSSteven Rostedt  again:
5220296e425SLi Zefan 	if (idx != 0)
523493762fcSSteven Rostedt 		rec++;
5240296e425SLi Zefan 
525493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
526493762fcSSteven Rostedt 		pg = pg->next;
527493762fcSSteven Rostedt 		if (!pg)
528493762fcSSteven Rostedt 			return NULL;
529493762fcSSteven Rostedt 		rec = &pg->records[0];
530493762fcSSteven Rostedt 		if (!rec->counter)
531493762fcSSteven Rostedt 			goto again;
532493762fcSSteven Rostedt 	}
533493762fcSSteven Rostedt 
534493762fcSSteven Rostedt 	return rec;
535493762fcSSteven Rostedt }
536493762fcSSteven Rostedt 
537493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
538493762fcSSteven Rostedt {
539cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
540cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
541cafb168aSSteven Rostedt 
542cafb168aSSteven Rostedt 	if (!stat || !stat->start)
543cafb168aSSteven Rostedt 		return NULL;
544cafb168aSSteven Rostedt 
545cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
546493762fcSSteven Rostedt }
547493762fcSSteven Rostedt 
5480706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5490706f1c4SSteven Rostedt /* function graph compares on total time */
5500706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
5510706f1c4SSteven Rostedt {
5520706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
5530706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
5540706f1c4SSteven Rostedt 
5550706f1c4SSteven Rostedt 	if (a->time < b->time)
5560706f1c4SSteven Rostedt 		return -1;
5570706f1c4SSteven Rostedt 	if (a->time > b->time)
5580706f1c4SSteven Rostedt 		return 1;
5590706f1c4SSteven Rostedt 	else
5600706f1c4SSteven Rostedt 		return 0;
5610706f1c4SSteven Rostedt }
5620706f1c4SSteven Rostedt #else
5630706f1c4SSteven Rostedt /* not function graph compares against hits */
564493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
565493762fcSSteven Rostedt {
566493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
567493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
568493762fcSSteven Rostedt 
569493762fcSSteven Rostedt 	if (a->counter < b->counter)
570493762fcSSteven Rostedt 		return -1;
571493762fcSSteven Rostedt 	if (a->counter > b->counter)
572493762fcSSteven Rostedt 		return 1;
573493762fcSSteven Rostedt 	else
574493762fcSSteven Rostedt 		return 0;
575493762fcSSteven Rostedt }
5760706f1c4SSteven Rostedt #endif
577493762fcSSteven Rostedt 
578493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
579493762fcSSteven Rostedt {
5800706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
581fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
582e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
58334886c8bSSteven Rostedt 		    "  --------                               "
584e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5850706f1c4SSteven Rostedt #else
586fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
587493762fcSSteven Rostedt 		    "  --------                               ---\n");
5880706f1c4SSteven Rostedt #endif
589493762fcSSteven Rostedt 	return 0;
590493762fcSSteven Rostedt }
591493762fcSSteven Rostedt 
592493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
593493762fcSSteven Rostedt {
594493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
595493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5963aaba20fSLi Zefan 	int ret = 0;
5970706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
59834886c8bSSteven Rostedt 	static struct trace_seq s;
59934886c8bSSteven Rostedt 	unsigned long long avg;
600e330b3bcSChase Douglas 	unsigned long long stddev;
6010706f1c4SSteven Rostedt #endif
6023aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
6033aaba20fSLi Zefan 
6043aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
6053aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
6063aaba20fSLi Zefan 		ret = -EBUSY;
6073aaba20fSLi Zefan 		goto out;
6083aaba20fSLi Zefan 	}
609493762fcSSteven Rostedt 
6108e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6118e436ca0SUmesh Tiwari 	avg = rec->time;
6128e436ca0SUmesh Tiwari 	do_div(avg, rec->counter);
6138e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
6148e436ca0SUmesh Tiwari 		goto out;
6158e436ca0SUmesh Tiwari #endif
6168e436ca0SUmesh Tiwari 
617493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
6180706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
619493762fcSSteven Rostedt 
6200706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
621fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
62234886c8bSSteven Rostedt 
623e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
624e330b3bcSChase Douglas 	if (rec->counter <= 1)
625e330b3bcSChase Douglas 		stddev = 0;
626e330b3bcSChase Douglas 	else {
62752d85d76SJuri Lelli 		/*
62852d85d76SJuri Lelli 		 * Apply Welford's method:
62952d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
63052d85d76SJuri Lelli 		 */
63152d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
63252d85d76SJuri Lelli 			 rec->time * rec->time;
63352d85d76SJuri Lelli 
634e330b3bcSChase Douglas 		/*
635e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
636e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
637e330b3bcSChase Douglas 		 */
63852d85d76SJuri Lelli 		do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
639e330b3bcSChase Douglas 	}
640e330b3bcSChase Douglas 
64134886c8bSSteven Rostedt 	trace_seq_init(&s);
64234886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
64334886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
64434886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
645e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
646e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
6470706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
6480706f1c4SSteven Rostedt #endif
6490706f1c4SSteven Rostedt 	seq_putc(m, '\n');
6503aaba20fSLi Zefan out:
6513aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
6520706f1c4SSteven Rostedt 
6533aaba20fSLi Zefan 	return ret;
654493762fcSSteven Rostedt }
655493762fcSSteven Rostedt 
656cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
657493762fcSSteven Rostedt {
658493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
659493762fcSSteven Rostedt 
660cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
661493762fcSSteven Rostedt 
662493762fcSSteven Rostedt 	while (pg) {
663493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
664493762fcSSteven Rostedt 		pg->index = 0;
665493762fcSSteven Rostedt 		pg = pg->next;
666493762fcSSteven Rostedt 	}
667493762fcSSteven Rostedt 
668cafb168aSSteven Rostedt 	memset(stat->hash, 0,
669493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
670493762fcSSteven Rostedt }
671493762fcSSteven Rostedt 
672cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
673493762fcSSteven Rostedt {
674493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
675318e0a73SSteven Rostedt 	int functions;
676318e0a73SSteven Rostedt 	int pages;
677493762fcSSteven Rostedt 	int i;
678493762fcSSteven Rostedt 
679493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
680cafb168aSSteven Rostedt 	if (stat->pages)
681493762fcSSteven Rostedt 		return 0;
682493762fcSSteven Rostedt 
683cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
684cafb168aSSteven Rostedt 	if (!stat->pages)
685493762fcSSteven Rostedt 		return -ENOMEM;
686493762fcSSteven Rostedt 
687318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
688318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
689318e0a73SSteven Rostedt #else
690318e0a73SSteven Rostedt 	/*
691318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
692318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
693318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
694318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
695318e0a73SSteven Rostedt 	 * the kernel.
696318e0a73SSteven Rostedt 	 */
697318e0a73SSteven Rostedt 	functions = 20000;
698318e0a73SSteven Rostedt #endif
699318e0a73SSteven Rostedt 
700cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
701493762fcSSteven Rostedt 
702318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
703318e0a73SSteven Rostedt 
70439e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
705493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
706493762fcSSteven Rostedt 		if (!pg->next)
707318e0a73SSteven Rostedt 			goto out_free;
708493762fcSSteven Rostedt 		pg = pg->next;
709493762fcSSteven Rostedt 	}
710493762fcSSteven Rostedt 
711493762fcSSteven Rostedt 	return 0;
712318e0a73SSteven Rostedt 
713318e0a73SSteven Rostedt  out_free:
714318e0a73SSteven Rostedt 	pg = stat->start;
715318e0a73SSteven Rostedt 	while (pg) {
716318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
717318e0a73SSteven Rostedt 
718318e0a73SSteven Rostedt 		pg = pg->next;
719318e0a73SSteven Rostedt 		free_page(tmp);
720318e0a73SSteven Rostedt 	}
721318e0a73SSteven Rostedt 
722318e0a73SSteven Rostedt 	stat->pages = NULL;
723318e0a73SSteven Rostedt 	stat->start = NULL;
724318e0a73SSteven Rostedt 
725318e0a73SSteven Rostedt 	return -ENOMEM;
726493762fcSSteven Rostedt }
727493762fcSSteven Rostedt 
728cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
729493762fcSSteven Rostedt {
730cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
731493762fcSSteven Rostedt 	int size;
732493762fcSSteven Rostedt 
733cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
734cafb168aSSteven Rostedt 
735cafb168aSSteven Rostedt 	if (stat->hash) {
736493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
737cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
738493762fcSSteven Rostedt 		return 0;
739493762fcSSteven Rostedt 	}
740493762fcSSteven Rostedt 
741493762fcSSteven Rostedt 	/*
742493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
743493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
744493762fcSSteven Rostedt 	 */
745493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
746493762fcSSteven Rostedt 
747cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
748493762fcSSteven Rostedt 
749cafb168aSSteven Rostedt 	if (!stat->hash)
750493762fcSSteven Rostedt 		return -ENOMEM;
751493762fcSSteven Rostedt 
752318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
753cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
754cafb168aSSteven Rostedt 		kfree(stat->hash);
755cafb168aSSteven Rostedt 		stat->hash = NULL;
756493762fcSSteven Rostedt 		return -ENOMEM;
757493762fcSSteven Rostedt 	}
758493762fcSSteven Rostedt 
759493762fcSSteven Rostedt 	return 0;
760493762fcSSteven Rostedt }
761493762fcSSteven Rostedt 
762cafb168aSSteven Rostedt static int ftrace_profile_init(void)
763cafb168aSSteven Rostedt {
764cafb168aSSteven Rostedt 	int cpu;
765cafb168aSSteven Rostedt 	int ret = 0;
766cafb168aSSteven Rostedt 
767c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
768cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
769cafb168aSSteven Rostedt 		if (ret)
770cafb168aSSteven Rostedt 			break;
771cafb168aSSteven Rostedt 	}
772cafb168aSSteven Rostedt 
773cafb168aSSteven Rostedt 	return ret;
774cafb168aSSteven Rostedt }
775cafb168aSSteven Rostedt 
776493762fcSSteven Rostedt /* interrupts must be disabled */
777cafb168aSSteven Rostedt static struct ftrace_profile *
778cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
779493762fcSSteven Rostedt {
780493762fcSSteven Rostedt 	struct ftrace_profile *rec;
781493762fcSSteven Rostedt 	struct hlist_head *hhd;
782493762fcSSteven Rostedt 	unsigned long key;
783493762fcSSteven Rostedt 
78420079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
785cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
786493762fcSSteven Rostedt 
787493762fcSSteven Rostedt 	if (hlist_empty(hhd))
788493762fcSSteven Rostedt 		return NULL;
789493762fcSSteven Rostedt 
7901bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
791493762fcSSteven Rostedt 		if (rec->ip == ip)
792493762fcSSteven Rostedt 			return rec;
793493762fcSSteven Rostedt 	}
794493762fcSSteven Rostedt 
795493762fcSSteven Rostedt 	return NULL;
796493762fcSSteven Rostedt }
797493762fcSSteven Rostedt 
798cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
799cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
800493762fcSSteven Rostedt {
801493762fcSSteven Rostedt 	unsigned long key;
802493762fcSSteven Rostedt 
80320079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
804cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
805493762fcSSteven Rostedt }
806493762fcSSteven Rostedt 
807318e0a73SSteven Rostedt /*
808318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
809318e0a73SSteven Rostedt  */
810493762fcSSteven Rostedt static struct ftrace_profile *
811318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
812493762fcSSteven Rostedt {
813493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
814493762fcSSteven Rostedt 
815318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
816cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
817493762fcSSteven Rostedt 		goto out;
818493762fcSSteven Rostedt 
819493762fcSSteven Rostedt 	/*
820318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
821318e0a73SSteven Rostedt 	 * could have added it
822493762fcSSteven Rostedt 	 */
823cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
824493762fcSSteven Rostedt 	if (rec)
825cafb168aSSteven Rostedt 		goto out;
826493762fcSSteven Rostedt 
827cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
828cafb168aSSteven Rostedt 		if (!stat->pages->next)
829cafb168aSSteven Rostedt 			goto out;
830cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
831493762fcSSteven Rostedt 	}
832493762fcSSteven Rostedt 
833cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
834493762fcSSteven Rostedt 	rec->ip = ip;
835cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
836493762fcSSteven Rostedt 
837493762fcSSteven Rostedt  out:
838cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
839493762fcSSteven Rostedt 
840493762fcSSteven Rostedt 	return rec;
841493762fcSSteven Rostedt }
842493762fcSSteven Rostedt 
843493762fcSSteven Rostedt static void
8442f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
845a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
846493762fcSSteven Rostedt {
847cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
848493762fcSSteven Rostedt 	struct ftrace_profile *rec;
849493762fcSSteven Rostedt 	unsigned long flags;
850493762fcSSteven Rostedt 
851493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
852493762fcSSteven Rostedt 		return;
853493762fcSSteven Rostedt 
854493762fcSSteven Rostedt 	local_irq_save(flags);
855cafb168aSSteven Rostedt 
856bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8570f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
858cafb168aSSteven Rostedt 		goto out;
859cafb168aSSteven Rostedt 
860cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
861493762fcSSteven Rostedt 	if (!rec) {
862318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
863493762fcSSteven Rostedt 		if (!rec)
864493762fcSSteven Rostedt 			goto out;
865493762fcSSteven Rostedt 	}
866493762fcSSteven Rostedt 
867493762fcSSteven Rostedt 	rec->counter++;
868493762fcSSteven Rostedt  out:
869493762fcSSteven Rostedt 	local_irq_restore(flags);
870493762fcSSteven Rostedt }
871493762fcSSteven Rostedt 
8720706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8730706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8740706f1c4SSteven Rostedt {
8758861dd30SNamhyung Kim 	int index = trace->depth;
8768861dd30SNamhyung Kim 
877a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8788861dd30SNamhyung Kim 
8798861dd30SNamhyung Kim 	if (index >= 0 && index < FTRACE_RETFUNC_DEPTH)
8808861dd30SNamhyung Kim 		current->ret_stack[index].subtime = 0;
8818861dd30SNamhyung Kim 
8820706f1c4SSteven Rostedt 	return 1;
8830706f1c4SSteven Rostedt }
8840706f1c4SSteven Rostedt 
8850706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8860706f1c4SSteven Rostedt {
887cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
888a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8890706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
890cafb168aSSteven Rostedt 	unsigned long flags;
8910706f1c4SSteven Rostedt 
8920706f1c4SSteven Rostedt 	local_irq_save(flags);
893bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8940f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
895cafb168aSSteven Rostedt 		goto out;
896cafb168aSSteven Rostedt 
89737e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
89837e44bc5SSteven Rostedt 	if (!trace->calltime)
89937e44bc5SSteven Rostedt 		goto out;
90037e44bc5SSteven Rostedt 
901a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
902a2a16d6aSSteven Rostedt 
90355577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
904a2a16d6aSSteven Rostedt 		int index;
905a2a16d6aSSteven Rostedt 
906a2a16d6aSSteven Rostedt 		index = trace->depth;
907a2a16d6aSSteven Rostedt 
908a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
909a2a16d6aSSteven Rostedt 		if (index)
910a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
911a2a16d6aSSteven Rostedt 
912a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
913a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
914a2a16d6aSSteven Rostedt 		else
915a2a16d6aSSteven Rostedt 			calltime = 0;
916a2a16d6aSSteven Rostedt 	}
917a2a16d6aSSteven Rostedt 
918cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
919e330b3bcSChase Douglas 	if (rec) {
920a2a16d6aSSteven Rostedt 		rec->time += calltime;
921e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
922e330b3bcSChase Douglas 	}
923a2a16d6aSSteven Rostedt 
924cafb168aSSteven Rostedt  out:
9250706f1c4SSteven Rostedt 	local_irq_restore(flags);
9260706f1c4SSteven Rostedt }
9270706f1c4SSteven Rostedt 
9280706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9290706f1c4SSteven Rostedt {
9300706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
9310706f1c4SSteven Rostedt 				     &profile_graph_entry);
9320706f1c4SSteven Rostedt }
9330706f1c4SSteven Rostedt 
9340706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9350706f1c4SSteven Rostedt {
9360706f1c4SSteven Rostedt 	unregister_ftrace_graph();
9370706f1c4SSteven Rostedt }
9380706f1c4SSteven Rostedt #else
939bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
940493762fcSSteven Rostedt 	.func		= function_profile_call,
941f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
94233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
943493762fcSSteven Rostedt };
944493762fcSSteven Rostedt 
9450706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9460706f1c4SSteven Rostedt {
9470706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9480706f1c4SSteven Rostedt }
9490706f1c4SSteven Rostedt 
9500706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9510706f1c4SSteven Rostedt {
9520706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9530706f1c4SSteven Rostedt }
9540706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9550706f1c4SSteven Rostedt 
956493762fcSSteven Rostedt static ssize_t
957493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
958493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
959493762fcSSteven Rostedt {
960493762fcSSteven Rostedt 	unsigned long val;
961493762fcSSteven Rostedt 	int ret;
962493762fcSSteven Rostedt 
96322fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
96422fe9b54SPeter Huewe 	if (ret)
965493762fcSSteven Rostedt 		return ret;
966493762fcSSteven Rostedt 
967493762fcSSteven Rostedt 	val = !!val;
968493762fcSSteven Rostedt 
969493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
970493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
971493762fcSSteven Rostedt 		if (val) {
972493762fcSSteven Rostedt 			ret = ftrace_profile_init();
973493762fcSSteven Rostedt 			if (ret < 0) {
974493762fcSSteven Rostedt 				cnt = ret;
975493762fcSSteven Rostedt 				goto out;
976493762fcSSteven Rostedt 			}
977493762fcSSteven Rostedt 
9780706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9790706f1c4SSteven Rostedt 			if (ret < 0) {
9800706f1c4SSteven Rostedt 				cnt = ret;
9810706f1c4SSteven Rostedt 				goto out;
9820706f1c4SSteven Rostedt 			}
983493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
984493762fcSSteven Rostedt 		} else {
985493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9860f6ce3deSSteven Rostedt 			/*
9870f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9880f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9890f6ce3deSSteven Rostedt 			 */
9900706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
991493762fcSSteven Rostedt 		}
992493762fcSSteven Rostedt 	}
993493762fcSSteven Rostedt  out:
994493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
995493762fcSSteven Rostedt 
996cf8517cfSJiri Olsa 	*ppos += cnt;
997493762fcSSteven Rostedt 
998493762fcSSteven Rostedt 	return cnt;
999493762fcSSteven Rostedt }
1000493762fcSSteven Rostedt 
1001493762fcSSteven Rostedt static ssize_t
1002493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
1003493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
1004493762fcSSteven Rostedt {
1005fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
1006493762fcSSteven Rostedt 	int r;
1007493762fcSSteven Rostedt 
1008493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
1009493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
1010493762fcSSteven Rostedt }
1011493762fcSSteven Rostedt 
1012493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
1013493762fcSSteven Rostedt 	.open		= tracing_open_generic,
1014493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
1015493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
10166038f373SArnd Bergmann 	.llseek		= default_llseek,
1017493762fcSSteven Rostedt };
1018493762fcSSteven Rostedt 
1019cafb168aSSteven Rostedt /* used to initialize the real stat files */
1020cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
1021cafb168aSSteven Rostedt 	.name		= "functions",
1022cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
1023cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
1024cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
1025cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
1026cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
1027cafb168aSSteven Rostedt };
1028cafb168aSSteven Rostedt 
10298434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1030493762fcSSteven Rostedt {
1031cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
1032493762fcSSteven Rostedt 	struct dentry *entry;
1033cafb168aSSteven Rostedt 	char *name;
1034493762fcSSteven Rostedt 	int ret;
1035cafb168aSSteven Rostedt 	int cpu;
1036493762fcSSteven Rostedt 
1037cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
1038cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
1039cafb168aSSteven Rostedt 
10406363c6b5SGeliang Tang 		name = kasprintf(GFP_KERNEL, "function%d", cpu);
1041cafb168aSSteven Rostedt 		if (!name) {
1042cafb168aSSteven Rostedt 			/*
1043cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1044cafb168aSSteven Rostedt 			 * we still do not free memory.
1045cafb168aSSteven Rostedt 			 */
1046cafb168aSSteven Rostedt 			WARN(1,
1047cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1048cafb168aSSteven Rostedt 			     cpu);
1049493762fcSSteven Rostedt 			return;
1050493762fcSSteven Rostedt 		}
1051cafb168aSSteven Rostedt 		stat->stat = function_stats;
1052cafb168aSSteven Rostedt 		stat->stat.name = name;
1053cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1054cafb168aSSteven Rostedt 		if (ret) {
1055cafb168aSSteven Rostedt 			WARN(1,
1056cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1057cafb168aSSteven Rostedt 			     cpu);
1058cafb168aSSteven Rostedt 			kfree(name);
1059cafb168aSSteven Rostedt 			return;
1060cafb168aSSteven Rostedt 		}
1061cafb168aSSteven Rostedt 	}
1062493762fcSSteven Rostedt 
10638434dc93SSteven Rostedt (Red Hat) 	entry = tracefs_create_file("function_profile_enabled", 0644,
1064493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
1065493762fcSSteven Rostedt 	if (!entry)
1066a395d6a7SJoe Perches 		pr_warn("Could not create tracefs 'function_profile_enabled' entry\n");
1067493762fcSSteven Rostedt }
1068493762fcSSteven Rostedt 
1069493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10708434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1071493762fcSSteven Rostedt {
1072493762fcSSteven Rostedt }
1073493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1074493762fcSSteven Rostedt 
107573d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
107673d3fd96SIngo Molnar 
10771619dc3fSPratyush Anand #ifdef CONFIG_FUNCTION_GRAPH_TRACER
10781619dc3fSPratyush Anand static int ftrace_graph_active;
10791619dc3fSPratyush Anand #else
10801619dc3fSPratyush Anand # define ftrace_graph_active 0
10811619dc3fSPratyush Anand #endif
10821619dc3fSPratyush Anand 
10833d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
108473d3fd96SIngo Molnar 
108579922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
108679922b80SSteven Rostedt (Red Hat) 
1087e1effa01SSteven Rostedt (Red Hat) /*
1088e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1089e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1090e1effa01SSteven Rostedt (Red Hat)  */
1091e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1092e1effa01SSteven Rostedt (Red Hat) 
109399ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1094cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
109599ecdc43SSteven Rostedt #endif
109699ecdc43SSteven Rostedt 
10978fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
10988fc0c701SSteven Rostedt 
1099b6887d79SSteven Rostedt struct ftrace_func_probe {
11008fc0c701SSteven Rostedt 	struct hlist_node	node;
1101b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
11028fc0c701SSteven Rostedt 	unsigned long		flags;
11038fc0c701SSteven Rostedt 	unsigned long		ip;
11048fc0c701SSteven Rostedt 	void			*data;
11057818b388SSteven Rostedt (Red Hat) 	struct list_head	free_list;
11068fc0c701SSteven Rostedt };
11078fc0c701SSteven Rostedt 
1108b448c4e3SSteven Rostedt struct ftrace_func_entry {
1109b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1110b448c4e3SSteven Rostedt 	unsigned long ip;
1111b448c4e3SSteven Rostedt };
1112b448c4e3SSteven Rostedt 
1113b448c4e3SSteven Rostedt struct ftrace_hash {
1114b448c4e3SSteven Rostedt 	unsigned long		size_bits;
1115b448c4e3SSteven Rostedt 	struct hlist_head	*buckets;
1116b448c4e3SSteven Rostedt 	unsigned long		count;
111707fd5515SSteven Rostedt 	struct rcu_head		rcu;
1118b448c4e3SSteven Rostedt };
1119b448c4e3SSteven Rostedt 
112033dc9b12SSteven Rostedt /*
112133dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
112233dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
112333dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
112433dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
112533dc9b12SSteven Rostedt  */
112633dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
112733dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
112833dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1129b448c4e3SSteven Rostedt };
113033dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
11315072c59fSSteven Rostedt 
11322b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1133f45948e8SSteven Rostedt 	.func				= ftrace_stub,
113433b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
113533b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
113633b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
113733b7f99cSSteven Rostedt (Red Hat) 	.flags				= FTRACE_OPS_FL_RECURSION_SAFE |
1138e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_INITIALIZED |
1139e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1140f45948e8SSteven Rostedt };
1141f45948e8SSteven Rostedt 
1142aec0be2dSSteven Rostedt (Red Hat) /*
1143aec0be2dSSteven Rostedt (Red Hat)  * This is used by __kernel_text_address() to return true if the
11440af26492SSteven Rostedt (Red Hat)  * address is on a dynamically allocated trampoline that would
1145aec0be2dSSteven Rostedt (Red Hat)  * not return true for either core_kernel_text() or
1146aec0be2dSSteven Rostedt (Red Hat)  * is_module_text_address().
1147aec0be2dSSteven Rostedt (Red Hat)  */
1148aec0be2dSSteven Rostedt (Red Hat) bool is_ftrace_trampoline(unsigned long addr)
1149aec0be2dSSteven Rostedt (Red Hat) {
1150aec0be2dSSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
1151aec0be2dSSteven Rostedt (Red Hat) 	bool ret = false;
1152aec0be2dSSteven Rostedt (Red Hat) 
1153aec0be2dSSteven Rostedt (Red Hat) 	/*
1154aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
1155aec0be2dSSteven Rostedt (Red Hat) 	 * they are freed after a synchronize_sched().
1156aec0be2dSSteven Rostedt (Red Hat) 	 */
1157aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1158aec0be2dSSteven Rostedt (Red Hat) 
1159aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1160aec0be2dSSteven Rostedt (Red Hat) 		/*
1161aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1162aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1163aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1164aec0be2dSSteven Rostedt (Red Hat) 		 */
1165aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1166aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1167aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
1168aec0be2dSSteven Rostedt (Red Hat) 				ret = true;
1169aec0be2dSSteven Rostedt (Red Hat) 				goto out;
1170aec0be2dSSteven Rostedt (Red Hat) 			}
1171aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1172aec0be2dSSteven Rostedt (Red Hat) 
1173aec0be2dSSteven Rostedt (Red Hat)  out:
1174aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1175aec0be2dSSteven Rostedt (Red Hat) 
1176aec0be2dSSteven Rostedt (Red Hat) 	return ret;
1177aec0be2dSSteven Rostedt (Red Hat) }
1178aec0be2dSSteven Rostedt (Red Hat) 
11793c1720f0SSteven Rostedt struct ftrace_page {
11803c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1181a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1182431aa3fbSSteven Rostedt 	int			index;
1183a7900875SSteven Rostedt 	int			size;
1184aa5e5ceaSDavid Miller };
11853c1720f0SSteven Rostedt 
1186a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1187a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11883c1720f0SSteven Rostedt 
11893c1720f0SSteven Rostedt /* estimate from running different kernels */
11903c1720f0SSteven Rostedt #define NR_TO_INIT		10000
11913c1720f0SSteven Rostedt 
11923c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11933c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11943c1720f0SSteven Rostedt 
119568f40969SSteven Rostedt (Red Hat) static bool __always_inline ftrace_hash_empty(struct ftrace_hash *hash)
119606a51d93SSteven Rostedt {
119706a51d93SSteven Rostedt 	return !hash || !hash->count;
119806a51d93SSteven Rostedt }
119906a51d93SSteven Rostedt 
1200b448c4e3SSteven Rostedt static struct ftrace_func_entry *
1201b448c4e3SSteven Rostedt 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 
120706a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
1208b448c4e3SSteven Rostedt 		return NULL;
1209b448c4e3SSteven Rostedt 
1210b448c4e3SSteven Rostedt 	if (hash->size_bits > 0)
1211b448c4e3SSteven Rostedt 		key = hash_long(ip, hash->size_bits);
1212b448c4e3SSteven Rostedt 	else
1213b448c4e3SSteven Rostedt 		key = 0;
1214b448c4e3SSteven Rostedt 
1215b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1216b448c4e3SSteven Rostedt 
12171bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1218b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1219b448c4e3SSteven Rostedt 			return entry;
1220b448c4e3SSteven Rostedt 	}
1221b448c4e3SSteven Rostedt 	return NULL;
1222b448c4e3SSteven Rostedt }
1223b448c4e3SSteven Rostedt 
122433dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
122533dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
122633dc9b12SSteven Rostedt {
122733dc9b12SSteven Rostedt 	struct hlist_head *hhd;
122833dc9b12SSteven Rostedt 	unsigned long key;
122933dc9b12SSteven Rostedt 
123033dc9b12SSteven Rostedt 	if (hash->size_bits)
123133dc9b12SSteven Rostedt 		key = hash_long(entry->ip, hash->size_bits);
123233dc9b12SSteven Rostedt 	else
123333dc9b12SSteven Rostedt 		key = 0;
123433dc9b12SSteven Rostedt 
123533dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
123633dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
123733dc9b12SSteven Rostedt 	hash->count++;
123833dc9b12SSteven Rostedt }
123933dc9b12SSteven Rostedt 
1240b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1241b448c4e3SSteven Rostedt {
1242b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1243b448c4e3SSteven Rostedt 
1244b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1245b448c4e3SSteven Rostedt 	if (!entry)
1246b448c4e3SSteven Rostedt 		return -ENOMEM;
1247b448c4e3SSteven Rostedt 
1248b448c4e3SSteven Rostedt 	entry->ip = ip;
124933dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1250b448c4e3SSteven Rostedt 
1251b448c4e3SSteven Rostedt 	return 0;
1252b448c4e3SSteven Rostedt }
1253b448c4e3SSteven Rostedt 
1254b448c4e3SSteven Rostedt static void
125533dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
125633dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
125733dc9b12SSteven Rostedt {
125833dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
125933dc9b12SSteven Rostedt 	kfree(entry);
126033dc9b12SSteven Rostedt 	hash->count--;
126133dc9b12SSteven Rostedt }
126233dc9b12SSteven Rostedt 
126333dc9b12SSteven Rostedt static void
1264b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1265b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1266b448c4e3SSteven Rostedt {
1267b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1268b448c4e3SSteven Rostedt 	hash->count--;
1269b448c4e3SSteven Rostedt }
1270b448c4e3SSteven Rostedt 
1271b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1272b448c4e3SSteven Rostedt {
1273b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1274b67bfe0dSSasha Levin 	struct hlist_node *tn;
1275b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1276b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1277b448c4e3SSteven Rostedt 	int i;
1278b448c4e3SSteven Rostedt 
127933dc9b12SSteven Rostedt 	if (!hash->count)
128033dc9b12SSteven Rostedt 		return;
128133dc9b12SSteven Rostedt 
1282b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1283b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1284b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
128533dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1286b448c4e3SSteven Rostedt 	}
1287b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1288b448c4e3SSteven Rostedt }
1289b448c4e3SSteven Rostedt 
129033dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
129133dc9b12SSteven Rostedt {
129233dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
129333dc9b12SSteven Rostedt 		return;
129433dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
129533dc9b12SSteven Rostedt 	kfree(hash->buckets);
129633dc9b12SSteven Rostedt 	kfree(hash);
129733dc9b12SSteven Rostedt }
129833dc9b12SSteven Rostedt 
129907fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
130007fd5515SSteven Rostedt {
130107fd5515SSteven Rostedt 	struct ftrace_hash *hash;
130207fd5515SSteven Rostedt 
130307fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
130407fd5515SSteven Rostedt 	free_ftrace_hash(hash);
130507fd5515SSteven Rostedt }
130607fd5515SSteven Rostedt 
130707fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
130807fd5515SSteven Rostedt {
130907fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
131007fd5515SSteven Rostedt 		return;
131107fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
131207fd5515SSteven Rostedt }
131307fd5515SSteven Rostedt 
13145500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
13155500fa51SJiri Olsa {
1316f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
131733b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
131833b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
13195500fa51SJiri Olsa }
13205500fa51SJiri Olsa 
132133dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
132233dc9b12SSteven Rostedt {
132333dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
132433dc9b12SSteven Rostedt 	int size;
132533dc9b12SSteven Rostedt 
132633dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
132733dc9b12SSteven Rostedt 	if (!hash)
132833dc9b12SSteven Rostedt 		return NULL;
132933dc9b12SSteven Rostedt 
133033dc9b12SSteven Rostedt 	size = 1 << size_bits;
133147b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
133233dc9b12SSteven Rostedt 
133333dc9b12SSteven Rostedt 	if (!hash->buckets) {
133433dc9b12SSteven Rostedt 		kfree(hash);
133533dc9b12SSteven Rostedt 		return NULL;
133633dc9b12SSteven Rostedt 	}
133733dc9b12SSteven Rostedt 
133833dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
133933dc9b12SSteven Rostedt 
134033dc9b12SSteven Rostedt 	return hash;
134133dc9b12SSteven Rostedt }
134233dc9b12SSteven Rostedt 
134333dc9b12SSteven Rostedt static struct ftrace_hash *
134433dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
134533dc9b12SSteven Rostedt {
134633dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
134733dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
134833dc9b12SSteven Rostedt 	int size;
134933dc9b12SSteven Rostedt 	int ret;
135033dc9b12SSteven Rostedt 	int i;
135133dc9b12SSteven Rostedt 
135233dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
135333dc9b12SSteven Rostedt 	if (!new_hash)
135433dc9b12SSteven Rostedt 		return NULL;
135533dc9b12SSteven Rostedt 
135633dc9b12SSteven Rostedt 	/* Empty hash? */
135706a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
135833dc9b12SSteven Rostedt 		return new_hash;
135933dc9b12SSteven Rostedt 
136033dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
136133dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1362b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
136333dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
136433dc9b12SSteven Rostedt 			if (ret < 0)
136533dc9b12SSteven Rostedt 				goto free_hash;
136633dc9b12SSteven Rostedt 		}
136733dc9b12SSteven Rostedt 	}
136833dc9b12SSteven Rostedt 
136933dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
137033dc9b12SSteven Rostedt 
137133dc9b12SSteven Rostedt 	return new_hash;
137233dc9b12SSteven Rostedt 
137333dc9b12SSteven Rostedt  free_hash:
137433dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
137533dc9b12SSteven Rostedt 	return NULL;
137633dc9b12SSteven Rostedt }
137733dc9b12SSteven Rostedt 
137841fb61c2SSteven Rostedt static void
137984261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
138041fb61c2SSteven Rostedt static void
138184261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
138241fb61c2SSteven Rostedt 
1383f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1384f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1385f8b8be8aSMasami Hiramatsu 
1386*3e278c0dSNamhyung Kim static struct ftrace_hash *
1387*3e278c0dSNamhyung Kim __ftrace_hash_move(struct ftrace_hash *src)
138833dc9b12SSteven Rostedt {
138933dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
1390b67bfe0dSSasha Levin 	struct hlist_node *tn;
139133dc9b12SSteven Rostedt 	struct hlist_head *hhd;
139207fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
139333dc9b12SSteven Rostedt 	int size = src->count;
139433dc9b12SSteven Rostedt 	int bits = 0;
139533dc9b12SSteven Rostedt 	int i;
139633dc9b12SSteven Rostedt 
139733dc9b12SSteven Rostedt 	/*
1398*3e278c0dSNamhyung Kim 	 * If the new source is empty, just return the empty_hash.
139933dc9b12SSteven Rostedt 	 */
1400*3e278c0dSNamhyung Kim 	if (!src->count)
1401*3e278c0dSNamhyung Kim 		return EMPTY_HASH;
140233dc9b12SSteven Rostedt 
140333dc9b12SSteven Rostedt 	/*
140433dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
140533dc9b12SSteven Rostedt 	 */
140633dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
140733dc9b12SSteven Rostedt 		bits++;
140833dc9b12SSteven Rostedt 
140933dc9b12SSteven Rostedt 	/* Don't allocate too much */
141033dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
141133dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
141233dc9b12SSteven Rostedt 
141307fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
141407fd5515SSteven Rostedt 	if (!new_hash)
1415*3e278c0dSNamhyung Kim 		return NULL;
141633dc9b12SSteven Rostedt 
141733dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
141833dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
141933dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1420b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
142133dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
142207fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
142333dc9b12SSteven Rostedt 		}
142433dc9b12SSteven Rostedt 	}
142533dc9b12SSteven Rostedt 
1426*3e278c0dSNamhyung Kim 	return new_hash;
1427*3e278c0dSNamhyung Kim }
1428*3e278c0dSNamhyung Kim 
1429*3e278c0dSNamhyung Kim static int
1430*3e278c0dSNamhyung Kim ftrace_hash_move(struct ftrace_ops *ops, int enable,
1431*3e278c0dSNamhyung Kim 		 struct ftrace_hash **dst, struct ftrace_hash *src)
1432*3e278c0dSNamhyung Kim {
1433*3e278c0dSNamhyung Kim 	struct ftrace_hash *new_hash;
1434*3e278c0dSNamhyung Kim 	int ret;
1435*3e278c0dSNamhyung Kim 
1436*3e278c0dSNamhyung Kim 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
1437*3e278c0dSNamhyung Kim 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
1438*3e278c0dSNamhyung Kim 		return -EINVAL;
1439*3e278c0dSNamhyung Kim 
1440*3e278c0dSNamhyung Kim 	new_hash = __ftrace_hash_move(src);
1441*3e278c0dSNamhyung Kim 	if (!new_hash)
1442*3e278c0dSNamhyung Kim 		return -ENOMEM;
1443*3e278c0dSNamhyung Kim 
1444f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1445f8b8be8aSMasami Hiramatsu 	if (enable) {
1446f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1447f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1448f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1449f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1450f8b8be8aSMasami Hiramatsu 			return ret;
1451f8b8be8aSMasami Hiramatsu 		}
1452f8b8be8aSMasami Hiramatsu 	}
1453f8b8be8aSMasami Hiramatsu 
14545c27c775SMasami Hiramatsu 	/*
14555c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14565c27c775SMasami Hiramatsu 	 * them back.
14575c27c775SMasami Hiramatsu 	 */
145884261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14595c27c775SMasami Hiramatsu 
146007fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
146107fd5515SSteven Rostedt 
146284261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
146341fb61c2SSteven Rostedt 
14645c27c775SMasami Hiramatsu 	return 0;
146533dc9b12SSteven Rostedt }
146633dc9b12SSteven Rostedt 
1467fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1468fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1469fef5aeeeSSteven Rostedt (Red Hat) {
1470fef5aeeeSSteven Rostedt (Red Hat) 	/*
1471fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1472fef5aeeeSSteven Rostedt (Red Hat) 	 * hash and not in the notrace hash. Note, an emty hash is
1473fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1474fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1475fef5aeeeSSteven Rostedt (Red Hat) 	 */
1476fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
1477fef5aeeeSSteven Rostedt (Red Hat) 		ftrace_lookup_ip(hash->filter_hash, ip)) &&
1478fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
1479fef5aeeeSSteven Rostedt (Red Hat) 		 !ftrace_lookup_ip(hash->notrace_hash, ip));
1480fef5aeeeSSteven Rostedt (Red Hat) }
1481fef5aeeeSSteven Rostedt (Red Hat) 
1482265c831cSSteven Rostedt /*
1483b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1484b848914cSSteven Rostedt  * the ops->func or not.
1485b848914cSSteven Rostedt  *
1486b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1487b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1488b848914cSSteven Rostedt  *  AND
1489b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1490cdbe61bfSSteven Rostedt  *
1491cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1492cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1493b848914cSSteven Rostedt  */
1494b848914cSSteven Rostedt static int
1495195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1496b848914cSSteven Rostedt {
1497fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1498b848914cSSteven Rostedt 	int ret;
1499b848914cSSteven Rostedt 
1500195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1501195a8afcSSteven Rostedt (Red Hat) 	/*
1502195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1503195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1504195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1505195a8afcSSteven Rostedt (Red Hat) 	 */
1506195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1507195a8afcSSteven Rostedt (Red Hat) 		return 0;
1508195a8afcSSteven Rostedt (Red Hat) #endif
1509195a8afcSSteven Rostedt (Red Hat) 
1510fef5aeeeSSteven Rostedt (Red Hat) 	hash.filter_hash = rcu_dereference_raw_notrace(ops->func_hash->filter_hash);
1511fef5aeeeSSteven Rostedt (Red Hat) 	hash.notrace_hash = rcu_dereference_raw_notrace(ops->func_hash->notrace_hash);
1512b848914cSSteven Rostedt 
1513fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1514b848914cSSteven Rostedt 		ret = 1;
1515b848914cSSteven Rostedt 	else
1516b848914cSSteven Rostedt 		ret = 0;
1517b848914cSSteven Rostedt 
1518b848914cSSteven Rostedt 	return ret;
1519b848914cSSteven Rostedt }
1520b848914cSSteven Rostedt 
1521b848914cSSteven Rostedt /*
1522265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1523265c831cSSteven Rostedt  * you must use a goto.
1524265c831cSSteven Rostedt  */
1525265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1526265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1527265c831cSSteven Rostedt 		int _____i;						\
1528265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1529265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1530265c831cSSteven Rostedt 
1531265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1532265c831cSSteven Rostedt 		}				\
1533265c831cSSteven Rostedt 	}
1534ecea656dSAbhishek Sagar 
15355855feadSSteven Rostedt 
15365855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15375855feadSSteven Rostedt {
1538a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1539a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15405855feadSSteven Rostedt 
1541a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15425855feadSSteven Rostedt 		return -1;
1543a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1544a650e02aSSteven Rostedt 		return 1;
1545a650e02aSSteven Rostedt 	return 0;
1546a650e02aSSteven Rostedt }
1547a650e02aSSteven Rostedt 
154804cf31a7SMichael Ellerman /**
154904cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
155004cf31a7SMichael Ellerman  *	if it touches the given ip range
155104cf31a7SMichael Ellerman  * @start: start of range to search.
155204cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
155304cf31a7SMichael Ellerman  *	to check.
155404cf31a7SMichael Ellerman  *
155504cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
155604cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
155704cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
155804cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
155904cf31a7SMichael Ellerman  */
156004cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1561a650e02aSSteven Rostedt {
1562a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1563a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1564a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1565a650e02aSSteven Rostedt 
1566a650e02aSSteven Rostedt 	key.ip = start;
1567a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1568a650e02aSSteven Rostedt 
1569a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1570a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1571a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1572a650e02aSSteven Rostedt 			continue;
1573a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1574a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1575a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1576a650e02aSSteven Rostedt 		if (rec)
1577f0cf973aSSteven Rostedt 			return rec->ip;
1578a650e02aSSteven Rostedt 	}
1579a650e02aSSteven Rostedt 
15805855feadSSteven Rostedt 	return 0;
15815855feadSSteven Rostedt }
15825855feadSSteven Rostedt 
1583c88fd863SSteven Rostedt /**
1584c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1585c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1586c88fd863SSteven Rostedt  *
1587f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1588c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1589c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1590c88fd863SSteven Rostedt  * determine if the address belongs or not.
1591c88fd863SSteven Rostedt  */
1592f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1593c88fd863SSteven Rostedt {
1594a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
15955855feadSSteven Rostedt }
1596c88fd863SSteven Rostedt 
1597a650e02aSSteven Rostedt /**
1598a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1599a650e02aSSteven Rostedt  * @start: start of range to search
1600a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1601a650e02aSSteven Rostedt  *
1602a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1603a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1604a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1605a650e02aSSteven Rostedt  * determine if the address belongs or not.
1606a650e02aSSteven Rostedt  */
1607d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1608a650e02aSSteven Rostedt {
1609f0cf973aSSteven Rostedt 	unsigned long ret;
1610f0cf973aSSteven Rostedt 
1611f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1612a650e02aSSteven Rostedt 				    (unsigned long)end);
1613f0cf973aSSteven Rostedt 
1614f0cf973aSSteven Rostedt 	return (int)!!ret;
1615c88fd863SSteven Rostedt }
1616c88fd863SSteven Rostedt 
16174fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16184fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16194fbb48cbSSteven Rostedt (Red Hat) {
16204fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16214fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16224fbb48cbSSteven Rostedt (Red Hat) 
16234fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16244fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16254fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16264fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16274fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16284fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16294fbb48cbSSteven Rostedt (Red Hat) 				break;
16304fbb48cbSSteven Rostedt (Red Hat) 			}
16314fbb48cbSSteven Rostedt (Red Hat) 		}
16324fbb48cbSSteven Rostedt (Red Hat) 	}
16334fbb48cbSSteven Rostedt (Red Hat) 
16344fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16354fbb48cbSSteven Rostedt (Red Hat) }
16364fbb48cbSSteven Rostedt (Red Hat) 
163784b6d3e6SJiri Olsa static bool __ftrace_hash_rec_update(struct ftrace_ops *ops,
1638ed926f9bSSteven Rostedt 				     int filter_hash,
1639ed926f9bSSteven Rostedt 				     bool inc)
1640ed926f9bSSteven Rostedt {
1641ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1642ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1643ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1644ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
164584b6d3e6SJiri Olsa 	bool update = false;
1646ed926f9bSSteven Rostedt 	int count = 0;
1647ed926f9bSSteven Rostedt 	int all = 0;
1648ed926f9bSSteven Rostedt 
1649ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1650ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
165184b6d3e6SJiri Olsa 		return false;
1652ed926f9bSSteven Rostedt 
1653ed926f9bSSteven Rostedt 	/*
1654ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1655ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1656ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1657ed926f9bSSteven Rostedt 	 *
1658ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1659ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1660ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1661ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1662ed926f9bSSteven Rostedt 	 *   gets inversed.
1663ed926f9bSSteven Rostedt 	 */
1664ed926f9bSSteven Rostedt 	if (filter_hash) {
166533b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
166633b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
166706a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1668ed926f9bSSteven Rostedt 			all = 1;
1669ed926f9bSSteven Rostedt 	} else {
1670ed926f9bSSteven Rostedt 		inc = !inc;
167133b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
167233b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1673ed926f9bSSteven Rostedt 		/*
1674ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1675ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1676ed926f9bSSteven Rostedt 		 */
167706a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
167884b6d3e6SJiri Olsa 			return false;
1679ed926f9bSSteven Rostedt 	}
1680ed926f9bSSteven Rostedt 
1681ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1682ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1683ed926f9bSSteven Rostedt 		int in_hash = 0;
1684ed926f9bSSteven Rostedt 		int match = 0;
1685ed926f9bSSteven Rostedt 
1686b7ffffbbSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1687b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1688b7ffffbbSSteven Rostedt (Red Hat) 
1689ed926f9bSSteven Rostedt 		if (all) {
1690ed926f9bSSteven Rostedt 			/*
1691ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1692ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1693ed926f9bSSteven Rostedt 			 */
1694b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1695ed926f9bSSteven Rostedt 				match = 1;
1696ed926f9bSSteven Rostedt 		} else {
169706a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
169806a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1699ed926f9bSSteven Rostedt 
1700ed926f9bSSteven Rostedt 			/*
170119eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
170219eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1703ed926f9bSSteven Rostedt 			 *
170419eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
170519eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
170619eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
170719eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
170819eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1709ed926f9bSSteven Rostedt 			 */
1710ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1711ed926f9bSSteven Rostedt 				match = 1;
1712ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
171306a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1714ed926f9bSSteven Rostedt 				match = 1;
1715ed926f9bSSteven Rostedt 		}
1716ed926f9bSSteven Rostedt 		if (!match)
1717ed926f9bSSteven Rostedt 			continue;
1718ed926f9bSSteven Rostedt 
1719ed926f9bSSteven Rostedt 		if (inc) {
1720ed926f9bSSteven Rostedt 			rec->flags++;
17210376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
172284b6d3e6SJiri Olsa 				return false;
172379922b80SSteven Rostedt (Red Hat) 
172479922b80SSteven Rostedt (Red Hat) 			/*
172579922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
172679922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
172779922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
172879922b80SSteven Rostedt (Red Hat) 			 */
1729fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
173079922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1731fef5aeeeSSteven Rostedt (Red Hat) 			else
173279922b80SSteven Rostedt (Red Hat) 				/*
173379922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
173479922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1735bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1736bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
173779922b80SSteven Rostedt (Red Hat) 				 */
1738fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
173979922b80SSteven Rostedt (Red Hat) 
174008f6fba5SSteven Rostedt 			/*
174108f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
174208f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
174308f6fba5SSteven Rostedt 			 */
174408f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
174508f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1746ed926f9bSSteven Rostedt 		} else {
17470376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
174884b6d3e6SJiri Olsa 				return false;
1749ed926f9bSSteven Rostedt 			rec->flags--;
175079922b80SSteven Rostedt (Red Hat) 
17514fbb48cbSSteven Rostedt (Red Hat) 			/*
17524fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
17534fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
17544fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
17554fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
17564fbb48cbSSteven Rostedt (Red Hat) 			 */
17570376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
17584fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
17594fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
17604fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
17614fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
17624fbb48cbSSteven Rostedt (Red Hat) 			}
176379922b80SSteven Rostedt (Red Hat) 
176479922b80SSteven Rostedt (Red Hat) 			/*
1765fef5aeeeSSteven Rostedt (Red Hat) 			 * If the rec had TRAMP enabled, then it needs to
1766fef5aeeeSSteven Rostedt (Red Hat) 			 * be cleared. As TRAMP can only be enabled iff
1767fef5aeeeSSteven Rostedt (Red Hat) 			 * there is only a single ops attached to it.
1768fef5aeeeSSteven Rostedt (Red Hat) 			 * In otherwords, always disable it on decrementing.
1769fef5aeeeSSteven Rostedt (Red Hat) 			 * In the future, we may set it if rec count is
1770fef5aeeeSSteven Rostedt (Red Hat) 			 * decremented to one, and the ops that is left
1771fef5aeeeSSteven Rostedt (Red Hat) 			 * has a trampoline.
1772fef5aeeeSSteven Rostedt (Red Hat) 			 */
1773fef5aeeeSSteven Rostedt (Red Hat) 			rec->flags &= ~FTRACE_FL_TRAMP;
1774fef5aeeeSSteven Rostedt (Red Hat) 
1775fef5aeeeSSteven Rostedt (Red Hat) 			/*
177679922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
177779922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
177879922b80SSteven Rostedt (Red Hat) 			 */
1779ed926f9bSSteven Rostedt 		}
1780ed926f9bSSteven Rostedt 		count++;
178184b6d3e6SJiri Olsa 
178284b6d3e6SJiri Olsa 		/* Must match FTRACE_UPDATE_CALLS in ftrace_modify_all_code() */
178384b6d3e6SJiri Olsa 		update |= ftrace_test_record(rec, 1) != FTRACE_UPDATE_IGNORE;
178484b6d3e6SJiri Olsa 
1785ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1786ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
178784b6d3e6SJiri Olsa 			return update;
1788ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
178984b6d3e6SJiri Olsa 
179084b6d3e6SJiri Olsa 	return update;
1791ed926f9bSSteven Rostedt }
1792ed926f9bSSteven Rostedt 
179384b6d3e6SJiri Olsa static bool ftrace_hash_rec_disable(struct ftrace_ops *ops,
1794ed926f9bSSteven Rostedt 				    int filter_hash)
1795ed926f9bSSteven Rostedt {
179684b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 0);
1797ed926f9bSSteven Rostedt }
1798ed926f9bSSteven Rostedt 
179984b6d3e6SJiri Olsa static bool ftrace_hash_rec_enable(struct ftrace_ops *ops,
1800ed926f9bSSteven Rostedt 				   int filter_hash)
1801ed926f9bSSteven Rostedt {
180284b6d3e6SJiri Olsa 	return __ftrace_hash_rec_update(ops, filter_hash, 1);
1803ed926f9bSSteven Rostedt }
1804ed926f9bSSteven Rostedt 
180584261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
180684261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
180784261912SSteven Rostedt (Red Hat) {
180884261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
180984261912SSteven Rostedt (Red Hat) 
181084261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
181184261912SSteven Rostedt (Red Hat) 
181284261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
181384261912SSteven Rostedt (Red Hat) 		return;
181484261912SSteven Rostedt (Red Hat) 
181584261912SSteven Rostedt (Red Hat) 	/*
181684261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
181784261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
181884261912SSteven Rostedt (Red Hat) 	 */
181984261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
182084261912SSteven Rostedt (Red Hat) 		/* Already done */
182184261912SSteven Rostedt (Red Hat) 		if (op == ops)
182284261912SSteven Rostedt (Red Hat) 			continue;
182384261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
182484261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
182584261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
182684261912SSteven Rostedt (Red Hat) }
182784261912SSteven Rostedt (Red Hat) 
182884261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
182984261912SSteven Rostedt (Red Hat) 					   int filter_hash)
183084261912SSteven Rostedt (Red Hat) {
183184261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
183284261912SSteven Rostedt (Red Hat) }
183384261912SSteven Rostedt (Red Hat) 
183484261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
183584261912SSteven Rostedt (Red Hat) 					  int filter_hash)
183684261912SSteven Rostedt (Red Hat) {
183784261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
183884261912SSteven Rostedt (Red Hat) }
183984261912SSteven Rostedt (Red Hat) 
1840f8b8be8aSMasami Hiramatsu /*
1841f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1842f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1843f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1844f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1845f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1846f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1847f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
1848f8b8be8aSMasami Hiramatsu  */
1849f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1850f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1851f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1852f8b8be8aSMasami Hiramatsu {
1853f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1854f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1855f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
1856f8b8be8aSMasami Hiramatsu 
1857f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1858f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1859f8b8be8aSMasami Hiramatsu 		return 0;
1860f8b8be8aSMasami Hiramatsu 
1861f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
1862f8b8be8aSMasami Hiramatsu 		return 0;
1863f8b8be8aSMasami Hiramatsu 
1864f8b8be8aSMasami Hiramatsu 	/*
1865f8b8be8aSMasami Hiramatsu 	 * Since the IPMODIFY is a very address sensitive action, we do not
1866f8b8be8aSMasami Hiramatsu 	 * allow ftrace_ops to set all functions to new hash.
1867f8b8be8aSMasami Hiramatsu 	 */
1868f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1869f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1870f8b8be8aSMasami Hiramatsu 
1871f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1872f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1873546fece4SSteven Rostedt (Red Hat) 
1874546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1875546fece4SSteven Rostedt (Red Hat) 			continue;
1876546fece4SSteven Rostedt (Red Hat) 
1877f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1878f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1879f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1880f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1881f8b8be8aSMasami Hiramatsu 			continue;
1882f8b8be8aSMasami Hiramatsu 
1883f8b8be8aSMasami Hiramatsu 		if (in_new) {
1884f8b8be8aSMasami Hiramatsu 			/* New entries must ensure no others are using it */
1885f8b8be8aSMasami Hiramatsu 			if (rec->flags & FTRACE_FL_IPMODIFY)
1886f8b8be8aSMasami Hiramatsu 				goto rollback;
1887f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1888f8b8be8aSMasami Hiramatsu 		} else /* Removed entry */
1889f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1890f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1891f8b8be8aSMasami Hiramatsu 
1892f8b8be8aSMasami Hiramatsu 	return 0;
1893f8b8be8aSMasami Hiramatsu 
1894f8b8be8aSMasami Hiramatsu rollback:
1895f8b8be8aSMasami Hiramatsu 	end = rec;
1896f8b8be8aSMasami Hiramatsu 
1897f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1898f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1899546fece4SSteven Rostedt (Red Hat) 
1900546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1901546fece4SSteven Rostedt (Red Hat) 			continue;
1902546fece4SSteven Rostedt (Red Hat) 
1903f8b8be8aSMasami Hiramatsu 		if (rec == end)
1904f8b8be8aSMasami Hiramatsu 			goto err_out;
1905f8b8be8aSMasami Hiramatsu 
1906f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1907f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1908f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1909f8b8be8aSMasami Hiramatsu 			continue;
1910f8b8be8aSMasami Hiramatsu 
1911f8b8be8aSMasami Hiramatsu 		if (in_new)
1912f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1913f8b8be8aSMasami Hiramatsu 		else
1914f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1915f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1916f8b8be8aSMasami Hiramatsu 
1917f8b8be8aSMasami Hiramatsu err_out:
1918f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1919f8b8be8aSMasami Hiramatsu }
1920f8b8be8aSMasami Hiramatsu 
1921f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1922f8b8be8aSMasami Hiramatsu {
1923f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1924f8b8be8aSMasami Hiramatsu 
1925f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1926f8b8be8aSMasami Hiramatsu 		hash = NULL;
1927f8b8be8aSMasami Hiramatsu 
1928f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
1929f8b8be8aSMasami Hiramatsu }
1930f8b8be8aSMasami Hiramatsu 
1931f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
1932f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
1933f8b8be8aSMasami Hiramatsu {
1934f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1935f8b8be8aSMasami Hiramatsu 
1936f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1937f8b8be8aSMasami Hiramatsu 		hash = NULL;
1938f8b8be8aSMasami Hiramatsu 
1939f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
1940f8b8be8aSMasami Hiramatsu }
1941f8b8be8aSMasami Hiramatsu 
1942f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1943f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
1944f8b8be8aSMasami Hiramatsu {
1945f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
1946f8b8be8aSMasami Hiramatsu 
1947f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
1948f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
1949f8b8be8aSMasami Hiramatsu 
1950f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
1951f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
1952f8b8be8aSMasami Hiramatsu 
1953f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
1954f8b8be8aSMasami Hiramatsu }
1955f8b8be8aSMasami Hiramatsu 
1956b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
195705736a42SSteven Rostedt {
195805736a42SSteven Rostedt 	int i;
195905736a42SSteven Rostedt 
196005736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
196105736a42SSteven Rostedt 
196205736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
196305736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
196405736a42SSteven Rostedt }
196505736a42SSteven Rostedt 
19664fd3279bSSteven Rostedt (Red Hat) static struct ftrace_ops *
19674fd3279bSSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
196839daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
196939daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
19704fd3279bSSteven Rostedt (Red Hat) 
197102a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
1972b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
197302a392a0SSteven Rostedt (Red Hat) 
197402a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
197502a392a0SSteven Rostedt (Red Hat) {
197602a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
197702a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
197802a392a0SSteven Rostedt (Red Hat) 		break;
197902a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
198002a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
198102a392a0SSteven Rostedt (Red Hat) 		break;
198202a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
198302a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
198402a392a0SSteven Rostedt (Red Hat) 		break;
198502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
198602a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
198702a392a0SSteven Rostedt (Red Hat) 		break;
198802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
198902a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
199002a392a0SSteven Rostedt (Red Hat) 		break;
199102a392a0SSteven Rostedt (Red Hat) 	}
199202a392a0SSteven Rostedt (Red Hat) }
199302a392a0SSteven Rostedt (Red Hat) 
1994c88fd863SSteven Rostedt /**
1995c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
1996c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
19974fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
1998c88fd863SSteven Rostedt  *
1999c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
2000c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
2001c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
2002c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
2003c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
2004c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
2005c88fd863SSteven Rostedt  */
20064fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
20073c1720f0SSteven Rostedt {
20084fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
20094fd3279bSSteven Rostedt (Red Hat) 
2010b17e8a37SSteven Rostedt 	switch (failed) {
2011593eb8a2SSteven Rostedt 	case -EFAULT:
20126912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
201305736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
201405736a42SSteven Rostedt 		print_ip_sym(ip);
201505736a42SSteven Rostedt 		break;
2016593eb8a2SSteven Rostedt 	case -EINVAL:
20176912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
201805736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
201905736a42SSteven Rostedt 		print_ip_sym(ip);
202005736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
20214fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
2022b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
2023b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
2024b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
2025b05086c7SSteven Rostedt (Red Hat) 		}
202605736a42SSteven Rostedt 		break;
2027593eb8a2SSteven Rostedt 	case -EPERM:
20286912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2029593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
2030593eb8a2SSteven Rostedt 		print_ip_sym(ip);
2031593eb8a2SSteven Rostedt 		break;
2032593eb8a2SSteven Rostedt 	default:
20336912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2034593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
2035593eb8a2SSteven Rostedt 		print_ip_sym(ip);
203605736a42SSteven Rostedt 	}
203702a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
20384fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
20394fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
20404fd3279bSSteven Rostedt (Red Hat) 
20414fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
20424fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
20434fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
20444fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
20454fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
204639daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
204739daa7b9SSteven Rostedt (Red Hat) 				do {
204839daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
204939daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
205039daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
205139daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
205239daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
205339daa7b9SSteven Rostedt (Red Hat) 			} else
20544fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
20554fd3279bSSteven Rostedt (Red Hat) 
20564fd3279bSSteven Rostedt (Red Hat) 		}
20574fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
205839daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
20594fd3279bSSteven Rostedt (Red Hat) 	}
2060b17e8a37SSteven Rostedt }
206105736a42SSteven Rostedt 
2062c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
20633d083395SSteven Rostedt {
206464fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2065e7d3737eSFrederic Weisbecker 
206602a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
206702a392a0SSteven Rostedt (Red Hat) 
2068b7ffffbbSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_DISABLED)
2069b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2070b7ffffbbSSteven Rostedt (Red Hat) 
20713d083395SSteven Rostedt 	/*
207230fb6aa7SJiri Olsa 	 * If we are updating calls:
20733d083395SSteven Rostedt 	 *
2074ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2075ed926f9bSSteven Rostedt 	 *   because someone is using it.
20763d083395SSteven Rostedt 	 *
2077ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2078ed926f9bSSteven Rostedt 	 *
207930fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2080ed926f9bSSteven Rostedt 	 * are enabled.
20813d083395SSteven Rostedt 	 */
20820376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
208364fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
20843d083395SSteven Rostedt 
208508f6fba5SSteven Rostedt 	/*
208679922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
208779922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
208879922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
208908f6fba5SSteven Rostedt 	 */
209079922b80SSteven Rostedt (Red Hat) 	if (flag) {
209179922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
209279922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
209308f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
209408f6fba5SSteven Rostedt 
209579922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
209679922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
209779922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
209879922b80SSteven Rostedt (Red Hat) 	}
209979922b80SSteven Rostedt (Red Hat) 
210064fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
210164fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2102c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
210364fbcd16SXiao Guangrong 
210464fbcd16SXiao Guangrong 	if (flag) {
210508f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
210608f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
210708f6fba5SSteven Rostedt 
210808f6fba5SSteven Rostedt 		if (update) {
210964fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
211008f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
211108f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
211208f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
211308f6fba5SSteven Rostedt 				else
211408f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
211508f6fba5SSteven Rostedt 			}
211679922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
211779922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
211879922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
211979922b80SSteven Rostedt (Red Hat) 				else
212079922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
212179922b80SSteven Rostedt (Red Hat) 			}
212264fbcd16SXiao Guangrong 		}
212364fbcd16SXiao Guangrong 
212408f6fba5SSteven Rostedt 		/*
212508f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
212608f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
212708f6fba5SSteven Rostedt 		 * Otherwise,
212808f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2129f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
213079922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
213108f6fba5SSteven Rostedt 		 */
213202a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
213302a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
213408f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
213502a392a0SSteven Rostedt (Red Hat) 		}
2136f1b2f2bdSSteven Rostedt (Red Hat) 
213702a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
213808f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
213908f6fba5SSteven Rostedt 	}
214008f6fba5SSteven Rostedt 
214108f6fba5SSteven Rostedt 	if (update) {
214208f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
21430376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
214408f6fba5SSteven Rostedt 			rec->flags = 0;
214508f6fba5SSteven Rostedt 		else
2146b24d443bSSteven Rostedt (Red Hat) 			/*
2147b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2148b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2149b24d443bSSteven Rostedt (Red Hat) 			 */
2150b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2151b24d443bSSteven Rostedt (Red Hat) 					FTRACE_FL_REGS_EN);
215208f6fba5SSteven Rostedt 	}
2153c88fd863SSteven Rostedt 
215402a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2155c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2156c88fd863SSteven Rostedt }
2157c88fd863SSteven Rostedt 
2158c88fd863SSteven Rostedt /**
2159c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
2160c88fd863SSteven Rostedt  * @rec: the record to update
2161c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
2162c88fd863SSteven Rostedt  *
2163c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2164c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2165c88fd863SSteven Rostedt  */
2166c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
2167c88fd863SSteven Rostedt {
2168c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
2169c88fd863SSteven Rostedt }
2170c88fd863SSteven Rostedt 
2171c88fd863SSteven Rostedt /**
2172c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
2173c88fd863SSteven Rostedt  * @rec: the record to test
2174c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
2175c88fd863SSteven Rostedt  *
2176c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2177c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2178c88fd863SSteven Rostedt  * represents.
2179c88fd863SSteven Rostedt  */
2180c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
2181c88fd863SSteven Rostedt {
2182c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
2183c88fd863SSteven Rostedt }
2184c88fd863SSteven Rostedt 
218579922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
21865fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
21875fecaa04SSteven Rostedt (Red Hat) {
21885fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2189fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
21905fecaa04SSteven Rostedt (Red Hat) 
21915fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
21925fecaa04SSteven Rostedt (Red Hat) 
21935fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
21945fecaa04SSteven Rostedt (Red Hat) 			continue;
21955fecaa04SSteven Rostedt (Red Hat) 
2196fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
21975fecaa04SSteven Rostedt (Red Hat) 			return op;
21985fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
21995fecaa04SSteven Rostedt (Red Hat) 
22005fecaa04SSteven Rostedt (Red Hat) 	return NULL;
22015fecaa04SSteven Rostedt (Red Hat) }
22025fecaa04SSteven Rostedt (Red Hat) 
22035fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
220439daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
220539daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
220639daa7b9SSteven Rostedt (Red Hat) {
220739daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
220839daa7b9SSteven Rostedt (Red Hat) 
220939daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
221039daa7b9SSteven Rostedt (Red Hat) 
221139daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
221239daa7b9SSteven Rostedt (Red Hat) 			continue;
221339daa7b9SSteven Rostedt (Red Hat) 
221439daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
221539daa7b9SSteven Rostedt (Red Hat) 			return op;
221639daa7b9SSteven Rostedt (Red Hat) 	}
221739daa7b9SSteven Rostedt (Red Hat) 
221839daa7b9SSteven Rostedt (Red Hat) 	return NULL;
221939daa7b9SSteven Rostedt (Red Hat) }
222039daa7b9SSteven Rostedt (Red Hat) 
222139daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
222279922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
222379922b80SSteven Rostedt (Red Hat) {
222479922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2225fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
222679922b80SSteven Rostedt (Red Hat) 
2227fef5aeeeSSteven Rostedt (Red Hat) 	/*
2228fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2229fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2230fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2231fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2232fef5aeeeSSteven Rostedt (Red Hat) 	 */
2233fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2234fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
223579922b80SSteven Rostedt (Red Hat) 			return removed_ops;
223679922b80SSteven Rostedt (Red Hat) 	}
223779922b80SSteven Rostedt (Red Hat) 
2238fef5aeeeSSteven Rostedt (Red Hat) 	/*
2239fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2240fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2241fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2242fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2243fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2244fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
22454fc40904SSteven Rostedt (Red Hat) 	 * yet.
22464fc40904SSteven Rostedt (Red Hat) 	 *
22474fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
22484fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
22494fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
22504fc40904SSteven Rostedt (Red Hat) 	 *
22514fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
22524fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
22534fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
22544fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2255fef5aeeeSSteven Rostedt (Red Hat) 	 */
225679922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2257fef5aeeeSSteven Rostedt (Red Hat) 
2258fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
225979922b80SSteven Rostedt (Red Hat) 			continue;
226079922b80SSteven Rostedt (Red Hat) 
2261fef5aeeeSSteven Rostedt (Red Hat) 		/*
2262fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2263fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2264fef5aeeeSSteven Rostedt (Red Hat) 		 */
2265fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2266fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2267fef5aeeeSSteven Rostedt (Red Hat) 
2268fef5aeeeSSteven Rostedt (Red Hat) 
22694fc40904SSteven Rostedt (Red Hat) 		/*
22704fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
22714fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
22724fc40904SSteven Rostedt (Red Hat) 		 * function.
22734fc40904SSteven Rostedt (Red Hat) 		 */
2274fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2275fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
227679922b80SSteven Rostedt (Red Hat) 			return op;
22774fc40904SSteven Rostedt (Red Hat) 		/*
22784fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
22794fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
22804fc40904SSteven Rostedt (Red Hat) 		 * we want!
22814fc40904SSteven Rostedt (Red Hat) 		 */
22824fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
22834fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
22844fc40904SSteven Rostedt (Red Hat) 			return op;
228579922b80SSteven Rostedt (Red Hat) 
228679922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
228779922b80SSteven Rostedt (Red Hat) 
228879922b80SSteven Rostedt (Red Hat) 	return NULL;
228979922b80SSteven Rostedt (Red Hat) }
229079922b80SSteven Rostedt (Red Hat) 
229179922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
229279922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
229379922b80SSteven Rostedt (Red Hat) {
229479922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2295fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
229679922b80SSteven Rostedt (Red Hat) 
229779922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
229879922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2299fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
230079922b80SSteven Rostedt (Red Hat) 			return op;
230179922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
230279922b80SSteven Rostedt (Red Hat) 
230379922b80SSteven Rostedt (Red Hat) 	return NULL;
230479922b80SSteven Rostedt (Red Hat) }
230579922b80SSteven Rostedt (Red Hat) 
23067413af1fSSteven Rostedt (Red Hat) /**
23077413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
23087413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23097413af1fSSteven Rostedt (Red Hat)  *
23107413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
23117413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
23127413af1fSSteven Rostedt (Red Hat)  * is not not set, then it wants to convert to the normal callback.
23137413af1fSSteven Rostedt (Red Hat)  *
23147413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
23157413af1fSSteven Rostedt (Red Hat)  */
23167413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
23177413af1fSSteven Rostedt (Red Hat) {
231879922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
231979922b80SSteven Rostedt (Red Hat) 
232079922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
232179922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
232279922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
232379922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2324bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2325bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
232679922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
232779922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
232879922b80SSteven Rostedt (Red Hat) 		}
232979922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
233079922b80SSteven Rostedt (Red Hat) 	}
233179922b80SSteven Rostedt (Red Hat) 
23327413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
23337413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23347413af1fSSteven Rostedt (Red Hat) 	else
23357413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23367413af1fSSteven Rostedt (Red Hat) }
23377413af1fSSteven Rostedt (Red Hat) 
23387413af1fSSteven Rostedt (Red Hat) /**
23397413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
23407413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23417413af1fSSteven Rostedt (Red Hat)  *
23427413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
23437413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
23447413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
23457413af1fSSteven Rostedt (Red Hat)  *
23467413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
23477413af1fSSteven Rostedt (Red Hat)  */
23487413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
23497413af1fSSteven Rostedt (Red Hat) {
235079922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
235179922b80SSteven Rostedt (Red Hat) 
235279922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
235379922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
235479922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
235579922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
2356a395d6a7SJoe Perches 			pr_warn("Bad trampoline accounting at: %p (%pS)\n",
235779922b80SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip);
235879922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
235979922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
236079922b80SSteven Rostedt (Red Hat) 		}
236179922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
236279922b80SSteven Rostedt (Red Hat) 	}
236379922b80SSteven Rostedt (Red Hat) 
23647413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
23657413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23667413af1fSSteven Rostedt (Red Hat) 	else
23677413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23687413af1fSSteven Rostedt (Red Hat) }
23697413af1fSSteven Rostedt (Red Hat) 
2370c88fd863SSteven Rostedt static int
2371c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
2372c88fd863SSteven Rostedt {
237308f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2374c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2375c88fd863SSteven Rostedt 	int ret;
2376c88fd863SSteven Rostedt 
23777c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2378c88fd863SSteven Rostedt 
23797c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
23807c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
23817c0868e0SSteven Rostedt (Red Hat) 
23827c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
238308f6fba5SSteven Rostedt 
238402a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
238502a392a0SSteven Rostedt (Red Hat) 
2386c88fd863SSteven Rostedt 	switch (ret) {
2387c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2388c88fd863SSteven Rostedt 		return 0;
2389c88fd863SSteven Rostedt 
2390c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
239102a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2392c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2393c88fd863SSteven Rostedt 
2394c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
239502a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
239639b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
239708f6fba5SSteven Rostedt 
239808f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
239902a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
240008f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
24013d083395SSteven Rostedt 	}
24023d083395SSteven Rostedt 
2403c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
2404c88fd863SSteven Rostedt }
2405c88fd863SSteven Rostedt 
2406e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
24073d083395SSteven Rostedt {
24083d083395SSteven Rostedt 	struct dyn_ftrace *rec;
24093d083395SSteven Rostedt 	struct ftrace_page *pg;
24106a24a244SSteven Rostedt 	int failed;
24113d083395SSteven Rostedt 
241245a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
241345a4a237SSteven Rostedt 		return;
241445a4a237SSteven Rostedt 
2415265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2416546fece4SSteven Rostedt (Red Hat) 
2417546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
2418546fece4SSteven Rostedt (Red Hat) 			continue;
2419546fece4SSteven Rostedt (Red Hat) 
2420e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2421fa9d13cfSZhaolei 		if (failed) {
24224fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
24234377245aSSteven Rostedt 			/* Stop processing */
24244377245aSSteven Rostedt 			return;
24254377245aSSteven Rostedt 		}
2426265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
24273d083395SSteven Rostedt }
24283c1720f0SSteven Rostedt 
2429c88fd863SSteven Rostedt struct ftrace_rec_iter {
2430c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2431c88fd863SSteven Rostedt 	int			index;
2432c88fd863SSteven Rostedt };
2433c88fd863SSteven Rostedt 
2434c88fd863SSteven Rostedt /**
2435c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
2436c88fd863SSteven Rostedt  *
2437c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2438c88fd863SSteven Rostedt  * the records that represent address locations where functions
2439c88fd863SSteven Rostedt  * are traced.
2440c88fd863SSteven Rostedt  *
2441c88fd863SSteven Rostedt  * May return NULL if no records are available.
2442c88fd863SSteven Rostedt  */
2443c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2444c88fd863SSteven Rostedt {
2445c88fd863SSteven Rostedt 	/*
2446c88fd863SSteven Rostedt 	 * We only use a single iterator.
2447c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2448c88fd863SSteven Rostedt 	 */
2449c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2450c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2451c88fd863SSteven Rostedt 
2452c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2453c88fd863SSteven Rostedt 	iter->index = 0;
2454c88fd863SSteven Rostedt 
2455c88fd863SSteven Rostedt 	/* Could have empty pages */
2456c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2457c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2458c88fd863SSteven Rostedt 
2459c88fd863SSteven Rostedt 	if (!iter->pg)
2460c88fd863SSteven Rostedt 		return NULL;
2461c88fd863SSteven Rostedt 
2462c88fd863SSteven Rostedt 	return iter;
2463c88fd863SSteven Rostedt }
2464c88fd863SSteven Rostedt 
2465c88fd863SSteven Rostedt /**
2466c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
2467c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2468c88fd863SSteven Rostedt  *
2469c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2470c88fd863SSteven Rostedt  */
2471c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2472c88fd863SSteven Rostedt {
2473c88fd863SSteven Rostedt 	iter->index++;
2474c88fd863SSteven Rostedt 
2475c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2476c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2477c88fd863SSteven Rostedt 		iter->index = 0;
2478c88fd863SSteven Rostedt 
2479c88fd863SSteven Rostedt 		/* Could have empty pages */
2480c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2481c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2482c88fd863SSteven Rostedt 	}
2483c88fd863SSteven Rostedt 
2484c88fd863SSteven Rostedt 	if (!iter->pg)
2485c88fd863SSteven Rostedt 		return NULL;
2486c88fd863SSteven Rostedt 
2487c88fd863SSteven Rostedt 	return iter;
2488c88fd863SSteven Rostedt }
2489c88fd863SSteven Rostedt 
2490c88fd863SSteven Rostedt /**
2491c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
2492c88fd863SSteven Rostedt  * @iter: The current iterator location
2493c88fd863SSteven Rostedt  *
2494c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2495c88fd863SSteven Rostedt  */
2496c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2497c88fd863SSteven Rostedt {
2498c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2499c88fd863SSteven Rostedt }
2500c88fd863SSteven Rostedt 
25013b47bfc1SSteven Rostedt static int
250231e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
25033c1720f0SSteven Rostedt {
2504492a7ea5SAbhishek Sagar 	int ret;
250537ad5084SSteven Rostedt 
250645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
250745a4a237SSteven Rostedt 		return 0;
250845a4a237SSteven Rostedt 
250925aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
25103d083395SSteven Rostedt 	if (ret) {
251102a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
25124fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
25133d083395SSteven Rostedt 		return 0;
2514d61f82d0SSteven Rostedt 	}
2515d61f82d0SSteven Rostedt 	return 1;
25163d083395SSteven Rostedt }
25173d083395SSteven Rostedt 
2518000ab691SSteven Rostedt /*
2519000ab691SSteven Rostedt  * archs can override this function if they must do something
2520000ab691SSteven Rostedt  * before the modifying code is performed.
2521000ab691SSteven Rostedt  */
2522000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
2523000ab691SSteven Rostedt {
2524000ab691SSteven Rostedt 	return 0;
2525000ab691SSteven Rostedt }
2526000ab691SSteven Rostedt 
2527000ab691SSteven Rostedt /*
2528000ab691SSteven Rostedt  * archs can override this function if they must do something
2529000ab691SSteven Rostedt  * after the modifying code is performed.
2530000ab691SSteven Rostedt  */
2531000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
2532000ab691SSteven Rostedt {
2533000ab691SSteven Rostedt 	return 0;
2534000ab691SSteven Rostedt }
2535000ab691SSteven Rostedt 
25368ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
25378ed3e2cfSSteven Rostedt {
253859338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2539cd21067fSPetr Mladek 	int err = 0;
254059338f75SSteven Rostedt (Red Hat) 
254159338f75SSteven Rostedt (Red Hat) 	/*
254259338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
254359338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
254459338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
254559338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
254659338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
254759338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
254859338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
254959338f75SSteven Rostedt (Red Hat) 	 * traced.
255059338f75SSteven Rostedt (Red Hat) 	 */
2551cd21067fSPetr Mladek 	if (update) {
2552cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2553cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2554cd21067fSPetr Mladek 			return;
2555cd21067fSPetr Mladek 	}
255659338f75SSteven Rostedt (Red Hat) 
25578ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
25588ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
25598ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
25608ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
25618ed3e2cfSSteven Rostedt 
2562405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2563405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2564405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2565405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2566405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2567405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2568cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2569cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2570cd21067fSPetr Mladek 			return;
2571405e1d83SSteven Rostedt (Red Hat) 	}
25728ed3e2cfSSteven Rostedt 
25738ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2574cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
25758ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2576cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2577cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
25788ed3e2cfSSteven Rostedt }
25798ed3e2cfSSteven Rostedt 
25803d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
25813d083395SSteven Rostedt {
25823d083395SSteven Rostedt 	int *command = data;
25833d083395SSteven Rostedt 
25848ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
25855a45cfe1SSteven Rostedt 
2586c88fd863SSteven Rostedt 	return 0;
2587c88fd863SSteven Rostedt }
2588c88fd863SSteven Rostedt 
2589c88fd863SSteven Rostedt /**
2590c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
2591c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2592c88fd863SSteven Rostedt  *
2593c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2594c88fd863SSteven Rostedt  * it can call this function.
2595c88fd863SSteven Rostedt  */
2596c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2597c88fd863SSteven Rostedt {
2598c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2599c88fd863SSteven Rostedt }
2600c88fd863SSteven Rostedt 
2601c88fd863SSteven Rostedt /**
2602c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
2603c88fd863SSteven Rostedt  * @command: The command that needs to be done
2604c88fd863SSteven Rostedt  *
2605c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2606c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2607c88fd863SSteven Rostedt  */
2608c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2609c88fd863SSteven Rostedt {
2610c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2611c88fd863SSteven Rostedt }
2612c88fd863SSteven Rostedt 
2613c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2614c88fd863SSteven Rostedt {
2615c88fd863SSteven Rostedt 	int ret;
2616c88fd863SSteven Rostedt 
2617c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
2618c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
2619c88fd863SSteven Rostedt 	if (ret)
2620c88fd863SSteven Rostedt 		return;
2621c88fd863SSteven Rostedt 
2622c88fd863SSteven Rostedt 	/*
2623c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2624c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2625c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2626c88fd863SSteven Rostedt 	 * produces the most overhead.
2627c88fd863SSteven Rostedt 	 */
2628c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2629c88fd863SSteven Rostedt 
2630000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
2631000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
26323d083395SSteven Rostedt }
26333d083395SSteven Rostedt 
26348252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
26357485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2636e1effa01SSteven Rostedt (Red Hat) {
2637e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
26387485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
26397485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2640e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
26418252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
26427485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2643e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2644e1effa01SSteven Rostedt (Red Hat) }
2645e1effa01SSteven Rostedt (Red Hat) 
26463d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
264760a7ecf4SSteven Rostedt static int ftrace_start_up;
2648df4fc315SSteven Rostedt 
264912cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
265012cce594SSteven Rostedt (Red Hat) {
265112cce594SSteven Rostedt (Red Hat) }
265212cce594SSteven Rostedt (Red Hat) 
2653ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_free(struct ftrace_ops *ops)
2654db0fbadcSJiri Slaby {
2655db0fbadcSJiri Slaby 	free_percpu(ops->disabled);
2656db0fbadcSJiri Slaby }
2657db0fbadcSJiri Slaby 
2658df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2659df4fc315SSteven Rostedt {
2660df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2661df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2662df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2663df4fc315SSteven Rostedt 	}
2664df4fc315SSteven Rostedt 
2665df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2666df4fc315SSteven Rostedt 		return;
2667df4fc315SSteven Rostedt 
2668df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2669df4fc315SSteven Rostedt }
26703d083395SSteven Rostedt 
2671e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2672e1effa01SSteven Rostedt (Red Hat) {
2673e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2674e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2675e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2676e1effa01SSteven Rostedt (Red Hat) }
2677e1effa01SSteven Rostedt (Red Hat) 
2678a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
26793d083395SSteven Rostedt {
26808a56d776SSteven Rostedt (Red Hat) 	int ret;
2681b848914cSSteven Rostedt 
26824eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2683a1cd6173SSteven Rostedt 		return -ENODEV;
26844eebcc81SSteven Rostedt 
26858a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
26868a56d776SSteven Rostedt (Red Hat) 	if (ret)
26878a56d776SSteven Rostedt (Red Hat) 		return ret;
26888a56d776SSteven Rostedt (Red Hat) 
268960a7ecf4SSteven Rostedt 	ftrace_start_up++;
26903d083395SSteven Rostedt 
2691e1effa01SSteven Rostedt (Red Hat) 	/*
2692e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2693e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2694e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2695e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2696e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2697e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2698e1effa01SSteven Rostedt (Red Hat) 	 */
2699e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
270066209a5bSSteven Rostedt (Red Hat) 
2701f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2702f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2703f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2704f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2705f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2706f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2707f8b8be8aSMasami Hiramatsu 		return ret;
2708f8b8be8aSMasami Hiramatsu 	}
2709f8b8be8aSMasami Hiramatsu 
27107f50d06bSJiri Olsa 	if (ftrace_hash_rec_enable(ops, 1))
27117f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2712ed926f9bSSteven Rostedt 
2713df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2714a1cd6173SSteven Rostedt 
2715e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2716e1effa01SSteven Rostedt (Red Hat) 
2717a1cd6173SSteven Rostedt 	return 0;
27183d083395SSteven Rostedt }
27193d083395SSteven Rostedt 
27208a56d776SSteven Rostedt (Red Hat) static int ftrace_shutdown(struct ftrace_ops *ops, int command)
27213d083395SSteven Rostedt {
27228a56d776SSteven Rostedt (Red Hat) 	int ret;
2723b848914cSSteven Rostedt 
27244eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
27258a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
27268a56d776SSteven Rostedt (Red Hat) 
27278a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
27288a56d776SSteven Rostedt (Red Hat) 	if (ret)
27298a56d776SSteven Rostedt (Red Hat) 		return ret;
27304eebcc81SSteven Rostedt 
273160a7ecf4SSteven Rostedt 	ftrace_start_up--;
27329ea1a153SFrederic Weisbecker 	/*
27339ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
27349ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
27359ea1a153SFrederic Weisbecker 	 * further ftrace uses.
27369ea1a153SFrederic Weisbecker 	 */
27379ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
27389ea1a153SFrederic Weisbecker 
2739f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
2740f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
27417f50d06bSJiri Olsa 
27427f50d06bSJiri Olsa 	if (ftrace_hash_rec_disable(ops, 1))
27437f50d06bSJiri Olsa 		command |= FTRACE_UPDATE_CALLS;
2744ed926f9bSSteven Rostedt 
2745ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2746b848914cSSteven Rostedt 
2747d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2748d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2749d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2750d61f82d0SSteven Rostedt 	}
2751d61f82d0SSteven Rostedt 
2752a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
2753a4c35ed2SSteven Rostedt (Red Hat) 		/*
2754ba27f2bcSSteven Rostedt (Red Hat) 		 * If these are per_cpu ops, they still need their
2755a4c35ed2SSteven Rostedt (Red Hat) 		 * per_cpu field freed. Since, function tracing is
2756a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
2757a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
2758a4c35ed2SSteven Rostedt (Red Hat) 		 */
2759ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2760ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
27618a56d776SSteven Rostedt (Red Hat) 		return 0;
2762a4c35ed2SSteven Rostedt (Red Hat) 	}
27633d083395SSteven Rostedt 
276479922b80SSteven Rostedt (Red Hat) 	/*
276579922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
276679922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
276779922b80SSteven Rostedt (Red Hat) 	 */
2768e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
276979922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
277079922b80SSteven Rostedt (Red Hat) 
2771fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
2772fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
2773fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
2774fef5aeeeSSteven Rostedt (Red Hat) 
2775d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
2776a4c35ed2SSteven Rostedt (Red Hat) 
277784bde62cSSteven Rostedt (Red Hat) 	/*
277884bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
277984bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
278084bde62cSSteven Rostedt (Red Hat) 	 */
278184bde62cSSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
278284bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
278384bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
278484bde62cSSteven Rostedt (Red Hat) 
278584bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
2786977c1f9cSAlexei Starovoitov 			if (FTRACE_WARN_ON_ONCE(rec->flags & ~FTRACE_FL_DISABLED))
278784bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
278884bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
278984bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
279084bde62cSSteven Rostedt (Red Hat) 	}
279184bde62cSSteven Rostedt (Red Hat) 
2792fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
2793fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2794fef5aeeeSSteven Rostedt (Red Hat) 
2795fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
2796e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
279779922b80SSteven Rostedt (Red Hat) 
2798a4c35ed2SSteven Rostedt (Red Hat) 	/*
2799a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
2800a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
2801ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
2802a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
2803a4c35ed2SSteven Rostedt (Red Hat) 	 *
2804a4c35ed2SSteven Rostedt (Red Hat) 	 * Again, normal synchronize_sched() is not good enough.
2805a4c35ed2SSteven Rostedt (Red Hat) 	 * We need to do a hard force of sched synchronization.
2806a4c35ed2SSteven Rostedt (Red Hat) 	 * This is because we use preempt_disable() to do RCU, but
2807a4c35ed2SSteven Rostedt (Red Hat) 	 * the function tracers can be called where RCU is not watching
2808a4c35ed2SSteven Rostedt (Red Hat) 	 * (like before user_exit()). We can not rely on the RCU
2809a4c35ed2SSteven Rostedt (Red Hat) 	 * infrastructure to do the synchronization, thus we must do it
2810a4c35ed2SSteven Rostedt (Red Hat) 	 * ourselves.
2811a4c35ed2SSteven Rostedt (Red Hat) 	 */
2812ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU)) {
2813a4c35ed2SSteven Rostedt (Red Hat) 		schedule_on_each_cpu(ftrace_sync);
2814a4c35ed2SSteven Rostedt (Red Hat) 
281512cce594SSteven Rostedt (Red Hat) 		arch_ftrace_trampoline_free(ops);
281612cce594SSteven Rostedt (Red Hat) 
2817ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2818ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
2819a4c35ed2SSteven Rostedt (Red Hat) 	}
2820a4c35ed2SSteven Rostedt (Red Hat) 
28218a56d776SSteven Rostedt (Red Hat) 	return 0;
28223d083395SSteven Rostedt }
28233d083395SSteven Rostedt 
2824e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2825b0fc494fSSteven Rostedt {
28261619dc3fSPratyush Anand 	int command;
28271619dc3fSPratyush Anand 
28284eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
28294eebcc81SSteven Rostedt 		return;
28304eebcc81SSteven Rostedt 
2831d61f82d0SSteven Rostedt 	/* Force update next time */
2832d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
283360a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
28341619dc3fSPratyush Anand 	if (ftrace_start_up) {
28351619dc3fSPratyush Anand 		command = FTRACE_UPDATE_CALLS;
28361619dc3fSPratyush Anand 		if (ftrace_graph_active)
28371619dc3fSPratyush Anand 			command |= FTRACE_START_FUNC_RET;
2838524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_enable(command);
28391619dc3fSPratyush Anand 	}
2840b0fc494fSSteven Rostedt }
2841b0fc494fSSteven Rostedt 
2842e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2843b0fc494fSSteven Rostedt {
28441619dc3fSPratyush Anand 	int command;
28451619dc3fSPratyush Anand 
28464eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
28474eebcc81SSteven Rostedt 		return;
28484eebcc81SSteven Rostedt 
284960a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
28501619dc3fSPratyush Anand 	if (ftrace_start_up) {
28511619dc3fSPratyush Anand 		command = FTRACE_DISABLE_CALLS;
28521619dc3fSPratyush Anand 		if (ftrace_graph_active)
28531619dc3fSPratyush Anand 			command |= FTRACE_STOP_FUNC_RET;
28541619dc3fSPratyush Anand 		ftrace_run_update_code(command);
28551619dc3fSPratyush Anand 	}
2856b0fc494fSSteven Rostedt }
2857b0fc494fSSteven Rostedt 
2858a5a1d1c2SThomas Gleixner static u64		ftrace_update_time;
28593d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
28603d083395SSteven Rostedt 
28618c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
2862f7bc8b61SSteven Rostedt {
28638c4f3c3fSSteven Rostedt (Red Hat) 	/*
28648c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
28658c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
28668c4f3c3fSSteven Rostedt (Red Hat) 	 */
286733b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
286833b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
28698c4f3c3fSSteven Rostedt (Red Hat) }
2870f7bc8b61SSteven Rostedt 
28718c4f3c3fSSteven Rostedt (Red Hat) /*
28728c4f3c3fSSteven Rostedt (Red Hat)  * Check if the current ops references the record.
28738c4f3c3fSSteven Rostedt (Red Hat)  *
28748c4f3c3fSSteven Rostedt (Red Hat)  * If the ops traces all functions, then it was already accounted for.
28758c4f3c3fSSteven Rostedt (Red Hat)  * If the ops does not trace the current record function, skip it.
28768c4f3c3fSSteven Rostedt (Red Hat)  * If the ops ignores the function via notrace filter, skip it.
28778c4f3c3fSSteven Rostedt (Red Hat)  */
28788c4f3c3fSSteven Rostedt (Red Hat) static inline bool
28798c4f3c3fSSteven Rostedt (Red Hat) ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
28808c4f3c3fSSteven Rostedt (Red Hat) {
28818c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops isn't enabled, ignore it */
28828c4f3c3fSSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
28838c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28848c4f3c3fSSteven Rostedt (Red Hat) 
2885b7ffffbbSSteven Rostedt (Red Hat) 	/* If ops traces all then it includes this function */
28868c4f3c3fSSteven Rostedt (Red Hat) 	if (ops_traces_mod(ops))
2887b7ffffbbSSteven Rostedt (Red Hat) 		return 1;
28888c4f3c3fSSteven Rostedt (Red Hat) 
28898c4f3c3fSSteven Rostedt (Red Hat) 	/* The function must be in the filter */
289033b7f99cSSteven Rostedt (Red Hat) 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
289133b7f99cSSteven Rostedt (Red Hat) 	    !ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))
28928c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28938c4f3c3fSSteven Rostedt (Red Hat) 
28948c4f3c3fSSteven Rostedt (Red Hat) 	/* If in notrace hash, we ignore it too */
289533b7f99cSSteven Rostedt (Red Hat) 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
28968c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28978c4f3c3fSSteven Rostedt (Red Hat) 
28988c4f3c3fSSteven Rostedt (Red Hat) 	return 1;
28998c4f3c3fSSteven Rostedt (Red Hat) }
29008c4f3c3fSSteven Rostedt (Red Hat) 
29011dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
29023d083395SSteven Rostedt {
290385ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2904e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2905a5a1d1c2SThomas Gleixner 	u64 start, stop;
29061dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
2907b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
290885ae32aeSSteven Rostedt 	int i;
2909f7bc8b61SSteven Rostedt 
2910750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
29113d083395SSteven Rostedt 
2912b7ffffbbSSteven Rostedt (Red Hat) 	/*
2913b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
2914b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
2915b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
2916b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
2917b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
2918b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
2919b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
2920b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
2921b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
2922b7ffffbbSSteven Rostedt (Red Hat) 	 */
2923b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
2924b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
2925b7ffffbbSSteven Rostedt (Red Hat) 
29261dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
2927f22f9a89SAbhishek Sagar 
292885ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
29298c4f3c3fSSteven Rostedt (Red Hat) 
293008f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
293108f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
293208f5ac90SSteven Rostedt 				return -1;
29333d083395SSteven Rostedt 
293485ae32aeSSteven Rostedt 			p = &pg->records[i];
2935b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
2936f22f9a89SAbhishek Sagar 
29375cb084bbSJiri Olsa 			/*
293825985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
29395cb084bbSJiri Olsa 			 * to the NOP instructions.
29405cb084bbSJiri Olsa 			 */
294132082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2942d2c8c3eaSSteven Rostedt 				break;
29435cb084bbSJiri Olsa 
29441dc43cf0SJiri Slaby 			update_cnt++;
29455cb084bbSJiri Olsa 		}
294685ae32aeSSteven Rostedt 	}
294785ae32aeSSteven Rostedt 
2948750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
29493d083395SSteven Rostedt 	ftrace_update_time = stop - start;
29501dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
29513d083395SSteven Rostedt 
295216444a8aSArnaldo Carvalho de Melo 	return 0;
295316444a8aSArnaldo Carvalho de Melo }
295416444a8aSArnaldo Carvalho de Melo 
2955a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
29563c1720f0SSteven Rostedt {
2957a7900875SSteven Rostedt 	int order;
29583c1720f0SSteven Rostedt 	int cnt;
29593c1720f0SSteven Rostedt 
2960a7900875SSteven Rostedt 	if (WARN_ON(!count))
2961a7900875SSteven Rostedt 		return -EINVAL;
2962a7900875SSteven Rostedt 
2963a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
29643c1720f0SSteven Rostedt 
29653c1720f0SSteven Rostedt 	/*
2966a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2967a7900875SSteven Rostedt 	 * may be empty.
29683c1720f0SSteven Rostedt 	 */
2969a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2970a7900875SSteven Rostedt 		order--;
29713c1720f0SSteven Rostedt 
2972a7900875SSteven Rostedt  again:
2973a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2974a7900875SSteven Rostedt 
2975a7900875SSteven Rostedt 	if (!pg->records) {
2976a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2977a7900875SSteven Rostedt 		if (!order)
2978a7900875SSteven Rostedt 			return -ENOMEM;
2979a7900875SSteven Rostedt 		order >>= 1;
2980a7900875SSteven Rostedt 		goto again;
2981a7900875SSteven Rostedt 	}
2982a7900875SSteven Rostedt 
2983a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2984a7900875SSteven Rostedt 	pg->size = cnt;
2985a7900875SSteven Rostedt 
2986a7900875SSteven Rostedt 	if (cnt > count)
2987a7900875SSteven Rostedt 		cnt = count;
2988a7900875SSteven Rostedt 
2989a7900875SSteven Rostedt 	return cnt;
2990a7900875SSteven Rostedt }
2991a7900875SSteven Rostedt 
2992a7900875SSteven Rostedt static struct ftrace_page *
2993a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
2994a7900875SSteven Rostedt {
2995a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
2996a7900875SSteven Rostedt 	struct ftrace_page *pg;
2997a7900875SSteven Rostedt 	int order;
2998a7900875SSteven Rostedt 	int cnt;
2999a7900875SSteven Rostedt 
3000a7900875SSteven Rostedt 	if (!num_to_init)
3001a7900875SSteven Rostedt 		return 0;
3002a7900875SSteven Rostedt 
3003a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
3004a7900875SSteven Rostedt 	if (!pg)
3005a7900875SSteven Rostedt 		return NULL;
3006a7900875SSteven Rostedt 
3007a7900875SSteven Rostedt 	/*
3008a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
3009a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
3010a7900875SSteven Rostedt 	 * waste as little space as possible.
3011a7900875SSteven Rostedt 	 */
3012a7900875SSteven Rostedt 	for (;;) {
3013a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
3014a7900875SSteven Rostedt 		if (cnt < 0)
3015a7900875SSteven Rostedt 			goto free_pages;
3016a7900875SSteven Rostedt 
3017a7900875SSteven Rostedt 		num_to_init -= cnt;
3018a7900875SSteven Rostedt 		if (!num_to_init)
3019a7900875SSteven Rostedt 			break;
3020a7900875SSteven Rostedt 
3021a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
3022a7900875SSteven Rostedt 		if (!pg->next)
3023a7900875SSteven Rostedt 			goto free_pages;
3024a7900875SSteven Rostedt 
3025a7900875SSteven Rostedt 		pg = pg->next;
3026a7900875SSteven Rostedt 	}
3027a7900875SSteven Rostedt 
3028a7900875SSteven Rostedt 	return start_pg;
3029a7900875SSteven Rostedt 
3030a7900875SSteven Rostedt  free_pages:
30311f61be00SNamhyung Kim 	pg = start_pg;
30321f61be00SNamhyung Kim 	while (pg) {
3033a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3034a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
3035a7900875SSteven Rostedt 		start_pg = pg->next;
3036a7900875SSteven Rostedt 		kfree(pg);
3037a7900875SSteven Rostedt 		pg = start_pg;
3038a7900875SSteven Rostedt 	}
3039a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3040a7900875SSteven Rostedt 	return NULL;
3041a7900875SSteven Rostedt }
3042a7900875SSteven Rostedt 
30435072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
30445072c59fSSteven Rostedt 
30455072c59fSSteven Rostedt struct ftrace_iterator {
304698c4fd04SSteven Rostedt 	loff_t				pos;
30472bccfffdSSteven Rostedt 	loff_t				func_pos;
30485072c59fSSteven Rostedt 	struct ftrace_page		*pg;
30494aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
30504aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
30514aeb6967SSteven Rostedt 	struct trace_parser		parser;
30521cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
305333dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
30548fc0c701SSteven Rostedt 	int				hidx;
3055431aa3fbSSteven Rostedt 	int				idx;
30565072c59fSSteven Rostedt 	unsigned			flags;
30575072c59fSSteven Rostedt };
30585072c59fSSteven Rostedt 
3059e309b41dSIngo Molnar static void *
30604aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
30618fc0c701SSteven Rostedt {
30628fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
30634aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
30648fc0c701SSteven Rostedt 	struct hlist_head *hhd;
30658fc0c701SSteven Rostedt 
30668fc0c701SSteven Rostedt 	(*pos)++;
306798c4fd04SSteven Rostedt 	iter->pos = *pos;
30688fc0c701SSteven Rostedt 
30694aeb6967SSteven Rostedt 	if (iter->probe)
30704aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
30718fc0c701SSteven Rostedt  retry:
30728fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
30738fc0c701SSteven Rostedt 		return NULL;
30748fc0c701SSteven Rostedt 
30758fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
30768fc0c701SSteven Rostedt 
30778fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
30788fc0c701SSteven Rostedt 		iter->hidx++;
30798fc0c701SSteven Rostedt 		hnd = NULL;
30808fc0c701SSteven Rostedt 		goto retry;
30818fc0c701SSteven Rostedt 	}
30828fc0c701SSteven Rostedt 
30838fc0c701SSteven Rostedt 	if (!hnd)
30848fc0c701SSteven Rostedt 		hnd = hhd->first;
30858fc0c701SSteven Rostedt 	else {
30868fc0c701SSteven Rostedt 		hnd = hnd->next;
30878fc0c701SSteven Rostedt 		if (!hnd) {
30888fc0c701SSteven Rostedt 			iter->hidx++;
30898fc0c701SSteven Rostedt 			goto retry;
30908fc0c701SSteven Rostedt 		}
30918fc0c701SSteven Rostedt 	}
30928fc0c701SSteven Rostedt 
30934aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
30944aeb6967SSteven Rostedt 		return NULL;
30954aeb6967SSteven Rostedt 
30964aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
30974aeb6967SSteven Rostedt 
30984aeb6967SSteven Rostedt 	return iter;
30998fc0c701SSteven Rostedt }
31008fc0c701SSteven Rostedt 
31018fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
31028fc0c701SSteven Rostedt {
31038fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
31048fc0c701SSteven Rostedt 	void *p = NULL;
3105d82d6244SLi Zefan 	loff_t l;
3106d82d6244SLi Zefan 
310769a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
310869a3083cSSteven Rostedt 		return NULL;
310969a3083cSSteven Rostedt 
31102bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
31112bccfffdSSteven Rostedt 		return NULL;
31128fc0c701SSteven Rostedt 
3113d82d6244SLi Zefan 	iter->hidx = 0;
31142bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
31154aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
3116d82d6244SLi Zefan 		if (!p)
3117d82d6244SLi Zefan 			break;
3118d82d6244SLi Zefan 	}
31194aeb6967SSteven Rostedt 	if (!p)
31204aeb6967SSteven Rostedt 		return NULL;
31214aeb6967SSteven Rostedt 
312298c4fd04SSteven Rostedt 	/* Only set this if we have an item */
312398c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
312498c4fd04SSteven Rostedt 
31254aeb6967SSteven Rostedt 	return iter;
31268fc0c701SSteven Rostedt }
31278fc0c701SSteven Rostedt 
31284aeb6967SSteven Rostedt static int
31294aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
31308fc0c701SSteven Rostedt {
3131b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
31328fc0c701SSteven Rostedt 
31334aeb6967SSteven Rostedt 	rec = iter->probe;
31344aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
31354aeb6967SSteven Rostedt 		return -EIO;
31368fc0c701SSteven Rostedt 
3137809dcf29SSteven Rostedt 	if (rec->ops->print)
3138809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
3139809dcf29SSteven Rostedt 
3140b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
31418fc0c701SSteven Rostedt 
31428fc0c701SSteven Rostedt 	if (rec->data)
31438fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
31448fc0c701SSteven Rostedt 	seq_putc(m, '\n');
31458fc0c701SSteven Rostedt 
31468fc0c701SSteven Rostedt 	return 0;
31478fc0c701SSteven Rostedt }
31488fc0c701SSteven Rostedt 
31498fc0c701SSteven Rostedt static void *
31505072c59fSSteven Rostedt t_next(struct seq_file *m, void *v, loff_t *pos)
31515072c59fSSteven Rostedt {
31525072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3153fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
31545072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
31555072c59fSSteven Rostedt 
315645a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
315745a4a237SSteven Rostedt 		return NULL;
315845a4a237SSteven Rostedt 
31598fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
31604aeb6967SSteven Rostedt 		return t_hash_next(m, pos);
31618fc0c701SSteven Rostedt 
31625072c59fSSteven Rostedt 	(*pos)++;
31631106b699SJiri Olsa 	iter->pos = iter->func_pos = *pos;
31645072c59fSSteven Rostedt 
31650c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL)
316657c072c7SSteven Rostedt 		return t_hash_start(m, pos);
31670c75a3edSSteven Rostedt 
31685072c59fSSteven Rostedt  retry:
31695072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
31705072c59fSSteven Rostedt 		if (iter->pg->next) {
31715072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
31725072c59fSSteven Rostedt 			iter->idx = 0;
31735072c59fSSteven Rostedt 			goto retry;
31745072c59fSSteven Rostedt 		}
31755072c59fSSteven Rostedt 	} else {
31765072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
317732082309SSteven Rostedt 		if (((iter->flags & FTRACE_ITER_FILTER) &&
317833b7f99cSSteven Rostedt (Red Hat) 		     !(ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))) ||
31790183fb1cSSteven Rostedt 
318041c52c0dSSteven Rostedt 		    ((iter->flags & FTRACE_ITER_NOTRACE) &&
318133b7f99cSSteven Rostedt (Red Hat) 		     !ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip)) ||
3182647bcd03SSteven Rostedt 
3183647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
318423ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3185647bcd03SSteven Rostedt 
31865072c59fSSteven Rostedt 			rec = NULL;
31875072c59fSSteven Rostedt 			goto retry;
31885072c59fSSteven Rostedt 		}
31895072c59fSSteven Rostedt 	}
31905072c59fSSteven Rostedt 
31914aeb6967SSteven Rostedt 	if (!rec)
319257c072c7SSteven Rostedt 		return t_hash_start(m, pos);
31934aeb6967SSteven Rostedt 
31944aeb6967SSteven Rostedt 	iter->func = rec;
31954aeb6967SSteven Rostedt 
31964aeb6967SSteven Rostedt 	return iter;
31975072c59fSSteven Rostedt }
31985072c59fSSteven Rostedt 
319998c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
320098c4fd04SSteven Rostedt {
320198c4fd04SSteven Rostedt 	iter->pos = 0;
320298c4fd04SSteven Rostedt 	iter->func_pos = 0;
320370f77b3fSDan Carpenter 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_HASH);
32045072c59fSSteven Rostedt }
32055072c59fSSteven Rostedt 
32065072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
32075072c59fSSteven Rostedt {
32085072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3209fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
32105072c59fSSteven Rostedt 	void *p = NULL;
3211694ce0a5SLi Zefan 	loff_t l;
32125072c59fSSteven Rostedt 
32138fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
321445a4a237SSteven Rostedt 
321545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
321645a4a237SSteven Rostedt 		return NULL;
321745a4a237SSteven Rostedt 
32180c75a3edSSteven Rostedt 	/*
321998c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
322098c4fd04SSteven Rostedt 	 */
322198c4fd04SSteven Rostedt 	if (*pos < iter->pos)
322298c4fd04SSteven Rostedt 		reset_iter_read(iter);
322398c4fd04SSteven Rostedt 
322498c4fd04SSteven Rostedt 	/*
32250c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
32260c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
32270c75a3edSSteven Rostedt 	 * functions are enabled.
32280c75a3edSSteven Rostedt 	 */
32298c006cf7SNamhyung Kim 	if ((iter->flags & FTRACE_ITER_FILTER &&
323033b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->filter_hash)) ||
32318c006cf7SNamhyung Kim 	    (iter->flags & FTRACE_ITER_NOTRACE &&
323233b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->notrace_hash))) {
32330c75a3edSSteven Rostedt 		if (*pos > 0)
32348fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
32350c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3236df091625SChris Wright 		/* reset in case of seek/pread */
3237df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
32380c75a3edSSteven Rostedt 		return iter;
32390c75a3edSSteven Rostedt 	}
32400c75a3edSSteven Rostedt 
32418fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
32428fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
32438fc0c701SSteven Rostedt 
324498c4fd04SSteven Rostedt 	/*
324598c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
324698c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
324798c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
324898c4fd04SSteven Rostedt 	 */
3249694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3250694ce0a5SLi Zefan 	iter->idx = 0;
3251694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
3252694ce0a5SLi Zefan 		p = t_next(m, p, &l);
3253694ce0a5SLi Zefan 		if (!p)
3254694ce0a5SLi Zefan 			break;
325550cdaf08SLiming Wang 	}
32565821e1b7Swalimis 
325769a3083cSSteven Rostedt 	if (!p)
32588fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
32598fc0c701SSteven Rostedt 
32604aeb6967SSteven Rostedt 	return iter;
32615072c59fSSteven Rostedt }
32625072c59fSSteven Rostedt 
32635072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
32645072c59fSSteven Rostedt {
32658fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
32665072c59fSSteven Rostedt }
32675072c59fSSteven Rostedt 
326815d5b02cSSteven Rostedt (Red Hat) void * __weak
326915d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
327015d5b02cSSteven Rostedt (Red Hat) {
327115d5b02cSSteven Rostedt (Red Hat) 	return NULL;
327215d5b02cSSteven Rostedt (Red Hat) }
327315d5b02cSSteven Rostedt (Red Hat) 
327415d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
327515d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
327615d5b02cSSteven Rostedt (Red Hat) {
327715d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
327815d5b02cSSteven Rostedt (Red Hat) 
327915d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
328015d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
328115d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
328215d5b02cSSteven Rostedt (Red Hat) }
328315d5b02cSSteven Rostedt (Red Hat) 
32845072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
32855072c59fSSteven Rostedt {
32860c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
32874aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
32885072c59fSSteven Rostedt 
32898fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
32904aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
32918fc0c701SSteven Rostedt 
32920c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
32938c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3294fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
32958c006cf7SNamhyung Kim 		else
3296fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
32970c75a3edSSteven Rostedt 		return 0;
32980c75a3edSSteven Rostedt 	}
32990c75a3edSSteven Rostedt 
33004aeb6967SSteven Rostedt 	rec = iter->func;
33014aeb6967SSteven Rostedt 
33025072c59fSSteven Rostedt 	if (!rec)
33035072c59fSSteven Rostedt 		return 0;
33045072c59fSSteven Rostedt 
3305647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
33069674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3307030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
330815d5b02cSSteven Rostedt (Red Hat) 
3309f8b8be8aSMasami Hiramatsu 		seq_printf(m, " (%ld)%s%s",
33100376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3311f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3312f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ");
33139674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
33145fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
331539daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
331639daa7b9SSteven Rostedt (Red Hat) 				do {
331739daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
331839daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
331939daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3320030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
332139daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
332239daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
332339daa7b9SSteven Rostedt (Red Hat) 			} else
3324fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3325030f4e1cSSteven Rostedt (Red Hat) 		} else {
3326030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
33279674b2faSSteven Rostedt (Red Hat) 		}
33289674b2faSSteven Rostedt (Red Hat) 	}
33299674b2faSSteven Rostedt (Red Hat) 
3330fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
33315072c59fSSteven Rostedt 
33325072c59fSSteven Rostedt 	return 0;
33335072c59fSSteven Rostedt }
33345072c59fSSteven Rostedt 
333588e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
33365072c59fSSteven Rostedt 	.start = t_start,
33375072c59fSSteven Rostedt 	.next = t_next,
33385072c59fSSteven Rostedt 	.stop = t_stop,
33395072c59fSSteven Rostedt 	.show = t_show,
33405072c59fSSteven Rostedt };
33415072c59fSSteven Rostedt 
3342e309b41dSIngo Molnar static int
33435072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
33445072c59fSSteven Rostedt {
33455072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
33465072c59fSSteven Rostedt 
33474eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
33484eebcc81SSteven Rostedt 		return -ENODEV;
33494eebcc81SSteven Rostedt 
335050e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
335150e18b94SJiri Olsa 	if (iter) {
33525072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
3353fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
33544bf39a94SIngo Molnar 	}
33555072c59fSSteven Rostedt 
335650e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
33575072c59fSSteven Rostedt }
33585072c59fSSteven Rostedt 
3359647bcd03SSteven Rostedt static int
3360647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3361647bcd03SSteven Rostedt {
3362647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3363647bcd03SSteven Rostedt 
336450e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
336550e18b94SJiri Olsa 	if (iter) {
3366647bcd03SSteven Rostedt 		iter->pg = ftrace_pages_start;
3367647bcd03SSteven Rostedt 		iter->flags = FTRACE_ITER_ENABLED;
3368fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
3369647bcd03SSteven Rostedt 	}
3370647bcd03SSteven Rostedt 
337150e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
3372647bcd03SSteven Rostedt }
3373647bcd03SSteven Rostedt 
3374fc13cb0cSSteven Rostedt /**
3375fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3376fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3377fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3378fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3379fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3380fc13cb0cSSteven Rostedt  *
3381fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3382fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3383fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3384fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3385fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3386fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3387098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3388fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3389fc13cb0cSSteven Rostedt  */
3390fc13cb0cSSteven Rostedt int
3391f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
33921cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
33935072c59fSSteven Rostedt {
33945072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3395f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
33965072c59fSSteven Rostedt 	int ret = 0;
33975072c59fSSteven Rostedt 
3398f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3399f04f24fbSMasami Hiramatsu 
34004eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
34014eebcc81SSteven Rostedt 		return -ENODEV;
34024eebcc81SSteven Rostedt 
34035072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
34045072c59fSSteven Rostedt 	if (!iter)
34055072c59fSSteven Rostedt 		return -ENOMEM;
34065072c59fSSteven Rostedt 
3407689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
3408689fd8b6S[email protected] 		kfree(iter);
3409689fd8b6S[email protected] 		return -ENOMEM;
3410689fd8b6S[email protected] 	}
3411689fd8b6S[email protected] 
34123f2367baSMasami Hiramatsu 	iter->ops = ops;
34133f2367baSMasami Hiramatsu 	iter->flags = flag;
34143f2367baSMasami Hiramatsu 
341533b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
34163f2367baSMasami Hiramatsu 
3417f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
341833b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
3419f45948e8SSteven Rostedt 	else
342033b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
3421f45948e8SSteven Rostedt 
342233dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3423ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3424ef2fbe16SNamhyung Kim 
3425ef2fbe16SNamhyung Kim 		if (file->f_flags & O_TRUNC)
3426ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3427ef2fbe16SNamhyung Kim 		else
3428ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3429ef2fbe16SNamhyung Kim 
343033dc9b12SSteven Rostedt 		if (!iter->hash) {
343133dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
343233dc9b12SSteven Rostedt 			kfree(iter);
34333f2367baSMasami Hiramatsu 			ret = -ENOMEM;
34343f2367baSMasami Hiramatsu 			goto out_unlock;
343533dc9b12SSteven Rostedt 		}
343633dc9b12SSteven Rostedt 	}
34371cf41dd7SSteven Rostedt 
34385072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
34395072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
34405072c59fSSteven Rostedt 
34415072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
34425072c59fSSteven Rostedt 		if (!ret) {
34435072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
34445072c59fSSteven Rostedt 			m->private = iter;
344579fe249cSLi Zefan 		} else {
344633dc9b12SSteven Rostedt 			/* Failed */
344733dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
344879fe249cSLi Zefan 			trace_parser_put(&iter->parser);
34495072c59fSSteven Rostedt 			kfree(iter);
345079fe249cSLi Zefan 		}
34515072c59fSSteven Rostedt 	} else
34525072c59fSSteven Rostedt 		file->private_data = iter;
34533f2367baSMasami Hiramatsu 
34543f2367baSMasami Hiramatsu  out_unlock:
345533b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
34565072c59fSSteven Rostedt 
34575072c59fSSteven Rostedt 	return ret;
34585072c59fSSteven Rostedt }
34595072c59fSSteven Rostedt 
346041c52c0dSSteven Rostedt static int
346141c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
346241c52c0dSSteven Rostedt {
3463e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3464e3b3e2e8SSteven Rostedt (Red Hat) 
3465e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
346669a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
34671cf41dd7SSteven Rostedt 			inode, file);
346841c52c0dSSteven Rostedt }
346941c52c0dSSteven Rostedt 
347041c52c0dSSteven Rostedt static int
347141c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
347241c52c0dSSteven Rostedt {
3473e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3474e3b3e2e8SSteven Rostedt (Red Hat) 
3475e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
34761cf41dd7SSteven Rostedt 				 inode, file);
347741c52c0dSSteven Rostedt }
347841c52c0dSSteven Rostedt 
34793ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
34803ba00929SDmitry Safonov struct ftrace_glob {
34813ba00929SDmitry Safonov 	char *search;
34823ba00929SDmitry Safonov 	unsigned len;
34833ba00929SDmitry Safonov 	int type;
34843ba00929SDmitry Safonov };
34853ba00929SDmitry Safonov 
34867132e2d6SThiago Jung Bauermann /*
34877132e2d6SThiago Jung Bauermann  * If symbols in an architecture don't correspond exactly to the user-visible
34887132e2d6SThiago Jung Bauermann  * name of what they represent, it is possible to define this function to
34897132e2d6SThiago Jung Bauermann  * perform the necessary adjustments.
34907132e2d6SThiago Jung Bauermann */
34917132e2d6SThiago Jung Bauermann char * __weak arch_ftrace_match_adjust(char *str, const char *search)
34927132e2d6SThiago Jung Bauermann {
34937132e2d6SThiago Jung Bauermann 	return str;
34947132e2d6SThiago Jung Bauermann }
34957132e2d6SThiago Jung Bauermann 
34963ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
34979f4801e3SSteven Rostedt {
34989f4801e3SSteven Rostedt 	int matched = 0;
3499751e9983SLi Zefan 	int slen;
35009f4801e3SSteven Rostedt 
35017132e2d6SThiago Jung Bauermann 	str = arch_ftrace_match_adjust(str, g->search);
35027132e2d6SThiago Jung Bauermann 
35033ba00929SDmitry Safonov 	switch (g->type) {
35049f4801e3SSteven Rostedt 	case MATCH_FULL:
35053ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
35069f4801e3SSteven Rostedt 			matched = 1;
35079f4801e3SSteven Rostedt 		break;
35089f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
35093ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
35109f4801e3SSteven Rostedt 			matched = 1;
35119f4801e3SSteven Rostedt 		break;
35129f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
35133ba00929SDmitry Safonov 		if (strstr(str, g->search))
35149f4801e3SSteven Rostedt 			matched = 1;
35159f4801e3SSteven Rostedt 		break;
35169f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
3517751e9983SLi Zefan 		slen = strlen(str);
35183ba00929SDmitry Safonov 		if (slen >= g->len &&
35193ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
35209f4801e3SSteven Rostedt 			matched = 1;
35219f4801e3SSteven Rostedt 		break;
352260f1d5e3SMasami Hiramatsu 	case MATCH_GLOB:
352360f1d5e3SMasami Hiramatsu 		if (glob_match(g->search, str))
352460f1d5e3SMasami Hiramatsu 			matched = 1;
352560f1d5e3SMasami Hiramatsu 		break;
35269f4801e3SSteven Rostedt 	}
35279f4801e3SSteven Rostedt 
35289f4801e3SSteven Rostedt 	return matched;
35299f4801e3SSteven Rostedt }
35309f4801e3SSteven Rostedt 
3531b448c4e3SSteven Rostedt static int
3532f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
353364e7c440SSteven Rostedt {
3534b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
3535b448c4e3SSteven Rostedt 	int ret = 0;
3536b448c4e3SSteven Rostedt 
35371cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
3538f0a3b154SDmitry Safonov 	if (clear_filter) {
3539b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
3540b448c4e3SSteven Rostedt 		if (!entry)
3541b448c4e3SSteven Rostedt 			return 0;
3542b448c4e3SSteven Rostedt 
354333dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
3544b448c4e3SSteven Rostedt 	} else {
3545b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
3546b448c4e3SSteven Rostedt 		if (entry)
3547b448c4e3SSteven Rostedt 			return 0;
3548b448c4e3SSteven Rostedt 
3549b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
3550b448c4e3SSteven Rostedt 	}
3551b448c4e3SSteven Rostedt 	return ret;
3552996e87beSSteven Rostedt }
3553996e87beSSteven Rostedt 
355464e7c440SSteven Rostedt static int
35550b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
35560b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
355764e7c440SSteven Rostedt {
355864e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
3559b9df92d2SSteven Rostedt 	char *modname;
356064e7c440SSteven Rostedt 
3561b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
3562b9df92d2SSteven Rostedt 
35630b507e1eSDmitry Safonov 	if (mod_g) {
35640b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
35650b507e1eSDmitry Safonov 
35660b507e1eSDmitry Safonov 		/* blank module name to match all modules */
35670b507e1eSDmitry Safonov 		if (!mod_g->len) {
35680b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
35690b507e1eSDmitry Safonov 			if ((!exclude_mod) != (!modname))
35700b507e1eSDmitry Safonov 				goto func_match;
35710b507e1eSDmitry Safonov 			return 0;
35720b507e1eSDmitry Safonov 		}
35730b507e1eSDmitry Safonov 
35740b507e1eSDmitry Safonov 		/* not matching the module */
35750b507e1eSDmitry Safonov 		if (!modname || !mod_matches) {
35760b507e1eSDmitry Safonov 			if (exclude_mod)
35770b507e1eSDmitry Safonov 				goto func_match;
35780b507e1eSDmitry Safonov 			else
35790b507e1eSDmitry Safonov 				return 0;
35800b507e1eSDmitry Safonov 		}
35810b507e1eSDmitry Safonov 
35820b507e1eSDmitry Safonov 		if (mod_matches && exclude_mod)
3583b9df92d2SSteven Rostedt 			return 0;
3584b9df92d2SSteven Rostedt 
35850b507e1eSDmitry Safonov func_match:
3586b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
35873ba00929SDmitry Safonov 		if (!func_g->len)
3588b9df92d2SSteven Rostedt 			return 1;
3589b9df92d2SSteven Rostedt 	}
3590b9df92d2SSteven Rostedt 
35913ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
359264e7c440SSteven Rostedt }
359364e7c440SSteven Rostedt 
35941cf41dd7SSteven Rostedt static int
35953ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
35969f4801e3SSteven Rostedt {
35979f4801e3SSteven Rostedt 	struct ftrace_page *pg;
35989f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
35993ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
36000b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
36010b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
36020b507e1eSDmitry Safonov 	int exclude_mod = 0;
3603311d16daSLi Zefan 	int found = 0;
3604b448c4e3SSteven Rostedt 	int ret;
3605f0a3b154SDmitry Safonov 	int clear_filter;
36069f4801e3SSteven Rostedt 
36070b507e1eSDmitry Safonov 	if (func) {
36083ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
36093ba00929SDmitry Safonov 						 &clear_filter);
36103ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
3611b9df92d2SSteven Rostedt 	}
3612b9df92d2SSteven Rostedt 
36130b507e1eSDmitry Safonov 	if (mod) {
36140b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
36150b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
36160b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
3617b9df92d2SSteven Rostedt 	}
3618b9df92d2SSteven Rostedt 
361952baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
3620b9df92d2SSteven Rostedt 
3621b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
3622b9df92d2SSteven Rostedt 		goto out_unlock;
3623b9df92d2SSteven Rostedt 
3624265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
3625546fece4SSteven Rostedt (Red Hat) 
3626546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
3627546fece4SSteven Rostedt (Red Hat) 			continue;
3628546fece4SSteven Rostedt (Red Hat) 
36290b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
3630f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
3631b448c4e3SSteven Rostedt 			if (ret < 0) {
3632b448c4e3SSteven Rostedt 				found = ret;
3633b448c4e3SSteven Rostedt 				goto out_unlock;
3634b448c4e3SSteven Rostedt 			}
3635311d16daSLi Zefan 			found = 1;
36365072c59fSSteven Rostedt 		}
3637265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3638b9df92d2SSteven Rostedt  out_unlock:
363952baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3640311d16daSLi Zefan 
3641311d16daSLi Zefan 	return found;
36425072c59fSSteven Rostedt }
36435072c59fSSteven Rostedt 
364464e7c440SSteven Rostedt static int
36451cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
364664e7c440SSteven Rostedt {
3647f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
364864e7c440SSteven Rostedt }
364964e7c440SSteven Rostedt 
365064e7c440SSteven Rostedt 
3651f6180773SSteven Rostedt /*
3652f6180773SSteven Rostedt  * We register the module command as a template to show others how
3653f6180773SSteven Rostedt  * to register the a command as well.
3654f6180773SSteven Rostedt  */
3655f6180773SSteven Rostedt 
3656f6180773SSteven Rostedt static int
365743dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
3658f0a3b154SDmitry Safonov 		    char *func, char *cmd, char *module, int enable)
3659f6180773SSteven Rostedt {
36605e3949f0SDmitry Safonov 	int ret;
3661f6180773SSteven Rostedt 
3662f6180773SSteven Rostedt 	/*
3663f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
3664f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
3665f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
3666f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
3667f6180773SSteven Rostedt 	 * parameter.
3668f6180773SSteven Rostedt 	 */
3669f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
3670b448c4e3SSteven Rostedt 	if (!ret)
36715e3949f0SDmitry Safonov 		return -EINVAL;
3672b448c4e3SSteven Rostedt 	if (ret < 0)
3673b448c4e3SSteven Rostedt 		return ret;
3674f6180773SSteven Rostedt 	return 0;
3675f6180773SSteven Rostedt }
3676f6180773SSteven Rostedt 
3677f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
3678f6180773SSteven Rostedt 	.name			= "mod",
3679f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
3680f6180773SSteven Rostedt };
3681f6180773SSteven Rostedt 
3682f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
3683f6180773SSteven Rostedt {
3684f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
3685f6180773SSteven Rostedt }
36866f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
3687f6180773SSteven Rostedt 
36882f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
3689a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
369059df055fSSteven Rostedt {
3691b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
369259df055fSSteven Rostedt 	struct hlist_head *hhd;
369359df055fSSteven Rostedt 	unsigned long key;
369459df055fSSteven Rostedt 
369559df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
369659df055fSSteven Rostedt 
369759df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
369859df055fSSteven Rostedt 
369959df055fSSteven Rostedt 	if (hlist_empty(hhd))
370059df055fSSteven Rostedt 		return;
370159df055fSSteven Rostedt 
370259df055fSSteven Rostedt 	/*
370359df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
370459df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
370559df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
370659df055fSSteven Rostedt 	 */
37075168ae50SSteven Rostedt 	preempt_disable_notrace();
37081bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, node) {
370959df055fSSteven Rostedt 		if (entry->ip == ip)
371059df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
371159df055fSSteven Rostedt 	}
37125168ae50SSteven Rostedt 	preempt_enable_notrace();
371359df055fSSteven Rostedt }
371459df055fSSteven Rostedt 
3715b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
371659df055fSSteven Rostedt {
3717b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
3718f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_INITIALIZED,
371933b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(trace_probe_ops)
372059df055fSSteven Rostedt };
372159df055fSSteven Rostedt 
3722b6887d79SSteven Rostedt static int ftrace_probe_registered;
372359df055fSSteven Rostedt 
37247485058eSSteven Rostedt (Red Hat) static void __enable_ftrace_function_probe(struct ftrace_ops_hash *old_hash)
372559df055fSSteven Rostedt {
3726b848914cSSteven Rostedt 	int ret;
372759df055fSSteven Rostedt 	int i;
372859df055fSSteven Rostedt 
372919dd603eSSteven Rostedt (Red Hat) 	if (ftrace_probe_registered) {
373019dd603eSSteven Rostedt (Red Hat) 		/* still need to update the function call sites */
373119dd603eSSteven Rostedt (Red Hat) 		if (ftrace_enabled)
37328252ecf3SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(&trace_probe_ops, FTRACE_UPDATE_CALLS,
37338252ecf3SSteven Rostedt (Red Hat) 					       old_hash);
373459df055fSSteven Rostedt 		return;
373519dd603eSSteven Rostedt (Red Hat) 	}
373659df055fSSteven Rostedt 
373759df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
373859df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
373959df055fSSteven Rostedt 		if (hhd->first)
374059df055fSSteven Rostedt 			break;
374159df055fSSteven Rostedt 	}
374259df055fSSteven Rostedt 	/* Nothing registered? */
374359df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
374459df055fSSteven Rostedt 		return;
374559df055fSSteven Rostedt 
3746a1cd6173SSteven Rostedt 	ret = ftrace_startup(&trace_probe_ops, 0);
3747b848914cSSteven Rostedt 
3748b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
374959df055fSSteven Rostedt }
375059df055fSSteven Rostedt 
3751b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
375259df055fSSteven Rostedt {
375359df055fSSteven Rostedt 	int i;
375459df055fSSteven Rostedt 
3755b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
375659df055fSSteven Rostedt 		return;
375759df055fSSteven Rostedt 
375859df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
375959df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
376059df055fSSteven Rostedt 		if (hhd->first)
376159df055fSSteven Rostedt 			return;
376259df055fSSteven Rostedt 	}
376359df055fSSteven Rostedt 
376459df055fSSteven Rostedt 	/* no more funcs left */
3765b848914cSSteven Rostedt 	ftrace_shutdown(&trace_probe_ops, 0);
3766b848914cSSteven Rostedt 
3767b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
376859df055fSSteven Rostedt }
376959df055fSSteven Rostedt 
377059df055fSSteven Rostedt 
37717818b388SSteven Rostedt (Red Hat) static void ftrace_free_entry(struct ftrace_func_probe *entry)
377259df055fSSteven Rostedt {
377359df055fSSteven Rostedt 	if (entry->ops->free)
3774e67efb93SSteven Rostedt (Red Hat) 		entry->ops->free(entry->ops, entry->ip, &entry->data);
377559df055fSSteven Rostedt 	kfree(entry);
377659df055fSSteven Rostedt }
377759df055fSSteven Rostedt 
377859df055fSSteven Rostedt int
3779b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
378059df055fSSteven Rostedt 			      void *data)
378159df055fSSteven Rostedt {
37827485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
3783b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
37843ba00929SDmitry Safonov 	struct ftrace_glob func_g;
378533b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
37863296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
3787e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
378859df055fSSteven Rostedt 	struct ftrace_page *pg;
378959df055fSSteven Rostedt 	struct dyn_ftrace *rec;
37903ba00929SDmitry Safonov 	int not;
37916a24a244SSteven Rostedt 	unsigned long key;
379259df055fSSteven Rostedt 	int count = 0;
3793e1df4cb6SSteven Rostedt (Red Hat) 	int ret;
379459df055fSSteven Rostedt 
37953ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(glob, strlen(glob),
37963ba00929SDmitry Safonov 			&func_g.search, &not);
37973ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
379859df055fSSteven Rostedt 
3799b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
380059df055fSSteven Rostedt 	if (WARN_ON(not))
380159df055fSSteven Rostedt 		return -EINVAL;
380259df055fSSteven Rostedt 
380333b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
380459df055fSSteven Rostedt 
38057485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = old_hash;
38067485058eSSteven Rostedt (Red Hat) 	/* Probes only have filters */
38077485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = NULL;
38087485058eSSteven Rostedt (Red Hat) 
38093296fc4eSSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
3810e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash) {
3811e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENOMEM;
38125ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3813e1df4cb6SSteven Rostedt (Red Hat) 	}
3814e1df4cb6SSteven Rostedt (Red Hat) 
3815e1df4cb6SSteven Rostedt (Red Hat) 	if (unlikely(ftrace_disabled)) {
3816e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENODEV;
38175ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3818e1df4cb6SSteven Rostedt (Red Hat) 	}
381945a4a237SSteven Rostedt 
38205ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
38215ae0bf59SSteven Rostedt (Red Hat) 
382259df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
382359df055fSSteven Rostedt 
3824546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
3825546fece4SSteven Rostedt (Red Hat) 			continue;
3826546fece4SSteven Rostedt (Red Hat) 
38270b507e1eSDmitry Safonov 		if (!ftrace_match_record(rec, &func_g, NULL, 0))
382859df055fSSteven Rostedt 			continue;
382959df055fSSteven Rostedt 
383059df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
383159df055fSSteven Rostedt 		if (!entry) {
3832b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
383359df055fSSteven Rostedt 			if (!count)
383459df055fSSteven Rostedt 				count = -ENOMEM;
383559df055fSSteven Rostedt 			goto out_unlock;
383659df055fSSteven Rostedt 		}
383759df055fSSteven Rostedt 
383859df055fSSteven Rostedt 		count++;
383959df055fSSteven Rostedt 
384059df055fSSteven Rostedt 		entry->data = data;
384159df055fSSteven Rostedt 
384259df055fSSteven Rostedt 		/*
384359df055fSSteven Rostedt 		 * The caller might want to do something special
384459df055fSSteven Rostedt 		 * for each function we find. We call the callback
384559df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
384659df055fSSteven Rostedt 		 */
3847e67efb93SSteven Rostedt (Red Hat) 		if (ops->init) {
3848e67efb93SSteven Rostedt (Red Hat) 			if (ops->init(ops, rec->ip, &entry->data) < 0) {
384959df055fSSteven Rostedt 				/* caller does not like this func */
385059df055fSSteven Rostedt 				kfree(entry);
385159df055fSSteven Rostedt 				continue;
385259df055fSSteven Rostedt 			}
385359df055fSSteven Rostedt 		}
385459df055fSSteven Rostedt 
3855e1df4cb6SSteven Rostedt (Red Hat) 		ret = enter_record(hash, rec, 0);
3856e1df4cb6SSteven Rostedt (Red Hat) 		if (ret < 0) {
3857e1df4cb6SSteven Rostedt (Red Hat) 			kfree(entry);
3858e1df4cb6SSteven Rostedt (Red Hat) 			count = ret;
3859e1df4cb6SSteven Rostedt (Red Hat) 			goto out_unlock;
3860e1df4cb6SSteven Rostedt (Red Hat) 		}
3861e1df4cb6SSteven Rostedt (Red Hat) 
386259df055fSSteven Rostedt 		entry->ops = ops;
386359df055fSSteven Rostedt 		entry->ip = rec->ip;
386459df055fSSteven Rostedt 
386559df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
386659df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
386759df055fSSteven Rostedt 
386859df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
3869e1df4cb6SSteven Rostedt (Red Hat) 
3870e1df4cb6SSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
38718252ecf3SSteven Rostedt (Red Hat) 
38727485058eSSteven Rostedt (Red Hat) 	__enable_ftrace_function_probe(&old_hash_ops);
38738252ecf3SSteven Rostedt (Red Hat) 
38743296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
38753296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
38763296fc4eSSteven Rostedt (Red Hat) 	else
3877e1df4cb6SSteven Rostedt (Red Hat) 		count = ret;
3878e1df4cb6SSteven Rostedt (Red Hat) 
387959df055fSSteven Rostedt  out_unlock:
38805ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
38815ae0bf59SSteven Rostedt (Red Hat)  out:
388233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3883e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
388459df055fSSteven Rostedt 
388559df055fSSteven Rostedt 	return count;
388659df055fSSteven Rostedt }
388759df055fSSteven Rostedt 
388859df055fSSteven Rostedt enum {
3889b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
3890b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
389159df055fSSteven Rostedt };
389259df055fSSteven Rostedt 
389359df055fSSteven Rostedt static void
3894b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
389559df055fSSteven Rostedt 				  void *data, int flags)
389659df055fSSteven Rostedt {
3897e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_func_entry *rec_entry;
3898b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
38997818b388SSteven Rostedt (Red Hat) 	struct ftrace_func_probe *p;
39003ba00929SDmitry Safonov 	struct ftrace_glob func_g;
390133b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
39023296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
39037818b388SSteven Rostedt (Red Hat) 	struct list_head free_list;
3904e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
3905b67bfe0dSSasha Levin 	struct hlist_node *tmp;
390659df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
39073ba00929SDmitry Safonov 	int i, ret;
390859df055fSSteven Rostedt 
3909b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
39103ba00929SDmitry Safonov 		func_g.search = NULL;
3911b36461daSAtsushi Tsuji 	else if (glob) {
391259df055fSSteven Rostedt 		int not;
391359df055fSSteven Rostedt 
39143ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
39153ba00929SDmitry Safonov 						 &func_g.search, &not);
39163ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
39173ba00929SDmitry Safonov 		func_g.search = glob;
391859df055fSSteven Rostedt 
3919b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
392059df055fSSteven Rostedt 		if (WARN_ON(not))
392159df055fSSteven Rostedt 			return;
392259df055fSSteven Rostedt 	}
392359df055fSSteven Rostedt 
392433b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
3925e1df4cb6SSteven Rostedt (Red Hat) 
3926e1df4cb6SSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3927e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
3928e1df4cb6SSteven Rostedt (Red Hat) 		/* Hmm, should report this somehow */
3929e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
3930e1df4cb6SSteven Rostedt (Red Hat) 
39317818b388SSteven Rostedt (Red Hat) 	INIT_LIST_HEAD(&free_list);
39327818b388SSteven Rostedt (Red Hat) 
393359df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
393459df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
393559df055fSSteven Rostedt 
3936b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tmp, hhd, node) {
393759df055fSSteven Rostedt 
393859df055fSSteven Rostedt 			/* break up if statements for readability */
3939b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
394059df055fSSteven Rostedt 				continue;
394159df055fSSteven Rostedt 
3942b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
394359df055fSSteven Rostedt 				continue;
394459df055fSSteven Rostedt 
394559df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
39463ba00929SDmitry Safonov 			if (func_g.search) {
394759df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
394859df055fSSteven Rostedt 						NULL, str);
39493ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
395059df055fSSteven Rostedt 					continue;
395159df055fSSteven Rostedt 			}
395259df055fSSteven Rostedt 
3953e1df4cb6SSteven Rostedt (Red Hat) 			rec_entry = ftrace_lookup_ip(hash, entry->ip);
3954e1df4cb6SSteven Rostedt (Red Hat) 			/* It is possible more than one entry had this ip */
3955e1df4cb6SSteven Rostedt (Red Hat) 			if (rec_entry)
3956e1df4cb6SSteven Rostedt (Red Hat) 				free_hash_entry(hash, rec_entry);
3957e1df4cb6SSteven Rostedt (Red Hat) 
3958740466bcSSteven Rostedt (Red Hat) 			hlist_del_rcu(&entry->node);
39597818b388SSteven Rostedt (Red Hat) 			list_add(&entry->free_list, &free_list);
396059df055fSSteven Rostedt 		}
396159df055fSSteven Rostedt 	}
39623f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
3963b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
3964e1df4cb6SSteven Rostedt (Red Hat) 	/*
3965e1df4cb6SSteven Rostedt (Red Hat) 	 * Remove after the disable is called. Otherwise, if the last
3966e1df4cb6SSteven Rostedt (Red Hat) 	 * probe is removed, a null hash means *all enabled*.
3967e1df4cb6SSteven Rostedt (Red Hat) 	 */
39683296fc4eSSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
39697818b388SSteven Rostedt (Red Hat) 	synchronize_sched();
39703296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
39713296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
39723296fc4eSSteven Rostedt (Red Hat) 
39737818b388SSteven Rostedt (Red Hat) 	list_for_each_entry_safe(entry, p, &free_list, free_list) {
39747818b388SSteven Rostedt (Red Hat) 		list_del(&entry->free_list);
39757818b388SSteven Rostedt (Red Hat) 		ftrace_free_entry(entry);
39767818b388SSteven Rostedt (Red Hat) 	}
39773f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
39787818b388SSteven Rostedt (Red Hat) 
3979e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
398033b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3981e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
398259df055fSSteven Rostedt }
398359df055fSSteven Rostedt 
398459df055fSSteven Rostedt void
3985b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
398659df055fSSteven Rostedt 				void *data)
398759df055fSSteven Rostedt {
3988b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
3989b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
399059df055fSSteven Rostedt }
399159df055fSSteven Rostedt 
399259df055fSSteven Rostedt void
3993b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
399459df055fSSteven Rostedt {
3995b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
399659df055fSSteven Rostedt }
399759df055fSSteven Rostedt 
3998b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
399959df055fSSteven Rostedt {
4000b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
400159df055fSSteven Rostedt }
400259df055fSSteven Rostedt 
4003f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
4004f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
4005f6180773SSteven Rostedt 
400638de93abSTom Zanussi /*
400738de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
400838de93abSTom Zanussi  * __init too.
400938de93abSTom Zanussi  */
401038de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
4011f6180773SSteven Rostedt {
4012f6180773SSteven Rostedt 	struct ftrace_func_command *p;
4013f6180773SSteven Rostedt 	int ret = 0;
4014f6180773SSteven Rostedt 
4015f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4016f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4017f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4018f6180773SSteven Rostedt 			ret = -EBUSY;
4019f6180773SSteven Rostedt 			goto out_unlock;
4020f6180773SSteven Rostedt 		}
4021f6180773SSteven Rostedt 	}
4022f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
4023f6180773SSteven Rostedt  out_unlock:
4024f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4025f6180773SSteven Rostedt 
4026f6180773SSteven Rostedt 	return ret;
4027f6180773SSteven Rostedt }
4028f6180773SSteven Rostedt 
402938de93abSTom Zanussi /*
403038de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
403138de93abSTom Zanussi  * this __init too.
403238de93abSTom Zanussi  */
403338de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
4034f6180773SSteven Rostedt {
4035f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
4036f6180773SSteven Rostedt 	int ret = -ENODEV;
4037f6180773SSteven Rostedt 
4038f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4039f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
4040f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
4041f6180773SSteven Rostedt 			ret = 0;
4042f6180773SSteven Rostedt 			list_del_init(&p->list);
4043f6180773SSteven Rostedt 			goto out_unlock;
4044f6180773SSteven Rostedt 		}
4045f6180773SSteven Rostedt 	}
4046f6180773SSteven Rostedt  out_unlock:
4047f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
4048f6180773SSteven Rostedt 
4049f6180773SSteven Rostedt 	return ret;
4050f6180773SSteven Rostedt }
4051f6180773SSteven Rostedt 
405233dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
405333dc9b12SSteven Rostedt 				char *buff, int len, int enable)
405464e7c440SSteven Rostedt {
4055f6180773SSteven Rostedt 	char *func, *command, *next = buff;
40566a24a244SSteven Rostedt 	struct ftrace_func_command *p;
40570aff1c0cSGuoWen Li 	int ret = -EINVAL;
405864e7c440SSteven Rostedt 
405964e7c440SSteven Rostedt 	func = strsep(&next, ":");
406064e7c440SSteven Rostedt 
406164e7c440SSteven Rostedt 	if (!next) {
40621cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
4063b448c4e3SSteven Rostedt 		if (!ret)
4064b448c4e3SSteven Rostedt 			ret = -EINVAL;
4065b448c4e3SSteven Rostedt 		if (ret < 0)
4066311d16daSLi Zefan 			return ret;
4067b448c4e3SSteven Rostedt 		return 0;
406864e7c440SSteven Rostedt 	}
406964e7c440SSteven Rostedt 
4070f6180773SSteven Rostedt 	/* command found */
407164e7c440SSteven Rostedt 
407264e7c440SSteven Rostedt 	command = strsep(&next, ":");
407364e7c440SSteven Rostedt 
4074f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4075f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4076f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
407743dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
4078f6180773SSteven Rostedt 			goto out_unlock;
407964e7c440SSteven Rostedt 		}
4080f6180773SSteven Rostedt 	}
4081f6180773SSteven Rostedt  out_unlock:
4082f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
408364e7c440SSteven Rostedt 
4084f6180773SSteven Rostedt 	return ret;
408564e7c440SSteven Rostedt }
408664e7c440SSteven Rostedt 
4087e309b41dSIngo Molnar static ssize_t
408841c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
408941c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
40905072c59fSSteven Rostedt {
40915072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
4092689fd8b6S[email protected] 	struct trace_parser *parser;
4093689fd8b6S[email protected] 	ssize_t ret, read;
40945072c59fSSteven Rostedt 
40954ba7978eSLi Zefan 	if (!cnt)
40965072c59fSSteven Rostedt 		return 0;
40975072c59fSSteven Rostedt 
40985072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
40995072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
41005072c59fSSteven Rostedt 		iter = m->private;
41015072c59fSSteven Rostedt 	} else
41025072c59fSSteven Rostedt 		iter = file->private_data;
41035072c59fSSteven Rostedt 
4104f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
41053f2367baSMasami Hiramatsu 		return -ENODEV;
41063f2367baSMasami Hiramatsu 
41073f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
4108f04f24fbSMasami Hiramatsu 
4109689fd8b6S[email protected] 	parser = &iter->parser;
4110689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
41115072c59fSSteven Rostedt 
41124ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
4113689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
411433dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
4115689fd8b6S[email protected] 					   parser->idx, enable);
4116313254a9SLi Zefan 		trace_parser_clear(parser);
41177c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
41183f2367baSMasami Hiramatsu 			goto out;
41195072c59fSSteven Rostedt 	}
41205072c59fSSteven Rostedt 
41215072c59fSSteven Rostedt 	ret = read;
41223f2367baSMasami Hiramatsu  out:
41235072c59fSSteven Rostedt 	return ret;
41245072c59fSSteven Rostedt }
41255072c59fSSteven Rostedt 
4126fc13cb0cSSteven Rostedt ssize_t
412741c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
412841c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
412941c52c0dSSteven Rostedt {
413041c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
413141c52c0dSSteven Rostedt }
413241c52c0dSSteven Rostedt 
4133fc13cb0cSSteven Rostedt ssize_t
413441c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
413541c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
413641c52c0dSSteven Rostedt {
413741c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
413841c52c0dSSteven Rostedt }
413941c52c0dSSteven Rostedt 
414033dc9b12SSteven Rostedt static int
4141647664eaSMasami Hiramatsu ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
4142647664eaSMasami Hiramatsu {
4143647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
4144647664eaSMasami Hiramatsu 
4145647664eaSMasami Hiramatsu 	if (!ftrace_location(ip))
4146647664eaSMasami Hiramatsu 		return -EINVAL;
4147647664eaSMasami Hiramatsu 
4148647664eaSMasami Hiramatsu 	if (remove) {
4149647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
4150647664eaSMasami Hiramatsu 		if (!entry)
4151647664eaSMasami Hiramatsu 			return -ENOENT;
4152647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
4153647664eaSMasami Hiramatsu 		return 0;
4154647664eaSMasami Hiramatsu 	}
4155647664eaSMasami Hiramatsu 
4156647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
4157647664eaSMasami Hiramatsu }
4158647664eaSMasami Hiramatsu 
41598252ecf3SSteven Rostedt (Red Hat) static void ftrace_ops_update_code(struct ftrace_ops *ops,
41607485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
41611c80c432SSteven Rostedt (Red Hat) {
41628f86f837SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
41638f86f837SSteven Rostedt (Red Hat) 
41648f86f837SSteven Rostedt (Red Hat) 	if (!ftrace_enabled)
41658f86f837SSteven Rostedt (Red Hat) 		return;
41668f86f837SSteven Rostedt (Red Hat) 
41678f86f837SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
41688252ecf3SSteven Rostedt (Red Hat) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
41698f86f837SSteven Rostedt (Red Hat) 		return;
41708f86f837SSteven Rostedt (Red Hat) 	}
41718f86f837SSteven Rostedt (Red Hat) 
41728f86f837SSteven Rostedt (Red Hat) 	/*
41738f86f837SSteven Rostedt (Red Hat) 	 * If this is the shared global_ops filter, then we need to
41748f86f837SSteven Rostedt (Red Hat) 	 * check if there is another ops that shares it, is enabled.
41758f86f837SSteven Rostedt (Red Hat) 	 * If so, we still need to run the modify code.
41768f86f837SSteven Rostedt (Red Hat) 	 */
41778f86f837SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
41788f86f837SSteven Rostedt (Red Hat) 		return;
41798f86f837SSteven Rostedt (Red Hat) 
41808f86f837SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
41818f86f837SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash &&
41828f86f837SSteven Rostedt (Red Hat) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
41838f86f837SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
41848f86f837SSteven Rostedt (Red Hat) 			/* Only need to do this once */
41858f86f837SSteven Rostedt (Red Hat) 			return;
41868f86f837SSteven Rostedt (Red Hat) 		}
41878f86f837SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
41881c80c432SSteven Rostedt (Red Hat) }
41891c80c432SSteven Rostedt (Red Hat) 
4190647664eaSMasami Hiramatsu static int
4191647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
4192647664eaSMasami Hiramatsu 		unsigned long ip, int remove, int reset, int enable)
419341c52c0dSSteven Rostedt {
419433dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
41957485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
41963296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4197f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
419833dc9b12SSteven Rostedt 	int ret;
4199f45948e8SSteven Rostedt 
420041c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
420133dc9b12SSteven Rostedt 		return -ENODEV;
420241c52c0dSSteven Rostedt 
420333b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
42043f2367baSMasami Hiramatsu 
4205f45948e8SSteven Rostedt 	if (enable)
420633b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
4207f45948e8SSteven Rostedt 	else
420833b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
420933dc9b12SSteven Rostedt 
4210b972cc58SWang Nan 	if (reset)
4211b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
4212b972cc58SWang Nan 	else
421333dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
4214b972cc58SWang Nan 
42153f2367baSMasami Hiramatsu 	if (!hash) {
42163f2367baSMasami Hiramatsu 		ret = -ENOMEM;
42173f2367baSMasami Hiramatsu 		goto out_regex_unlock;
42183f2367baSMasami Hiramatsu 	}
4219f45948e8SSteven Rostedt 
4220ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
4221ac483c44SJiri Olsa 		ret = -EINVAL;
4222ac483c44SJiri Olsa 		goto out_regex_unlock;
4223ac483c44SJiri Olsa 	}
4224647664eaSMasami Hiramatsu 	if (ip) {
4225647664eaSMasami Hiramatsu 		ret = ftrace_match_addr(hash, ip, remove);
4226647664eaSMasami Hiramatsu 		if (ret < 0)
4227647664eaSMasami Hiramatsu 			goto out_regex_unlock;
4228647664eaSMasami Hiramatsu 	}
422933dc9b12SSteven Rostedt 
423033dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
42313296fc4eSSteven Rostedt (Red Hat) 	old_hash = *orig_hash;
42327485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
42337485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
423441fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
42353296fc4eSSteven Rostedt (Red Hat) 	if (!ret) {
42367485058eSSteven Rostedt (Red Hat) 		ftrace_ops_update_code(ops, &old_hash_ops);
42373296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
42383296fc4eSSteven Rostedt (Red Hat) 	}
423933dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
424033dc9b12SSteven Rostedt 
4241ac483c44SJiri Olsa  out_regex_unlock:
424233b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
424333dc9b12SSteven Rostedt 
424433dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
424533dc9b12SSteven Rostedt 	return ret;
424641c52c0dSSteven Rostedt }
424741c52c0dSSteven Rostedt 
4248647664eaSMasami Hiramatsu static int
4249647664eaSMasami Hiramatsu ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
4250647664eaSMasami Hiramatsu 		int reset, int enable)
4251647664eaSMasami Hiramatsu {
4252647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
4253647664eaSMasami Hiramatsu }
4254647664eaSMasami Hiramatsu 
4255647664eaSMasami Hiramatsu /**
4256647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
4257647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
4258647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
4259647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
4260647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
4261647664eaSMasami Hiramatsu  *
4262647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
4263647664eaSMasami Hiramatsu  * If @ip is NULL, it failes to update filter.
4264647664eaSMasami Hiramatsu  */
4265647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
4266647664eaSMasami Hiramatsu 			 int remove, int reset)
4267647664eaSMasami Hiramatsu {
4268f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4269647664eaSMasami Hiramatsu 	return ftrace_set_addr(ops, ip, remove, reset, 1);
4270647664eaSMasami Hiramatsu }
4271647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
4272647664eaSMasami Hiramatsu 
4273d032ae89SJoel Fernandes /**
4274d032ae89SJoel Fernandes  * ftrace_ops_set_global_filter - setup ops to use global filters
4275d032ae89SJoel Fernandes  * @ops - the ops which will use the global filters
4276d032ae89SJoel Fernandes  *
4277d032ae89SJoel Fernandes  * ftrace users who need global function trace filtering should call this.
4278d032ae89SJoel Fernandes  * It can set the global filter only if ops were not initialized before.
4279d032ae89SJoel Fernandes  */
4280d032ae89SJoel Fernandes void ftrace_ops_set_global_filter(struct ftrace_ops *ops)
4281d032ae89SJoel Fernandes {
4282d032ae89SJoel Fernandes 	if (ops->flags & FTRACE_OPS_FL_INITIALIZED)
4283d032ae89SJoel Fernandes 		return;
4284d032ae89SJoel Fernandes 
4285d032ae89SJoel Fernandes 	ftrace_ops_init(ops);
4286d032ae89SJoel Fernandes 	ops->func_hash = &global_ops.local_hash;
4287d032ae89SJoel Fernandes }
4288d032ae89SJoel Fernandes EXPORT_SYMBOL_GPL(ftrace_ops_set_global_filter);
4289d032ae89SJoel Fernandes 
4290647664eaSMasami Hiramatsu static int
4291647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4292647664eaSMasami Hiramatsu 		 int reset, int enable)
4293647664eaSMasami Hiramatsu {
4294647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
4295647664eaSMasami Hiramatsu }
4296647664eaSMasami Hiramatsu 
429777a2b37dSSteven Rostedt /**
429877a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
4299936e074bSSteven Rostedt  * @ops - the ops to set the filter with
430077a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
430177a2b37dSSteven Rostedt  * @len - the length of the string.
430277a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
430377a2b37dSSteven Rostedt  *
430477a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
430577a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
430677a2b37dSSteven Rostedt  */
4307ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
4308936e074bSSteven Rostedt 		       int len, int reset)
430977a2b37dSSteven Rostedt {
4310f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4311ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
431241c52c0dSSteven Rostedt }
4313936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
43144eebcc81SSteven Rostedt 
431541c52c0dSSteven Rostedt /**
431641c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
4317936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
431841c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
431941c52c0dSSteven Rostedt  * @len - the length of the string.
432041c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
432141c52c0dSSteven Rostedt  *
432241c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
432341c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
432441c52c0dSSteven Rostedt  * for tracing.
432541c52c0dSSteven Rostedt  */
4326ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
4327936e074bSSteven Rostedt 			int len, int reset)
4328936e074bSSteven Rostedt {
4329f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4330ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
4331936e074bSSteven Rostedt }
4332936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
4333936e074bSSteven Rostedt /**
43348d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
4335936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
4336936e074bSSteven Rostedt  * @len - the length of the string.
4337936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4338936e074bSSteven Rostedt  *
4339936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
4340936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
4341936e074bSSteven Rostedt  */
4342936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
4343936e074bSSteven Rostedt {
4344936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
4345936e074bSSteven Rostedt }
4346936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
4347936e074bSSteven Rostedt 
4348936e074bSSteven Rostedt /**
43498d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
4350936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
4351936e074bSSteven Rostedt  * @len - the length of the string.
4352936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4353936e074bSSteven Rostedt  *
4354936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
4355936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
4356936e074bSSteven Rostedt  * for tracing.
4357936e074bSSteven Rostedt  */
4358936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
435941c52c0dSSteven Rostedt {
4360f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
436177a2b37dSSteven Rostedt }
4362936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
436377a2b37dSSteven Rostedt 
43642af15d6aSSteven Rostedt /*
43652af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
43662af15d6aSSteven Rostedt  */
43672af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
43682af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
43692af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
43702af15d6aSSteven Rostedt 
4371f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
4372f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
4373f1ed7c74SSteven Rostedt (Red Hat) 
43742af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
43752af15d6aSSteven Rostedt {
4376f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
437775761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
43782af15d6aSSteven Rostedt 	return 1;
43792af15d6aSSteven Rostedt }
43802af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
43812af15d6aSSteven Rostedt 
43822af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
43832af15d6aSSteven Rostedt {
4384f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
438575761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
43862af15d6aSSteven Rostedt 	return 1;
43872af15d6aSSteven Rostedt }
43882af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
43892af15d6aSSteven Rostedt 
4390369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4391f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
43920d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
4393faf982a6SNamhyung Kim static int ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer);
4394801c29fdSSteven Rostedt 
4395f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_trampoline;
4396f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_flags;
4397f3bea491SSteven Rostedt (Red Hat) 
4398369bc18fSStefan Assmann static int __init set_graph_function(char *str)
4399369bc18fSStefan Assmann {
440006f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
4401369bc18fSStefan Assmann 	return 1;
4402369bc18fSStefan Assmann }
4403369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
4404369bc18fSStefan Assmann 
44050d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
44060d7d9a16SNamhyung Kim {
44070d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
44080d7d9a16SNamhyung Kim 	return 1;
44090d7d9a16SNamhyung Kim }
44100d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
44110d7d9a16SNamhyung Kim 
44120d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
4413369bc18fSStefan Assmann {
4414369bc18fSStefan Assmann 	int ret;
4415369bc18fSStefan Assmann 	char *func;
44160d7d9a16SNamhyung Kim 	unsigned long *table = ftrace_graph_funcs;
44170d7d9a16SNamhyung Kim 	int *count = &ftrace_graph_count;
44180d7d9a16SNamhyung Kim 
44190d7d9a16SNamhyung Kim 	if (!enable) {
44200d7d9a16SNamhyung Kim 		table = ftrace_graph_notrace_funcs;
44210d7d9a16SNamhyung Kim 		count = &ftrace_graph_notrace_count;
44220d7d9a16SNamhyung Kim 	}
4423369bc18fSStefan Assmann 
4424369bc18fSStefan Assmann 	while (buf) {
4425369bc18fSStefan Assmann 		func = strsep(&buf, ",");
4426369bc18fSStefan Assmann 		/* we allow only one expression at a time */
44270d7d9a16SNamhyung Kim 		ret = ftrace_set_func(table, count, FTRACE_GRAPH_MAX_FUNCS, func);
4428369bc18fSStefan Assmann 		if (ret)
4429369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
4430369bc18fSStefan Assmann 					  "traceable\n", func);
4431369bc18fSStefan Assmann 	}
4432369bc18fSStefan Assmann }
4433369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4434369bc18fSStefan Assmann 
44352a85a37fSSteven Rostedt void __init
44362a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
44372af15d6aSSteven Rostedt {
44382af15d6aSSteven Rostedt 	char *func;
44392af15d6aSSteven Rostedt 
4440f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4441f04f24fbSMasami Hiramatsu 
44422af15d6aSSteven Rostedt 	while (buf) {
44432af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
4444f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
44452af15d6aSSteven Rostedt 	}
44462af15d6aSSteven Rostedt }
44472af15d6aSSteven Rostedt 
44482af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
44492af15d6aSSteven Rostedt {
44502af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
44512a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
44522af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
44532a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
4454369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4455369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
44560d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
44570d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
44580d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
4459369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
44602af15d6aSSteven Rostedt }
44612af15d6aSSteven Rostedt 
4462fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
44635072c59fSSteven Rostedt {
44645072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
44657485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
44665072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
446733dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
44683296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4469689fd8b6S[email protected] 	struct trace_parser *parser;
4470ed926f9bSSteven Rostedt 	int filter_hash;
447133dc9b12SSteven Rostedt 	int ret;
44725072c59fSSteven Rostedt 
44735072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
44745072c59fSSteven Rostedt 		iter = m->private;
44755072c59fSSteven Rostedt 		seq_release(inode, file);
44765072c59fSSteven Rostedt 	} else
44775072c59fSSteven Rostedt 		iter = file->private_data;
44785072c59fSSteven Rostedt 
4479689fd8b6S[email protected] 	parser = &iter->parser;
4480689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
4481689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
44821cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
44835072c59fSSteven Rostedt 	}
44845072c59fSSteven Rostedt 
4485058e297dSSteven Rostedt 	trace_parser_put(parser);
4486058e297dSSteven Rostedt 
448733b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
44883f2367baSMasami Hiramatsu 
4489058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4490ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
4491ed926f9bSSteven Rostedt 
4492ed926f9bSSteven Rostedt 		if (filter_hash)
449333b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
4494ed926f9bSSteven Rostedt 		else
449533b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
449633dc9b12SSteven Rostedt 
4497e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
44983296fc4eSSteven Rostedt (Red Hat) 		old_hash = *orig_hash;
44997485058eSSteven Rostedt (Red Hat) 		old_hash_ops.filter_hash = iter->ops->func_hash->filter_hash;
45007485058eSSteven Rostedt (Red Hat) 		old_hash_ops.notrace_hash = iter->ops->func_hash->notrace_hash;
450141fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
450241fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
45033296fc4eSSteven Rostedt (Red Hat) 		if (!ret) {
45047485058eSSteven Rostedt (Red Hat) 			ftrace_ops_update_code(iter->ops, &old_hash_ops);
45053296fc4eSSteven Rostedt (Red Hat) 			free_ftrace_hash_rcu(old_hash);
45063296fc4eSSteven Rostedt (Red Hat) 		}
4507e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
4508058e297dSSteven Rostedt 	}
45093f2367baSMasami Hiramatsu 
451033b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
451133dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
451233dc9b12SSteven Rostedt 	kfree(iter);
4513689fd8b6S[email protected] 
45145072c59fSSteven Rostedt 	return 0;
45155072c59fSSteven Rostedt }
45165072c59fSSteven Rostedt 
45175e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
45185072c59fSSteven Rostedt 	.open = ftrace_avail_open,
45195072c59fSSteven Rostedt 	.read = seq_read,
45205072c59fSSteven Rostedt 	.llseek = seq_lseek,
45213be04b47SLi Zefan 	.release = seq_release_private,
45225072c59fSSteven Rostedt };
45235072c59fSSteven Rostedt 
4524647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
4525647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
4526647bcd03SSteven Rostedt 	.read = seq_read,
4527647bcd03SSteven Rostedt 	.llseek = seq_lseek,
4528647bcd03SSteven Rostedt 	.release = seq_release_private,
4529647bcd03SSteven Rostedt };
4530647bcd03SSteven Rostedt 
45315e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
45325072c59fSSteven Rostedt 	.open = ftrace_filter_open,
4533850a80cfSLai Jiangshan 	.read = seq_read,
45345072c59fSSteven Rostedt 	.write = ftrace_filter_write,
4535098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
45361cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
45375072c59fSSteven Rostedt };
45385072c59fSSteven Rostedt 
45395e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
454041c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
4541850a80cfSLai Jiangshan 	.read = seq_read,
454241c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
4543098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
45441cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
454541c52c0dSSteven Rostedt };
454641c52c0dSSteven Rostedt 
4547ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4548ea4e2bc4SSteven Rostedt 
4549ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
4550ea4e2bc4SSteven Rostedt 
4551ea4e2bc4SSteven Rostedt int ftrace_graph_count;
455229ad23b0SNamhyung Kim int ftrace_graph_notrace_count;
4553ea4e2bc4SSteven Rostedt unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
455429ad23b0SNamhyung Kim unsigned long ftrace_graph_notrace_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
4555ea4e2bc4SSteven Rostedt 
4556faf982a6SNamhyung Kim struct ftrace_graph_data {
4557faf982a6SNamhyung Kim 	unsigned long *table;
4558faf982a6SNamhyung Kim 	size_t size;
4559faf982a6SNamhyung Kim 	int *count;
4560faf982a6SNamhyung Kim 	const struct seq_operations *seq_ops;
4561faf982a6SNamhyung Kim };
4562faf982a6SNamhyung Kim 
4563ea4e2bc4SSteven Rostedt static void *
456485951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
4565ea4e2bc4SSteven Rostedt {
4566faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4567faf982a6SNamhyung Kim 
4568faf982a6SNamhyung Kim 	if (*pos >= *fgd->count)
4569ea4e2bc4SSteven Rostedt 		return NULL;
4570faf982a6SNamhyung Kim 	return &fgd->table[*pos];
457185951842SLi Zefan }
4572ea4e2bc4SSteven Rostedt 
457385951842SLi Zefan static void *
457485951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
457585951842SLi Zefan {
457685951842SLi Zefan 	(*pos)++;
457785951842SLi Zefan 	return __g_next(m, pos);
4578ea4e2bc4SSteven Rostedt }
4579ea4e2bc4SSteven Rostedt 
4580ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
4581ea4e2bc4SSteven Rostedt {
4582faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4583faf982a6SNamhyung Kim 
4584ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4585ea4e2bc4SSteven Rostedt 
4586f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
4587faf982a6SNamhyung Kim 	if (!*fgd->count && !*pos)
4588f9349a8fSFrederic Weisbecker 		return (void *)1;
4589f9349a8fSFrederic Weisbecker 
459085951842SLi Zefan 	return __g_next(m, pos);
4591ea4e2bc4SSteven Rostedt }
4592ea4e2bc4SSteven Rostedt 
4593ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
4594ea4e2bc4SSteven Rostedt {
4595ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4596ea4e2bc4SSteven Rostedt }
4597ea4e2bc4SSteven Rostedt 
4598ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
4599ea4e2bc4SSteven Rostedt {
4600ea4e2bc4SSteven Rostedt 	unsigned long *ptr = v;
4601ea4e2bc4SSteven Rostedt 
4602ea4e2bc4SSteven Rostedt 	if (!ptr)
4603ea4e2bc4SSteven Rostedt 		return 0;
4604ea4e2bc4SSteven Rostedt 
4605f9349a8fSFrederic Weisbecker 	if (ptr == (unsigned long *)1) {
4606280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
4607280d1429SNamhyung Kim 
4608280d1429SNamhyung Kim 		if (fgd->table == ftrace_graph_funcs)
4609fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
4610280d1429SNamhyung Kim 		else
4611fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
4612f9349a8fSFrederic Weisbecker 		return 0;
4613f9349a8fSFrederic Weisbecker 	}
4614f9349a8fSFrederic Weisbecker 
4615b375a11aSSteven Rostedt 	seq_printf(m, "%ps\n", (void *)*ptr);
4616ea4e2bc4SSteven Rostedt 
4617ea4e2bc4SSteven Rostedt 	return 0;
4618ea4e2bc4SSteven Rostedt }
4619ea4e2bc4SSteven Rostedt 
462088e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
4621ea4e2bc4SSteven Rostedt 	.start = g_start,
4622ea4e2bc4SSteven Rostedt 	.next = g_next,
4623ea4e2bc4SSteven Rostedt 	.stop = g_stop,
4624ea4e2bc4SSteven Rostedt 	.show = g_show,
4625ea4e2bc4SSteven Rostedt };
4626ea4e2bc4SSteven Rostedt 
4627ea4e2bc4SSteven Rostedt static int
4628faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
4629faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
4630ea4e2bc4SSteven Rostedt {
4631ea4e2bc4SSteven Rostedt 	int ret = 0;
4632ea4e2bc4SSteven Rostedt 
4633ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4634ea4e2bc4SSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
46358650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC)) {
4636faf982a6SNamhyung Kim 		*fgd->count = 0;
4637faf982a6SNamhyung Kim 		memset(fgd->table, 0, fgd->size * sizeof(*fgd->table));
4638ea4e2bc4SSteven Rostedt 	}
4639ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4640ea4e2bc4SSteven Rostedt 
4641faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4642faf982a6SNamhyung Kim 		ret = seq_open(file, fgd->seq_ops);
4643faf982a6SNamhyung Kim 		if (!ret) {
4644faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
4645faf982a6SNamhyung Kim 			m->private = fgd;
4646faf982a6SNamhyung Kim 		}
4647faf982a6SNamhyung Kim 	} else
4648faf982a6SNamhyung Kim 		file->private_data = fgd;
4649a4ec5e0cSLi Zefan 
4650ea4e2bc4SSteven Rostedt 	return ret;
4651ea4e2bc4SSteven Rostedt }
4652ea4e2bc4SSteven Rostedt 
4653ea4e2bc4SSteven Rostedt static int
4654faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
4655faf982a6SNamhyung Kim {
4656faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
4657faf982a6SNamhyung Kim 
4658faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
4659faf982a6SNamhyung Kim 		return -ENODEV;
4660faf982a6SNamhyung Kim 
4661faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
4662faf982a6SNamhyung Kim 	if (fgd == NULL)
4663faf982a6SNamhyung Kim 		return -ENOMEM;
4664faf982a6SNamhyung Kim 
4665faf982a6SNamhyung Kim 	fgd->table = ftrace_graph_funcs;
4666faf982a6SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
4667faf982a6SNamhyung Kim 	fgd->count = &ftrace_graph_count;
4668faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
4669faf982a6SNamhyung Kim 
4670faf982a6SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
4671faf982a6SNamhyung Kim }
4672faf982a6SNamhyung Kim 
4673faf982a6SNamhyung Kim static int
467429ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
467529ad23b0SNamhyung Kim {
467629ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
467729ad23b0SNamhyung Kim 
467829ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
467929ad23b0SNamhyung Kim 		return -ENODEV;
468029ad23b0SNamhyung Kim 
468129ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
468229ad23b0SNamhyung Kim 	if (fgd == NULL)
468329ad23b0SNamhyung Kim 		return -ENOMEM;
468429ad23b0SNamhyung Kim 
468529ad23b0SNamhyung Kim 	fgd->table = ftrace_graph_notrace_funcs;
468629ad23b0SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
468729ad23b0SNamhyung Kim 	fgd->count = &ftrace_graph_notrace_count;
468829ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
468929ad23b0SNamhyung Kim 
469029ad23b0SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
469129ad23b0SNamhyung Kim }
469229ad23b0SNamhyung Kim 
469329ad23b0SNamhyung Kim static int
469487827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
469587827111SLi Zefan {
4696faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4697faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
4698faf982a6SNamhyung Kim 
4699faf982a6SNamhyung Kim 		kfree(m->private);
470087827111SLi Zefan 		seq_release(inode, file);
4701faf982a6SNamhyung Kim 	} else {
4702faf982a6SNamhyung Kim 		kfree(file->private_data);
4703faf982a6SNamhyung Kim 	}
4704faf982a6SNamhyung Kim 
470587827111SLi Zefan 	return 0;
470687827111SLi Zefan }
470787827111SLi Zefan 
470887827111SLi Zefan static int
4709faf982a6SNamhyung Kim ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer)
4710ea4e2bc4SSteven Rostedt {
47113ba00929SDmitry Safonov 	struct ftrace_glob func_g;
4712ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
4713ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
4714c7c6b1feSLi Zefan 	int fail = 1;
47153ba00929SDmitry Safonov 	int not;
4716f9349a8fSFrederic Weisbecker 	bool exists;
4717f9349a8fSFrederic Weisbecker 	int i;
4718ea4e2bc4SSteven Rostedt 
4719f9349a8fSFrederic Weisbecker 	/* decode regex */
47203ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
47213ba00929SDmitry Safonov 					 &func_g.search, &not);
4722faf982a6SNamhyung Kim 	if (!not && *idx >= size)
4723c7c6b1feSLi Zefan 		return -EBUSY;
4724f9349a8fSFrederic Weisbecker 
47253ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
4726f9349a8fSFrederic Weisbecker 
472752baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
472845a4a237SSteven Rostedt 
472945a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
473045a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
473145a4a237SSteven Rostedt 		return -ENODEV;
473245a4a237SSteven Rostedt 	}
473345a4a237SSteven Rostedt 
4734265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4735ea4e2bc4SSteven Rostedt 
4736546fece4SSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
4737546fece4SSteven Rostedt (Red Hat) 			continue;
4738546fece4SSteven Rostedt (Red Hat) 
47390b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
4740c7c6b1feSLi Zefan 			/* if it is in the array */
4741f9349a8fSFrederic Weisbecker 			exists = false;
4742c7c6b1feSLi Zefan 			for (i = 0; i < *idx; i++) {
4743f9349a8fSFrederic Weisbecker 				if (array[i] == rec->ip) {
4744f9349a8fSFrederic Weisbecker 					exists = true;
4745faec2ec5SLiming Wang 					break;
4746faec2ec5SLiming Wang 				}
4747c7c6b1feSLi Zefan 			}
4748c7c6b1feSLi Zefan 
4749c7c6b1feSLi Zefan 			if (!not) {
4750c7c6b1feSLi Zefan 				fail = 0;
4751c7c6b1feSLi Zefan 				if (!exists) {
4752f9349a8fSFrederic Weisbecker 					array[(*idx)++] = rec->ip;
4753faf982a6SNamhyung Kim 					if (*idx >= size)
4754c7c6b1feSLi Zefan 						goto out;
4755c7c6b1feSLi Zefan 				}
4756c7c6b1feSLi Zefan 			} else {
4757c7c6b1feSLi Zefan 				if (exists) {
4758c7c6b1feSLi Zefan 					array[i] = array[--(*idx)];
4759c7c6b1feSLi Zefan 					array[*idx] = 0;
4760c7c6b1feSLi Zefan 					fail = 0;
4761c7c6b1feSLi Zefan 				}
4762c7c6b1feSLi Zefan 			}
4763f9349a8fSFrederic Weisbecker 		}
4764265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4765c7c6b1feSLi Zefan out:
476652baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4767ea4e2bc4SSteven Rostedt 
4768c7c6b1feSLi Zefan 	if (fail)
4769c7c6b1feSLi Zefan 		return -EINVAL;
4770c7c6b1feSLi Zefan 
4771c7c6b1feSLi Zefan 	return 0;
4772ea4e2bc4SSteven Rostedt }
4773ea4e2bc4SSteven Rostedt 
4774ea4e2bc4SSteven Rostedt static ssize_t
4775ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
4776ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4777ea4e2bc4SSteven Rostedt {
4778689fd8b6S[email protected] 	struct trace_parser parser;
47796a10108bSNamhyung Kim 	ssize_t read, ret = 0;
4780faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
4781ea4e2bc4SSteven Rostedt 
4782c7c6b1feSLi Zefan 	if (!cnt)
4783ea4e2bc4SSteven Rostedt 		return 0;
4784ea4e2bc4SSteven Rostedt 
47856a10108bSNamhyung Kim 	if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX))
47866a10108bSNamhyung Kim 		return -ENOMEM;
4787ea4e2bc4SSteven Rostedt 
4788689fd8b6S[email protected] 	read = trace_get_user(&parser, ubuf, cnt, ppos);
4789689fd8b6S[email protected] 
47904ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded((&parser))) {
4791689fd8b6S[email protected] 		parser.buffer[parser.idx] = 0;
4792ea4e2bc4SSteven Rostedt 
47936a10108bSNamhyung Kim 		mutex_lock(&graph_lock);
47946a10108bSNamhyung Kim 
4795f9349a8fSFrederic Weisbecker 		/* we allow only one expression at a time */
4796faf982a6SNamhyung Kim 		ret = ftrace_set_func(fgd->table, fgd->count, fgd->size,
4797689fd8b6S[email protected] 				      parser.buffer);
47986a10108bSNamhyung Kim 
47996a10108bSNamhyung Kim 		mutex_unlock(&graph_lock);
4800689fd8b6S[email protected] 	}
4801ea4e2bc4SSteven Rostedt 
48026a10108bSNamhyung Kim 	if (!ret)
4803ea4e2bc4SSteven Rostedt 		ret = read;
48041eb90f13SLi Zefan 
4805689fd8b6S[email protected] 	trace_parser_put(&parser);
4806ea4e2bc4SSteven Rostedt 
4807ea4e2bc4SSteven Rostedt 	return ret;
4808ea4e2bc4SSteven Rostedt }
4809ea4e2bc4SSteven Rostedt 
4810ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
4811ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
4812850a80cfSLai Jiangshan 	.read		= seq_read,
4813ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
4814098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
481587827111SLi Zefan 	.release	= ftrace_graph_release,
4816ea4e2bc4SSteven Rostedt };
481729ad23b0SNamhyung Kim 
481829ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
481929ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
482029ad23b0SNamhyung Kim 	.read		= seq_read,
482129ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
4822098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
482329ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
482429ad23b0SNamhyung Kim };
4825ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4826ea4e2bc4SSteven Rostedt 
4827591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
4828591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
4829591dffdaSSteven Rostedt (Red Hat) {
4830591dffdaSSteven Rostedt (Red Hat) 
4831591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_filter", 0644, parent,
4832591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
4833591dffdaSSteven Rostedt (Red Hat) 
4834591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_notrace", 0644, parent,
4835591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
4836591dffdaSSteven Rostedt (Red Hat) }
4837591dffdaSSteven Rostedt (Red Hat) 
4838591dffdaSSteven Rostedt (Red Hat) /*
4839591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
4840591dffdaSSteven Rostedt (Red Hat)  * in the future, it may actualy delete the files, but this is
4841591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
4842591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
4843591dffdaSSteven Rostedt (Red Hat)  * free the ops.
4844591dffdaSSteven Rostedt (Red Hat)  *
4845591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
4846591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
4847591dffdaSSteven Rostedt (Red Hat)  */
4848591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
4849591dffdaSSteven Rostedt (Red Hat) {
4850591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
4851591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
4852591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
4853591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
4854591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
4855591dffdaSSteven Rostedt (Red Hat) }
4856591dffdaSSteven Rostedt (Red Hat) 
48578434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
48585072c59fSSteven Rostedt {
48595072c59fSSteven Rostedt 
48605452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
48615072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
48625072c59fSSteven Rostedt 
4863647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
4864647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
4865647bcd03SSteven Rostedt 
4866591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
4867ad90c0e3SSteven Rostedt 
4868ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
48695452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
4870ea4e2bc4SSteven Rostedt 				    NULL,
4871ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
487229ad23b0SNamhyung Kim 	trace_create_file("set_graph_notrace", 0444, d_tracer,
487329ad23b0SNamhyung Kim 				    NULL,
487429ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
4875ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4876ea4e2bc4SSteven Rostedt 
48775072c59fSSteven Rostedt 	return 0;
48785072c59fSSteven Rostedt }
48795072c59fSSteven Rostedt 
48809fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
488168950619SSteven Rostedt {
48829fd49328SSteven Rostedt 	const unsigned long *ipa = a;
48839fd49328SSteven Rostedt 	const unsigned long *ipb = b;
488468950619SSteven Rostedt 
48859fd49328SSteven Rostedt 	if (*ipa > *ipb)
48869fd49328SSteven Rostedt 		return 1;
48879fd49328SSteven Rostedt 	if (*ipa < *ipb)
48889fd49328SSteven Rostedt 		return -1;
48899fd49328SSteven Rostedt 	return 0;
48909fd49328SSteven Rostedt }
48919fd49328SSteven Rostedt 
48925cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
489331e88909SSteven Rostedt 			       unsigned long *start,
489468bf21aaSSteven Rostedt 			       unsigned long *end)
489568bf21aaSSteven Rostedt {
4896706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
4897a7900875SSteven Rostedt 	struct ftrace_page *pg;
4898706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
4899a7900875SSteven Rostedt 	unsigned long count;
490068bf21aaSSteven Rostedt 	unsigned long *p;
490168bf21aaSSteven Rostedt 	unsigned long addr;
49024376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
4903a7900875SSteven Rostedt 	int ret = -ENOMEM;
4904a7900875SSteven Rostedt 
4905a7900875SSteven Rostedt 	count = end - start;
4906a7900875SSteven Rostedt 
4907a7900875SSteven Rostedt 	if (!count)
4908a7900875SSteven Rostedt 		return 0;
4909a7900875SSteven Rostedt 
49109fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
49116db02903SRasmus Villemoes 	     ftrace_cmp_ips, NULL);
49129fd49328SSteven Rostedt 
4913706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
4914706c81f8SSteven Rostedt 	if (!start_pg)
4915a7900875SSteven Rostedt 		return -ENOMEM;
491668bf21aaSSteven Rostedt 
4917e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4918a7900875SSteven Rostedt 
491932082309SSteven Rostedt 	/*
492032082309SSteven Rostedt 	 * Core and each module needs their own pages, as
492132082309SSteven Rostedt 	 * modules will free them when they are removed.
492232082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
492332082309SSteven Rostedt 	 */
4924a7900875SSteven Rostedt 	if (!mod) {
4925a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
4926a7900875SSteven Rostedt 		/* First initialization */
4927706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
4928a7900875SSteven Rostedt 	} else {
492932082309SSteven Rostedt 		if (!ftrace_pages)
4930a7900875SSteven Rostedt 			goto out;
493132082309SSteven Rostedt 
4932a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
4933a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
4934a7900875SSteven Rostedt 			while (ftrace_pages->next)
493532082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
493632082309SSteven Rostedt 		}
4937a7900875SSteven Rostedt 
4938706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
493932082309SSteven Rostedt 	}
494032082309SSteven Rostedt 
494168bf21aaSSteven Rostedt 	p = start;
4942706c81f8SSteven Rostedt 	pg = start_pg;
494368bf21aaSSteven Rostedt 	while (p < end) {
494468bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
494520e5227eSSteven Rostedt 		/*
494620e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
494720e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
494820e5227eSSteven Rostedt 		 * object files to satisfy alignments.
494920e5227eSSteven Rostedt 		 * Skip any NULL pointers.
495020e5227eSSteven Rostedt 		 */
495120e5227eSSteven Rostedt 		if (!addr)
495220e5227eSSteven Rostedt 			continue;
4953706c81f8SSteven Rostedt 
4954706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
4955706c81f8SSteven Rostedt 			/* We should have allocated enough */
4956706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
4957a7900875SSteven Rostedt 				break;
4958706c81f8SSteven Rostedt 			pg = pg->next;
495968bf21aaSSteven Rostedt 		}
496068bf21aaSSteven Rostedt 
4961706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
4962706c81f8SSteven Rostedt 		rec->ip = addr;
4963706c81f8SSteven Rostedt 	}
4964706c81f8SSteven Rostedt 
4965706c81f8SSteven Rostedt 	/* We should have used all pages */
4966706c81f8SSteven Rostedt 	WARN_ON(pg->next);
4967706c81f8SSteven Rostedt 
4968706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
4969706c81f8SSteven Rostedt 	ftrace_pages = pg;
4970706c81f8SSteven Rostedt 
4971a4f18ed1SSteven Rostedt 	/*
49724376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
49734376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
49744376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
49754376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
49764376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
49774376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
4978a4f18ed1SSteven Rostedt 	 */
49794376cac6SSteven Rostedt 	if (!mod)
4980a4f18ed1SSteven Rostedt 		local_irq_save(flags);
49811dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
49824376cac6SSteven Rostedt 	if (!mod)
4983a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
4984a7900875SSteven Rostedt 	ret = 0;
4985a7900875SSteven Rostedt  out:
4986e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
498768bf21aaSSteven Rostedt 
4988a7900875SSteven Rostedt 	return ret;
498968bf21aaSSteven Rostedt }
499068bf21aaSSteven Rostedt 
499193eb677dSSteven Rostedt #ifdef CONFIG_MODULES
499232082309SSteven Rostedt 
499332082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
499432082309SSteven Rostedt 
4995b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
4996b7ffffbbSSteven Rostedt (Red Hat) {
4997b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
4998b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
4999b7ffffbbSSteven Rostedt (Red Hat) 
5000b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
5001b7ffffbbSSteven Rostedt (Red Hat) 		if (ops_references_rec(ops, rec))
5002b7ffffbbSSteven Rostedt (Red Hat) 		    cnt++;
5003b7ffffbbSSteven Rostedt (Red Hat) 	}
5004b7ffffbbSSteven Rostedt (Red Hat) 
5005b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
5006b7ffffbbSSteven Rostedt (Red Hat) }
5007b7ffffbbSSteven Rostedt (Red Hat) 
5008e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
500993eb677dSSteven Rostedt {
501093eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
501132082309SSteven Rostedt 	struct ftrace_page **last_pg;
501293eb677dSSteven Rostedt 	struct ftrace_page *pg;
5013a7900875SSteven Rostedt 	int order;
501493eb677dSSteven Rostedt 
501593eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
501645a4a237SSteven Rostedt 
501745a4a237SSteven Rostedt 	if (ftrace_disabled)
501845a4a237SSteven Rostedt 		goto out_unlock;
501945a4a237SSteven Rostedt 
502032082309SSteven Rostedt 	/*
502132082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
502232082309SSteven Rostedt 	 * them from the list.
502332082309SSteven Rostedt 	 */
502432082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
502532082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
502632082309SSteven Rostedt 		rec = &pg->records[0];
5027e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
502893eb677dSSteven Rostedt 			/*
502932082309SSteven Rostedt 			 * As core pages are first, the first
503032082309SSteven Rostedt 			 * page should never be a module page.
503193eb677dSSteven Rostedt 			 */
503232082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
503332082309SSteven Rostedt 				goto out_unlock;
503432082309SSteven Rostedt 
503532082309SSteven Rostedt 			/* Check if we are deleting the last page */
503632082309SSteven Rostedt 			if (pg == ftrace_pages)
503732082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
503832082309SSteven Rostedt 
503932082309SSteven Rostedt 			*last_pg = pg->next;
5040a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
5041a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
5042a7900875SSteven Rostedt 			kfree(pg);
504332082309SSteven Rostedt 		} else
504432082309SSteven Rostedt 			last_pg = &pg->next;
504593eb677dSSteven Rostedt 	}
504645a4a237SSteven Rostedt  out_unlock:
504793eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
504893eb677dSSteven Rostedt }
504993eb677dSSteven Rostedt 
50507dcd182bSJessica Yu void ftrace_module_enable(struct module *mod)
5051b7ffffbbSSteven Rostedt (Red Hat) {
5052b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
5053b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
5054b7ffffbbSSteven Rostedt (Red Hat) 
5055b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5056b7ffffbbSSteven Rostedt (Red Hat) 
5057b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
5058b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
5059b7ffffbbSSteven Rostedt (Red Hat) 
5060b7ffffbbSSteven Rostedt (Red Hat) 	/*
5061b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
5062b7ffffbbSSteven Rostedt (Red Hat) 	 *
5063b7ffffbbSSteven Rostedt (Red Hat) 	 * The reason not to enable the record immediatelly is the
5064b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
5065b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
5066b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
5067b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
5068b7ffffbbSSteven Rostedt (Red Hat) 	 *
5069b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
5070b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
5071b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
5072b7ffffbbSSteven Rostedt (Red Hat) 	 */
5073b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5074b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
5075b7ffffbbSSteven Rostedt (Red Hat) 
5076b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
5077b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
5078b7ffffbbSSteven Rostedt (Red Hat) 		/*
5079b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
5080b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
5081b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
5082b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
5083b7ffffbbSSteven Rostedt (Red Hat) 		 */
5084b7ffffbbSSteven Rostedt (Red Hat) 		if (!within_module_core(rec->ip, mod))
5085b7ffffbbSSteven Rostedt (Red Hat) 			break;
5086b7ffffbbSSteven Rostedt (Red Hat) 
5087b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
5088b7ffffbbSSteven Rostedt (Red Hat) 
5089b7ffffbbSSteven Rostedt (Red Hat) 		/*
5090b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
5091b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
5092b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
5093b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
5094b7ffffbbSSteven Rostedt (Red Hat) 		 */
5095b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
5096b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
5097b7ffffbbSSteven Rostedt (Red Hat) 
5098b7ffffbbSSteven Rostedt (Red Hat) 		/* This clears FTRACE_FL_DISABLED */
5099b7ffffbbSSteven Rostedt (Red Hat) 		rec->flags = cnt;
5100b7ffffbbSSteven Rostedt (Red Hat) 
5101b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
5102b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
5103b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
5104b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
5105b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
5106b7ffffbbSSteven Rostedt (Red Hat) 			}
5107b7ffffbbSSteven Rostedt (Red Hat) 		}
5108b7ffffbbSSteven Rostedt (Red Hat) 
5109b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
5110b7ffffbbSSteven Rostedt (Red Hat) 
5111b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
5112b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5113b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
5114b7ffffbbSSteven Rostedt (Red Hat) 
5115b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
5116b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5117b7ffffbbSSteven Rostedt (Red Hat) }
5118b7ffffbbSSteven Rostedt (Red Hat) 
5119a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
512093eb677dSSteven Rostedt {
512197e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
5122b6b71f66SAbel Vesa 		return;
5123b6b71f66SAbel Vesa 
512497e9b4fcSSteven Rostedt (Red Hat) 	ftrace_process_locs(mod, mod->ftrace_callsites,
512597e9b4fcSSteven Rostedt (Red Hat) 			    mod->ftrace_callsites + mod->num_ftrace_callsites);
512693eb677dSSteven Rostedt }
512793eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
512893eb677dSSteven Rostedt 
512968bf21aaSSteven Rostedt void __init ftrace_init(void)
513068bf21aaSSteven Rostedt {
51311dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
51321dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
51333a36cb11SJiri Slaby 	unsigned long count, flags;
513468bf21aaSSteven Rostedt 	int ret;
513568bf21aaSSteven Rostedt 
513668bf21aaSSteven Rostedt 	local_irq_save(flags);
51373a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
513868bf21aaSSteven Rostedt 	local_irq_restore(flags);
5139af64a7cbSJiri Slaby 	if (ret)
514068bf21aaSSteven Rostedt 		goto failed;
514168bf21aaSSteven Rostedt 
514268bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
5143c867ccd8SJiri Slaby 	if (!count) {
5144c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
514568bf21aaSSteven Rostedt 		goto failed;
5146c867ccd8SJiri Slaby 	}
5147c867ccd8SJiri Slaby 
5148c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
5149c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
515068bf21aaSSteven Rostedt 
515168bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
515268bf21aaSSteven Rostedt 
51535cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
515431e88909SSteven Rostedt 				  __start_mcount_loc,
515568bf21aaSSteven Rostedt 				  __stop_mcount_loc);
515668bf21aaSSteven Rostedt 
51572af15d6aSSteven Rostedt 	set_ftrace_early_filters();
51582af15d6aSSteven Rostedt 
515968bf21aaSSteven Rostedt 	return;
516068bf21aaSSteven Rostedt  failed:
516168bf21aaSSteven Rostedt 	ftrace_disabled = 1;
516268bf21aaSSteven Rostedt }
516368bf21aaSSteven Rostedt 
5164f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
5165f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
5166f3bea491SSteven Rostedt (Red Hat) {
5167f3bea491SSteven Rostedt (Red Hat) }
5168f3bea491SSteven Rostedt (Red Hat) 
5169f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5170f3bea491SSteven Rostedt (Red Hat) {
517112cce594SSteven Rostedt (Red Hat) 
517212cce594SSteven Rostedt (Red Hat) /*
517312cce594SSteven Rostedt (Red Hat)  * Currently there's no safe way to free a trampoline when the kernel
517412cce594SSteven Rostedt (Red Hat)  * is configured with PREEMPT. That is because a task could be preempted
517512cce594SSteven Rostedt (Red Hat)  * when it jumped to the trampoline, it may be preempted for a long time
517612cce594SSteven Rostedt (Red Hat)  * depending on the system load, and currently there's no way to know
517712cce594SSteven Rostedt (Red Hat)  * when it will be off the trampoline. If the trampoline is freed
517812cce594SSteven Rostedt (Red Hat)  * too early, when the task runs again, it will be executing on freed
517912cce594SSteven Rostedt (Red Hat)  * memory and crash.
518012cce594SSteven Rostedt (Red Hat)  */
518112cce594SSteven Rostedt (Red Hat) #ifdef CONFIG_PREEMPT
5182f3bea491SSteven Rostedt (Red Hat) 	/* Currently, only non dynamic ops can have a trampoline */
5183f3bea491SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
5184f3bea491SSteven Rostedt (Red Hat) 		return;
518512cce594SSteven Rostedt (Red Hat) #endif
5186f3bea491SSteven Rostedt (Red Hat) 
5187f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
5188f3bea491SSteven Rostedt (Red Hat) }
5189f3bea491SSteven Rostedt (Red Hat) 
51903d083395SSteven Rostedt #else
51910b6e4d56SFrederic Weisbecker 
51922b499381SSteven Rostedt static struct ftrace_ops global_ops = {
5193bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
5194e3eea140SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
5195e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_INITIALIZED |
5196e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
5197bd69c30bSSteven Rostedt };
5198bd69c30bSSteven Rostedt 
51990b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
52000b6e4d56SFrederic Weisbecker {
52010b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
52020b6e4d56SFrederic Weisbecker 	return 0;
52030b6e4d56SFrederic Weisbecker }
52046f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
52050b6e4d56SFrederic Weisbecker 
52068434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
5207df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
5208e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
52095a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
52103b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)					\
52113b6cfdb1SSteven Rostedt 	({								\
52128a56d776SSteven Rostedt (Red Hat) 		int ___ret = __register_ftrace_function(ops);		\
52138a56d776SSteven Rostedt (Red Hat) 		if (!___ret)						\
52143b6cfdb1SSteven Rostedt 			(ops)->flags |= FTRACE_OPS_FL_ENABLED;		\
52158a56d776SSteven Rostedt (Red Hat) 		___ret;							\
52163b6cfdb1SSteven Rostedt 	})
52171fcc1553SSteven Rostedt (Red Hat) # define ftrace_shutdown(ops, command)					\
52181fcc1553SSteven Rostedt (Red Hat) 	({								\
52191fcc1553SSteven Rostedt (Red Hat) 		int ___ret = __unregister_ftrace_function(ops);		\
52201fcc1553SSteven Rostedt (Red Hat) 		if (!___ret)						\
52211fcc1553SSteven Rostedt (Red Hat) 			(ops)->flags &= ~FTRACE_OPS_FL_ENABLED;		\
52221fcc1553SSteven Rostedt (Red Hat) 		___ret;							\
52231fcc1553SSteven Rostedt (Red Hat) 	})
52248a56d776SSteven Rostedt (Red Hat) 
5225b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
5226b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
5227b848914cSSteven Rostedt 
5228b848914cSSteven Rostedt static inline int
5229195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
5230b848914cSSteven Rostedt {
5231b848914cSSteven Rostedt 	return 1;
5232b848914cSSteven Rostedt }
5233b848914cSSteven Rostedt 
5234f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5235f3bea491SSteven Rostedt (Red Hat) {
5236f3bea491SSteven Rostedt (Red Hat) }
5237f3bea491SSteven Rostedt (Red Hat) 
52383d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
52393d083395SSteven Rostedt 
52404104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
52414104d326SSteven Rostedt (Red Hat) {
52424104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
52434104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
52444104d326SSteven Rostedt (Red Hat) }
52454104d326SSteven Rostedt (Red Hat) 
52464104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
52474104d326SSteven Rostedt (Red Hat) {
52484104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
52494104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
52504104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
52514104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
52524104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
52534104d326SSteven Rostedt (Red Hat) 	}
52544104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
52554104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
52564104d326SSteven Rostedt (Red Hat) }
52574104d326SSteven Rostedt (Red Hat) 
52584104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
52594104d326SSteven Rostedt (Red Hat) {
52604104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
52614104d326SSteven Rostedt (Red Hat) }
52624104d326SSteven Rostedt (Red Hat) 
52632f5f6ad9SSteven Rostedt static inline void
52642f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5265a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
5266b848914cSSteven Rostedt {
5267cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
5268edc15cafSSteven Rostedt 	int bit;
5269b848914cSSteven Rostedt 
5270edc15cafSSteven Rostedt 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5271edc15cafSSteven Rostedt 	if (bit < 0)
5272b1cff0adSSteven Rostedt 		return;
5273b1cff0adSSteven Rostedt 
5274cdbe61bfSSteven Rostedt 	/*
5275cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
5276cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
5277cdbe61bfSSteven Rostedt 	 */
5278cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
5279ba27f2bcSSteven Rostedt (Red Hat) 
52800a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
5281ba27f2bcSSteven Rostedt (Red Hat) 		/*
5282ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
5283ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
5284ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
5285ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
5286ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
5287ba27f2bcSSteven Rostedt (Red Hat) 		 *
5288ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
5289ba27f2bcSSteven Rostedt (Red Hat) 		 */
5290ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
5291ba27f2bcSSteven Rostedt (Red Hat) 		    (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5292ba27f2bcSSteven Rostedt (Red Hat) 		     !ftrace_function_local_disabled(op)) &&
5293ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
5294ba27f2bcSSteven Rostedt (Red Hat) 
52951d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
52961d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
52974104d326SSteven Rostedt (Red Hat) 				goto out;
52984104d326SSteven Rostedt (Red Hat) 			}
5299a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
53004104d326SSteven Rostedt (Red Hat) 		}
53010a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
53024104d326SSteven Rostedt (Red Hat) out:
5303cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
5304edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
5305b848914cSSteven Rostedt }
5306b848914cSSteven Rostedt 
53072f5f6ad9SSteven Rostedt /*
53082f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
53092f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
53102f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
53112f5f6ad9SSteven Rostedt  * sending a third parameter.
5312a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
5313a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
5314a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
531506aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
531606aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
5317a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
5318b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
53192f5f6ad9SSteven Rostedt  */
53202f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
53212f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5322a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
53232f5f6ad9SSteven Rostedt {
5324a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
53252f5f6ad9SSteven Rostedt }
53262f5f6ad9SSteven Rostedt #else
53272f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
53282f5f6ad9SSteven Rostedt {
5329a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
53302f5f6ad9SSteven Rostedt }
53312f5f6ad9SSteven Rostedt #endif
53322f5f6ad9SSteven Rostedt 
5333f1ff6348SSteven Rostedt (Red Hat) /*
5334f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
5335c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
5336c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
5337f1ff6348SSteven Rostedt (Red Hat)  */
5338c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
5339f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs)
5340f1ff6348SSteven Rostedt (Red Hat) {
5341f1ff6348SSteven Rostedt (Red Hat) 	int bit;
5342f1ff6348SSteven Rostedt (Red Hat) 
5343c68c0fa2SSteven Rostedt (Red Hat) 	if ((op->flags & FTRACE_OPS_FL_RCU) && !rcu_is_watching())
5344c68c0fa2SSteven Rostedt (Red Hat) 		return;
5345c68c0fa2SSteven Rostedt (Red Hat) 
5346f1ff6348SSteven Rostedt (Red Hat) 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5347f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
5348f1ff6348SSteven Rostedt (Red Hat) 		return;
5349f1ff6348SSteven Rostedt (Red Hat) 
5350c68c0fa2SSteven Rostedt (Red Hat) 	preempt_disable_notrace();
5351f1ff6348SSteven Rostedt (Red Hat) 
5352c68c0fa2SSteven Rostedt (Red Hat) 	if (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5353c68c0fa2SSteven Rostedt (Red Hat) 	    !ftrace_function_local_disabled(op)) {
5354c68c0fa2SSteven Rostedt (Red Hat) 		op->func(ip, parent_ip, op, regs);
5355c68c0fa2SSteven Rostedt (Red Hat) 	}
5356c68c0fa2SSteven Rostedt (Red Hat) 
5357c68c0fa2SSteven Rostedt (Red Hat) 	preempt_enable_notrace();
5358f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
5359f1ff6348SSteven Rostedt (Red Hat) }
5360f1ff6348SSteven Rostedt (Red Hat) 
536187354059SSteven Rostedt (Red Hat) /**
536287354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
536387354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
536487354059SSteven Rostedt (Red Hat)  *
536587354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
536687354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
536787354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
536887354059SSteven Rostedt (Red Hat)  * ftrace_ops_recurs_func() instead.
536987354059SSteven Rostedt (Red Hat)  *
537087354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
537187354059SSteven Rostedt (Red Hat)  */
537287354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
537387354059SSteven Rostedt (Red Hat) {
537487354059SSteven Rostedt (Red Hat) 	/*
5375c68c0fa2SSteven Rostedt (Red Hat) 	 * If the function does not handle recursion, needs to be RCU safe,
5376c68c0fa2SSteven Rostedt (Red Hat) 	 * or does per cpu logic, then we need to call the assist handler.
537787354059SSteven Rostedt (Red Hat) 	 */
5378c68c0fa2SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_RECURSION_SAFE) ||
5379c68c0fa2SSteven Rostedt (Red Hat) 	    ops->flags & (FTRACE_OPS_FL_RCU | FTRACE_OPS_FL_PER_CPU))
5380c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
538187354059SSteven Rostedt (Red Hat) 
538287354059SSteven Rostedt (Red Hat) 	return ops->func;
538387354059SSteven Rostedt (Red Hat) }
538487354059SSteven Rostedt (Red Hat) 
5385345ddcc8SSteven Rostedt (Red Hat) static void
5386345ddcc8SSteven Rostedt (Red Hat) ftrace_filter_pid_sched_switch_probe(void *data, bool preempt,
5387345ddcc8SSteven Rostedt (Red Hat) 		    struct task_struct *prev, struct task_struct *next)
5388e32d8956SSteven Rostedt {
5389345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
5390345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5391345ddcc8SSteven Rostedt (Red Hat) 
5392345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
5393345ddcc8SSteven Rostedt (Red Hat) 
5394345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
5395345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, next));
5396345ddcc8SSteven Rostedt (Red Hat) }
5397345ddcc8SSteven Rostedt (Red Hat) 
5398345ddcc8SSteven Rostedt (Red Hat) static void clear_ftrace_pids(struct trace_array *tr)
5399345ddcc8SSteven Rostedt (Red Hat) {
5400345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5401e32d8956SSteven Rostedt 	int cpu;
5402e32d8956SSteven Rostedt 
5403345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
5404345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
5405345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
5406345ddcc8SSteven Rostedt (Red Hat) 		return;
5407345ddcc8SSteven Rostedt (Red Hat) 
5408345ddcc8SSteven Rostedt (Red Hat) 	unregister_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
5409345ddcc8SSteven Rostedt (Red Hat) 
5410345ddcc8SSteven Rostedt (Red Hat) 	for_each_possible_cpu(cpu)
5411345ddcc8SSteven Rostedt (Red Hat) 		per_cpu_ptr(tr->trace_buffer.data, cpu)->ftrace_ignore_pid = false;
5412345ddcc8SSteven Rostedt (Red Hat) 
5413345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, NULL);
5414345ddcc8SSteven Rostedt (Red Hat) 
5415345ddcc8SSteven Rostedt (Red Hat) 	/* Wait till all users are no longer using pid filtering */
5416345ddcc8SSteven Rostedt (Red Hat) 	synchronize_sched();
5417345ddcc8SSteven Rostedt (Red Hat) 
5418345ddcc8SSteven Rostedt (Red Hat) 	trace_free_pid_list(pid_list);
5419e32d8956SSteven Rostedt }
5420e32d8956SSteven Rostedt 
5421345ddcc8SSteven Rostedt (Red Hat) static void ftrace_pid_reset(struct trace_array *tr)
5422e32d8956SSteven Rostedt {
5423756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5424345ddcc8SSteven Rostedt (Red Hat) 	clear_ftrace_pids(tr);
5425756d17eeS[email protected] 
5426756d17eeS[email protected] 	ftrace_update_pid_func();
5427e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5428756d17eeS[email protected] 
5429756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5430756d17eeS[email protected] }
5431756d17eeS[email protected] 
5432345ddcc8SSteven Rostedt (Red Hat) /* Greater than any max PID */
5433345ddcc8SSteven Rostedt (Red Hat) #define FTRACE_NO_PIDS		(void *)(PID_MAX_LIMIT + 1)
5434345ddcc8SSteven Rostedt (Red Hat) 
5435756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
5436345ddcc8SSteven Rostedt (Red Hat) 	__acquires(RCU)
5437756d17eeS[email protected] {
5438345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5439345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5440345ddcc8SSteven Rostedt (Red Hat) 
5441756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5442345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_lock_sched();
5443756d17eeS[email protected] 
5444345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_sched(tr->function_pids);
5445756d17eeS[email protected] 
5446345ddcc8SSteven Rostedt (Red Hat) 	if (!pid_list)
5447345ddcc8SSteven Rostedt (Red Hat) 		return !(*pos) ? FTRACE_NO_PIDS : NULL;
5448345ddcc8SSteven Rostedt (Red Hat) 
5449345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_start(pid_list, pos);
5450756d17eeS[email protected] }
5451756d17eeS[email protected] 
5452756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
5453756d17eeS[email protected] {
5454345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5455345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list = rcu_dereference_sched(tr->function_pids);
5456345ddcc8SSteven Rostedt (Red Hat) 
5457345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS)
5458756d17eeS[email protected] 		return NULL;
5459756d17eeS[email protected] 
5460345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_next(pid_list, v, pos);
5461756d17eeS[email protected] }
5462756d17eeS[email protected] 
5463756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
5464345ddcc8SSteven Rostedt (Red Hat) 	__releases(RCU)
5465756d17eeS[email protected] {
5466345ddcc8SSteven Rostedt (Red Hat) 	rcu_read_unlock_sched();
5467756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5468756d17eeS[email protected] }
5469756d17eeS[email protected] 
5470756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
5471756d17eeS[email protected] {
5472345ddcc8SSteven Rostedt (Red Hat) 	if (v == FTRACE_NO_PIDS) {
5473fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
5474756d17eeS[email protected] 		return 0;
5475756d17eeS[email protected] 	}
5476756d17eeS[email protected] 
5477345ddcc8SSteven Rostedt (Red Hat) 	return trace_pid_show(m, v);
5478756d17eeS[email protected] }
5479756d17eeS[email protected] 
5480756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
5481756d17eeS[email protected] 	.start = fpid_start,
5482756d17eeS[email protected] 	.next = fpid_next,
5483756d17eeS[email protected] 	.stop = fpid_stop,
5484756d17eeS[email protected] 	.show = fpid_show,
5485756d17eeS[email protected] };
5486756d17eeS[email protected] 
5487756d17eeS[email protected] static int
5488756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
5489756d17eeS[email protected] {
5490345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
5491345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m;
5492756d17eeS[email protected] 	int ret = 0;
5493756d17eeS[email protected] 
5494345ddcc8SSteven Rostedt (Red Hat) 	if (trace_array_get(tr) < 0)
5495345ddcc8SSteven Rostedt (Red Hat) 		return -ENODEV;
5496345ddcc8SSteven Rostedt (Red Hat) 
5497756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
5498756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
5499345ddcc8SSteven Rostedt (Red Hat) 		ftrace_pid_reset(tr);
5500756d17eeS[email protected] 
5501756d17eeS[email protected] 	ret = seq_open(file, &ftrace_pid_sops);
5502345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0) {
5503345ddcc8SSteven Rostedt (Red Hat) 		trace_array_put(tr);
5504345ddcc8SSteven Rostedt (Red Hat) 	} else {
5505345ddcc8SSteven Rostedt (Red Hat) 		m = file->private_data;
5506345ddcc8SSteven Rostedt (Red Hat) 		/* copy tr over to seq ops */
5507345ddcc8SSteven Rostedt (Red Hat) 		m->private = tr;
5508345ddcc8SSteven Rostedt (Red Hat) 	}
5509756d17eeS[email protected] 
5510756d17eeS[email protected] 	return ret;
5511756d17eeS[email protected] }
5512756d17eeS[email protected] 
5513345ddcc8SSteven Rostedt (Red Hat) static void ignore_task_cpu(void *data)
5514345ddcc8SSteven Rostedt (Red Hat) {
5515345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = data;
5516345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5517345ddcc8SSteven Rostedt (Red Hat) 
5518345ddcc8SSteven Rostedt (Red Hat) 	/*
5519345ddcc8SSteven Rostedt (Red Hat) 	 * This function is called by on_each_cpu() while the
5520345ddcc8SSteven Rostedt (Red Hat) 	 * event_mutex is held.
5521345ddcc8SSteven Rostedt (Red Hat) 	 */
5522345ddcc8SSteven Rostedt (Red Hat) 	pid_list = rcu_dereference_protected(tr->function_pids,
5523345ddcc8SSteven Rostedt (Red Hat) 					     mutex_is_locked(&ftrace_lock));
5524345ddcc8SSteven Rostedt (Red Hat) 
5525345ddcc8SSteven Rostedt (Red Hat) 	this_cpu_write(tr->trace_buffer.data->ftrace_ignore_pid,
5526345ddcc8SSteven Rostedt (Red Hat) 		       trace_ignore_this_task(pid_list, current));
5527345ddcc8SSteven Rostedt (Red Hat) }
5528345ddcc8SSteven Rostedt (Red Hat) 
5529df4fc315SSteven Rostedt static ssize_t
5530df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
5531df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
5532df4fc315SSteven Rostedt {
5533345ddcc8SSteven Rostedt (Red Hat) 	struct seq_file *m = filp->private_data;
5534345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = m->private;
5535345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *filtered_pids = NULL;
5536345ddcc8SSteven Rostedt (Red Hat) 	struct trace_pid_list *pid_list;
5537345ddcc8SSteven Rostedt (Red Hat) 	ssize_t ret;
5538df4fc315SSteven Rostedt 
5539345ddcc8SSteven Rostedt (Red Hat) 	if (!cnt)
5540345ddcc8SSteven Rostedt (Red Hat) 		return 0;
5541df4fc315SSteven Rostedt 
5542345ddcc8SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
5543df4fc315SSteven Rostedt 
5544345ddcc8SSteven Rostedt (Red Hat) 	filtered_pids = rcu_dereference_protected(tr->function_pids,
5545345ddcc8SSteven Rostedt (Red Hat) 					     lockdep_is_held(&ftrace_lock));
5546345ddcc8SSteven Rostedt (Red Hat) 
5547345ddcc8SSteven Rostedt (Red Hat) 	ret = trace_pid_write(filtered_pids, &pid_list, ubuf, cnt);
5548345ddcc8SSteven Rostedt (Red Hat) 	if (ret < 0)
5549345ddcc8SSteven Rostedt (Red Hat) 		goto out;
5550345ddcc8SSteven Rostedt (Red Hat) 
5551345ddcc8SSteven Rostedt (Red Hat) 	rcu_assign_pointer(tr->function_pids, pid_list);
5552345ddcc8SSteven Rostedt (Red Hat) 
5553345ddcc8SSteven Rostedt (Red Hat) 	if (filtered_pids) {
5554345ddcc8SSteven Rostedt (Red Hat) 		synchronize_sched();
5555345ddcc8SSteven Rostedt (Red Hat) 		trace_free_pid_list(filtered_pids);
5556345ddcc8SSteven Rostedt (Red Hat) 	} else if (pid_list) {
5557345ddcc8SSteven Rostedt (Red Hat) 		/* Register a probe to set whether to ignore the tracing of a task */
5558345ddcc8SSteven Rostedt (Red Hat) 		register_trace_sched_switch(ftrace_filter_pid_sched_switch_probe, tr);
5559345ddcc8SSteven Rostedt (Red Hat) 	}
5560df4fc315SSteven Rostedt 
5561756d17eeS[email protected] 	/*
5562345ddcc8SSteven Rostedt (Red Hat) 	 * Ignoring of pids is done at task switch. But we have to
5563345ddcc8SSteven Rostedt (Red Hat) 	 * check for those tasks that are currently running.
5564345ddcc8SSteven Rostedt (Red Hat) 	 * Always do this in case a pid was appended or removed.
5565756d17eeS[email protected] 	 */
5566345ddcc8SSteven Rostedt (Red Hat) 	on_each_cpu(ignore_task_cpu, tr, 1);
5567756d17eeS[email protected] 
5568345ddcc8SSteven Rostedt (Red Hat) 	ftrace_update_pid_func();
5569345ddcc8SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5570345ddcc8SSteven Rostedt (Red Hat)  out:
5571345ddcc8SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5572345ddcc8SSteven Rostedt (Red Hat) 
5573345ddcc8SSteven Rostedt (Red Hat) 	if (ret > 0)
5574345ddcc8SSteven Rostedt (Red Hat) 		*ppos += ret;
5575345ddcc8SSteven Rostedt (Red Hat) 
5576df4fc315SSteven Rostedt 	return ret;
5577e32d8956SSteven Rostedt }
5578978f3a45SSteven Rostedt 
5579756d17eeS[email protected] static int
5580756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
5581756d17eeS[email protected] {
5582345ddcc8SSteven Rostedt (Red Hat) 	struct trace_array *tr = inode->i_private;
5583978f3a45SSteven Rostedt 
5584345ddcc8SSteven Rostedt (Red Hat) 	trace_array_put(tr);
5585345ddcc8SSteven Rostedt (Red Hat) 
5586345ddcc8SSteven Rostedt (Red Hat) 	return seq_release(inode, file);
5587df4fc315SSteven Rostedt }
5588df4fc315SSteven Rostedt 
55895e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
5590756d17eeS[email protected] 	.open		= ftrace_pid_open,
5591df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
5592756d17eeS[email protected] 	.read		= seq_read,
5593098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
5594756d17eeS[email protected] 	.release	= ftrace_pid_release,
5595df4fc315SSteven Rostedt };
5596df4fc315SSteven Rostedt 
5597345ddcc8SSteven Rostedt (Red Hat) void ftrace_init_tracefs(struct trace_array *tr, struct dentry *d_tracer)
5598df4fc315SSteven Rostedt {
55995452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
5600345ddcc8SSteven Rostedt (Red Hat) 			    tr, &ftrace_pid_fops);
5601df4fc315SSteven Rostedt }
5602df4fc315SSteven Rostedt 
5603501c2375SSteven Rostedt (Red Hat) void __init ftrace_init_tracefs_toplevel(struct trace_array *tr,
5604501c2375SSteven Rostedt (Red Hat) 					 struct dentry *d_tracer)
5605501c2375SSteven Rostedt (Red Hat) {
5606501c2375SSteven Rostedt (Red Hat) 	/* Only the top level directory has the dyn_tracefs and profile */
5607501c2375SSteven Rostedt (Red Hat) 	WARN_ON(!(tr->flags & TRACE_ARRAY_FL_GLOBAL));
5608501c2375SSteven Rostedt (Red Hat) 
5609501c2375SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
5610501c2375SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
5611501c2375SSteven Rostedt (Red Hat) }
5612501c2375SSteven Rostedt (Red Hat) 
56133d083395SSteven Rostedt /**
561481adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
5615a2bb6a3dSSteven Rostedt  *
5616a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
5617a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
5618a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
5619a2bb6a3dSSteven Rostedt  */
562081adbdc0SSteven Rostedt void ftrace_kill(void)
5621a2bb6a3dSSteven Rostedt {
5622a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
5623a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
5624a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
5625a2bb6a3dSSteven Rostedt }
5626a2bb6a3dSSteven Rostedt 
5627a2bb6a3dSSteven Rostedt /**
5628e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
5629e0a413f6SSteven Rostedt  */
5630e0a413f6SSteven Rostedt int ftrace_is_dead(void)
5631e0a413f6SSteven Rostedt {
5632e0a413f6SSteven Rostedt 	return ftrace_disabled;
5633e0a413f6SSteven Rostedt }
5634e0a413f6SSteven Rostedt 
5635e0a413f6SSteven Rostedt /**
56363d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
56373d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
56383d083395SSteven Rostedt  *
56393d083395SSteven Rostedt  * Register a function to be called by all functions in the
56403d083395SSteven Rostedt  * kernel.
56413d083395SSteven Rostedt  *
56423d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
56433d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
56443d083395SSteven Rostedt  *       recursive loop.
56453d083395SSteven Rostedt  */
56463d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
56473d083395SSteven Rostedt {
564845a4a237SSteven Rostedt 	int ret = -1;
56494eebcc81SSteven Rostedt 
5650f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5651f04f24fbSMasami Hiramatsu 
5652e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5653e7d3737eSFrederic Weisbecker 
5654a1cd6173SSteven Rostedt 	ret = ftrace_startup(ops, 0);
5655b848914cSSteven Rostedt 
5656e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
56578d240dd8SBorislav Petkov 
5658b0fc494fSSteven Rostedt 	return ret;
56593d083395SSteven Rostedt }
5660cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
56613d083395SSteven Rostedt 
56623d083395SSteven Rostedt /**
566332632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
56643d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
56653d083395SSteven Rostedt  *
56663d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
56673d083395SSteven Rostedt  */
56683d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
56693d083395SSteven Rostedt {
56703d083395SSteven Rostedt 	int ret;
56713d083395SSteven Rostedt 
5672e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
56738a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
5674e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5675b0fc494fSSteven Rostedt 
5676b0fc494fSSteven Rostedt 	return ret;
5677b0fc494fSSteven Rostedt }
5678cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
5679b0fc494fSSteven Rostedt 
5680e309b41dSIngo Molnar int
5681b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
56828d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
5683b0fc494fSSteven Rostedt 		     loff_t *ppos)
5684b0fc494fSSteven Rostedt {
568545a4a237SSteven Rostedt 	int ret = -ENODEV;
56864eebcc81SSteven Rostedt 
5687e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5688b0fc494fSSteven Rostedt 
568945a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
569045a4a237SSteven Rostedt 		goto out;
569145a4a237SSteven Rostedt 
56928d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
5693b0fc494fSSteven Rostedt 
5694a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
5695b0fc494fSSteven Rostedt 		goto out;
5696b0fc494fSSteven Rostedt 
5697a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
5698b0fc494fSSteven Rostedt 
5699b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
5700b0fc494fSSteven Rostedt 
5701b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
57025000c418SJan Kiszka 		if (ftrace_ops_list != &ftrace_list_end)
57035000c418SJan Kiszka 			update_ftrace_function();
5704b0fc494fSSteven Rostedt 
5705524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
5706524a3868SSteven Rostedt (Red Hat) 
5707b0fc494fSSteven Rostedt 	} else {
5708b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
5709b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
5710b0fc494fSSteven Rostedt 
5711b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
5712b0fc494fSSteven Rostedt 	}
5713b0fc494fSSteven Rostedt 
5714b0fc494fSSteven Rostedt  out:
5715e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
57163d083395SSteven Rostedt 	return ret;
571716444a8aSArnaldo Carvalho de Melo }
5718f17845e5SIngo Molnar 
5719fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5720e7d3737eSFrederic Weisbecker 
57215f151b24SSteven Rostedt (Red Hat) static struct ftrace_ops graph_ops = {
57225f151b24SSteven Rostedt (Red Hat) 	.func			= ftrace_stub,
57235f151b24SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
57245f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_INITIALIZED |
5725e3eea140SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_PID |
57265f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_STUB,
57275f151b24SSteven Rostedt (Red Hat) #ifdef FTRACE_GRAPH_TRAMP_ADDR
57285f151b24SSteven Rostedt (Red Hat) 	.trampoline		= FTRACE_GRAPH_TRAMP_ADDR,
5729aec0be2dSSteven Rostedt (Red Hat) 	/* trampoline_size is only needed for dynamically allocated tramps */
57305f151b24SSteven Rostedt (Red Hat) #endif
57315f151b24SSteven Rostedt (Red Hat) 	ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
57325f151b24SSteven Rostedt (Red Hat) };
57335f151b24SSteven Rostedt (Red Hat) 
573455577204SSteven Rostedt (Red Hat) void ftrace_graph_sleep_time_control(bool enable)
573555577204SSteven Rostedt (Red Hat) {
573655577204SSteven Rostedt (Red Hat) 	fgraph_sleep_time = enable;
573755577204SSteven Rostedt (Red Hat) }
573855577204SSteven Rostedt (Red Hat) 
573955577204SSteven Rostedt (Red Hat) void ftrace_graph_graph_time_control(bool enable)
574055577204SSteven Rostedt (Red Hat) {
574155577204SSteven Rostedt (Red Hat) 	fgraph_graph_time = enable;
574255577204SSteven Rostedt (Red Hat) }
574355577204SSteven Rostedt (Red Hat) 
5744e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
5745e49dc19cSSteven Rostedt {
5746e49dc19cSSteven Rostedt 	return 0;
5747e49dc19cSSteven Rostedt }
5748e49dc19cSSteven Rostedt 
5749287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
5750287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
5751287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
5752e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
575323a8e844SSteven Rostedt (Red Hat) static trace_func_graph_ent_t __ftrace_graph_entry = ftrace_graph_entry_stub;
5754f201ae23SFrederic Weisbecker 
5755f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
5756f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
5757f201ae23SFrederic Weisbecker {
5758f201ae23SFrederic Weisbecker 	int i;
5759f201ae23SFrederic Weisbecker 	int ret = 0;
5760f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
5761f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
5762f201ae23SFrederic Weisbecker 
5763f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
5764f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
5765f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
5766f201ae23SFrederic Weisbecker 					GFP_KERNEL);
5767f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
5768f201ae23SFrederic Weisbecker 			start = 0;
5769f201ae23SFrederic Weisbecker 			end = i;
5770f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
5771f201ae23SFrederic Weisbecker 			goto free;
5772f201ae23SFrederic Weisbecker 		}
5773f201ae23SFrederic Weisbecker 	}
5774f201ae23SFrederic Weisbecker 
57756112a300SSoumya PN 	read_lock(&tasklist_lock);
5776f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
5777f201ae23SFrederic Weisbecker 		if (start == end) {
5778f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
5779f201ae23SFrederic Weisbecker 			goto unlock;
5780f201ae23SFrederic Weisbecker 		}
5781f201ae23SFrederic Weisbecker 
5782f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
5783380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
5784f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
578526c01624SSteven Rostedt 			t->curr_ret_stack = -1;
578626c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
578726c01624SSteven Rostedt 			smp_wmb();
578826c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
5789f201ae23SFrederic Weisbecker 		}
5790f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
5791f201ae23SFrederic Weisbecker 
5792f201ae23SFrederic Weisbecker unlock:
57936112a300SSoumya PN 	read_unlock(&tasklist_lock);
5794f201ae23SFrederic Weisbecker free:
5795f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
5796f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
5797f201ae23SFrederic Weisbecker 	return ret;
5798f201ae23SFrederic Weisbecker }
5799f201ae23SFrederic Weisbecker 
58008aef2d28SSteven Rostedt static void
5801c73464b1SPeter Zijlstra ftrace_graph_probe_sched_switch(void *ignore, bool preempt,
580238516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
58038aef2d28SSteven Rostedt {
58048aef2d28SSteven Rostedt 	unsigned long long timestamp;
58058aef2d28SSteven Rostedt 	int index;
58068aef2d28SSteven Rostedt 
5807be6f164aSSteven Rostedt 	/*
5808be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
5809be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
5810be6f164aSSteven Rostedt 	 */
581155577204SSteven Rostedt (Red Hat) 	if (fgraph_sleep_time)
5812be6f164aSSteven Rostedt 		return;
5813be6f164aSSteven Rostedt 
58148aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
58158aef2d28SSteven Rostedt 
58168aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
58178aef2d28SSteven Rostedt 
58188aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
58198aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
58208aef2d28SSteven Rostedt 		return;
58218aef2d28SSteven Rostedt 
58228aef2d28SSteven Rostedt 	/*
58238aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
58248aef2d28SSteven Rostedt 	 * time next was sleeping.
58258aef2d28SSteven Rostedt 	 */
58268aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
58278aef2d28SSteven Rostedt 
58288aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
58298aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
58308aef2d28SSteven Rostedt }
58318aef2d28SSteven Rostedt 
5832f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
5833fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
5834f201ae23SFrederic Weisbecker {
5835f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
58365b058bcdSFrederic Weisbecker 	int ret, cpu;
5837f201ae23SFrederic Weisbecker 
5838f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
5839f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
5840f201ae23SFrederic Weisbecker 				GFP_KERNEL);
5841f201ae23SFrederic Weisbecker 
5842f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
5843f201ae23SFrederic Weisbecker 		return -ENOMEM;
5844f201ae23SFrederic Weisbecker 
58455b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
5846179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
5847179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
5848868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
5849179c498aSSteven Rostedt 	}
58505b058bcdSFrederic Weisbecker 
5851f201ae23SFrederic Weisbecker 	do {
5852f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
5853f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
5854f201ae23SFrederic Weisbecker 
58558aef2d28SSteven Rostedt 	if (!ret) {
585638516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
58578aef2d28SSteven Rostedt 		if (ret)
58588aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
58598aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
58608aef2d28SSteven Rostedt 	}
58618aef2d28SSteven Rostedt 
5862f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
5863f201ae23SFrederic Weisbecker 	return ret;
5864f201ae23SFrederic Weisbecker }
5865f201ae23SFrederic Weisbecker 
58664a2b8ddaSFrederic Weisbecker /*
58674a2b8ddaSFrederic Weisbecker  * Hibernation protection.
58684a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
58694a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
58704a2b8ddaSFrederic Weisbecker  */
58714a2b8ddaSFrederic Weisbecker static int
58724a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
58734a2b8ddaSFrederic Weisbecker 							void *unused)
58744a2b8ddaSFrederic Weisbecker {
58754a2b8ddaSFrederic Weisbecker 	switch (state) {
58764a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
58774a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
58784a2b8ddaSFrederic Weisbecker 		break;
58794a2b8ddaSFrederic Weisbecker 
58804a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
58814a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
58824a2b8ddaSFrederic Weisbecker 		break;
58834a2b8ddaSFrederic Weisbecker 	}
58844a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
58854a2b8ddaSFrederic Weisbecker }
58864a2b8ddaSFrederic Weisbecker 
588723a8e844SSteven Rostedt (Red Hat) static int ftrace_graph_entry_test(struct ftrace_graph_ent *trace)
588823a8e844SSteven Rostedt (Red Hat) {
588923a8e844SSteven Rostedt (Red Hat) 	if (!ftrace_ops_test(&global_ops, trace->func, NULL))
589023a8e844SSteven Rostedt (Red Hat) 		return 0;
589123a8e844SSteven Rostedt (Red Hat) 	return __ftrace_graph_entry(trace);
589223a8e844SSteven Rostedt (Red Hat) }
589323a8e844SSteven Rostedt (Red Hat) 
589423a8e844SSteven Rostedt (Red Hat) /*
589523a8e844SSteven Rostedt (Red Hat)  * The function graph tracer should only trace the functions defined
589623a8e844SSteven Rostedt (Red Hat)  * by set_ftrace_filter and set_ftrace_notrace. If another function
589723a8e844SSteven Rostedt (Red Hat)  * tracer ops is registered, the graph tracer requires testing the
589823a8e844SSteven Rostedt (Red Hat)  * function against the global ops, and not just trace any function
589923a8e844SSteven Rostedt (Red Hat)  * that any ftrace_ops registered.
590023a8e844SSteven Rostedt (Red Hat)  */
590123a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void)
590223a8e844SSteven Rostedt (Red Hat) {
59035f151b24SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
59045f151b24SSteven Rostedt (Red Hat) 	bool do_test = false;
59055f151b24SSteven Rostedt (Red Hat) 
59065f151b24SSteven Rostedt (Red Hat) 	/*
59075f151b24SSteven Rostedt (Red Hat) 	 * The graph and global ops share the same set of functions
59085f151b24SSteven Rostedt (Red Hat) 	 * to test. If any other ops is on the list, then
59095f151b24SSteven Rostedt (Red Hat) 	 * the graph tracing needs to test if its the function
59105f151b24SSteven Rostedt (Red Hat) 	 * it should call.
59115f151b24SSteven Rostedt (Red Hat) 	 */
59125f151b24SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
59135f151b24SSteven Rostedt (Red Hat) 		if (op != &global_ops && op != &graph_ops &&
59145f151b24SSteven Rostedt (Red Hat) 		    op != &ftrace_list_end) {
59155f151b24SSteven Rostedt (Red Hat) 			do_test = true;
59165f151b24SSteven Rostedt (Red Hat) 			/* in double loop, break out with goto */
59175f151b24SSteven Rostedt (Red Hat) 			goto out;
59185f151b24SSteven Rostedt (Red Hat) 		}
59195f151b24SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
59205f151b24SSteven Rostedt (Red Hat)  out:
59215f151b24SSteven Rostedt (Red Hat) 	if (do_test)
592223a8e844SSteven Rostedt (Red Hat) 		ftrace_graph_entry = ftrace_graph_entry_test;
59235f151b24SSteven Rostedt (Red Hat) 	else
59245f151b24SSteven Rostedt (Red Hat) 		ftrace_graph_entry = __ftrace_graph_entry;
592523a8e844SSteven Rostedt (Red Hat) }
592623a8e844SSteven Rostedt (Red Hat) 
59278275f69fSMathias Krause static struct notifier_block ftrace_suspend_notifier = {
59288275f69fSMathias Krause 	.notifier_call = ftrace_suspend_notifier_call,
59298275f69fSMathias Krause };
59308275f69fSMathias Krause 
5931287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
5932287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
593315e6cb36SFrederic Weisbecker {
5934e7d3737eSFrederic Weisbecker 	int ret = 0;
5935e7d3737eSFrederic Weisbecker 
5936e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5937e7d3737eSFrederic Weisbecker 
593805ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
5939597af815SSteven Rostedt 	if (ftrace_graph_active) {
594005ce5818SSteven Rostedt 		ret = -EBUSY;
594105ce5818SSteven Rostedt 		goto out;
594205ce5818SSteven Rostedt 	}
594305ce5818SSteven Rostedt 
59444a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
59454a2b8ddaSFrederic Weisbecker 
5946597af815SSteven Rostedt 	ftrace_graph_active++;
5947fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
5948f201ae23SFrederic Weisbecker 	if (ret) {
5949597af815SSteven Rostedt 		ftrace_graph_active--;
5950f201ae23SFrederic Weisbecker 		goto out;
5951f201ae23SFrederic Weisbecker 	}
5952e53a6319SSteven Rostedt 
5953287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
595423a8e844SSteven Rostedt (Red Hat) 
595523a8e844SSteven Rostedt (Red Hat) 	/*
595623a8e844SSteven Rostedt (Red Hat) 	 * Update the indirect function to the entryfunc, and the
595723a8e844SSteven Rostedt (Red Hat) 	 * function that gets called to the entry_test first. Then
595823a8e844SSteven Rostedt (Red Hat) 	 * call the update fgraph entry function to determine if
595923a8e844SSteven Rostedt (Red Hat) 	 * the entryfunc should be called directly or not.
596023a8e844SSteven Rostedt (Red Hat) 	 */
596123a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = entryfunc;
596223a8e844SSteven Rostedt (Red Hat) 	ftrace_graph_entry = ftrace_graph_entry_test;
596323a8e844SSteven Rostedt (Red Hat) 	update_function_graph_func();
5964e53a6319SSteven Rostedt 
59655f151b24SSteven Rostedt (Red Hat) 	ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
5966e7d3737eSFrederic Weisbecker out:
5967e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5968e7d3737eSFrederic Weisbecker 	return ret;
596915e6cb36SFrederic Weisbecker }
597015e6cb36SFrederic Weisbecker 
5971fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
597215e6cb36SFrederic Weisbecker {
5973e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5974e7d3737eSFrederic Weisbecker 
5975597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
59762aad1b76SSteven Rostedt 		goto out;
59772aad1b76SSteven Rostedt 
5978597af815SSteven Rostedt 	ftrace_graph_active--;
5979287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
5980e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
598123a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = ftrace_graph_entry_stub;
59825f151b24SSteven Rostedt (Red Hat) 	ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
59834a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
598438516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
5985e7d3737eSFrederic Weisbecker 
5986f3bea491SSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE
5987f3bea491SSteven Rostedt (Red Hat) 	/*
5988f3bea491SSteven Rostedt (Red Hat) 	 * Function graph does not allocate the trampoline, but
5989f3bea491SSteven Rostedt (Red Hat) 	 * other global_ops do. We need to reset the ALLOC_TRAMP flag
5990f3bea491SSteven Rostedt (Red Hat) 	 * if one was used.
5991f3bea491SSteven Rostedt (Red Hat) 	 */
5992f3bea491SSteven Rostedt (Red Hat) 	global_ops.trampoline = save_global_trampoline;
5993f3bea491SSteven Rostedt (Red Hat) 	if (save_global_flags & FTRACE_OPS_FL_ALLOC_TRAMP)
5994f3bea491SSteven Rostedt (Red Hat) 		global_ops.flags |= FTRACE_OPS_FL_ALLOC_TRAMP;
5995f3bea491SSteven Rostedt (Red Hat) #endif
5996f3bea491SSteven Rostedt (Red Hat) 
59972aad1b76SSteven Rostedt  out:
5998e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
599915e6cb36SFrederic Weisbecker }
6000f201ae23SFrederic Weisbecker 
6001868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
6002868baf07SSteven Rostedt 
6003868baf07SSteven Rostedt static void
6004868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
6005868baf07SSteven Rostedt {
6006868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
6007868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
6008868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
600925985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
6010868baf07SSteven Rostedt 	smp_wmb();
6011868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
6012868baf07SSteven Rostedt }
6013868baf07SSteven Rostedt 
6014868baf07SSteven Rostedt /*
6015868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
6016868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
6017868baf07SSteven Rostedt  */
6018868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
6019868baf07SSteven Rostedt {
6020868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
6021868baf07SSteven Rostedt 	/*
6022868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
6023868baf07SSteven Rostedt 	 * stack or no stack at all.
6024868baf07SSteven Rostedt 	 */
6025868baf07SSteven Rostedt 	if (t->ret_stack)
6026868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
6027868baf07SSteven Rostedt 
6028868baf07SSteven Rostedt 	if (ftrace_graph_active) {
6029868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
6030868baf07SSteven Rostedt 
6031868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
6032868baf07SSteven Rostedt 		if (!ret_stack) {
6033868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6034868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
6035868baf07SSteven Rostedt 					    GFP_KERNEL);
6036868baf07SSteven Rostedt 			if (!ret_stack)
6037868baf07SSteven Rostedt 				return;
6038868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
6039868baf07SSteven Rostedt 		}
6040868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
6041868baf07SSteven Rostedt 	}
6042868baf07SSteven Rostedt }
6043868baf07SSteven Rostedt 
6044f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
6045fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
6046f201ae23SFrederic Weisbecker {
604784047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
604884047e36SSteven Rostedt 	t->ret_stack = NULL;
6049ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
605084047e36SSteven Rostedt 
6051597af815SSteven Rostedt 	if (ftrace_graph_active) {
605282310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
605382310a32SSteven Rostedt 
605482310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6055f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
6056f201ae23SFrederic Weisbecker 				GFP_KERNEL);
605782310a32SSteven Rostedt 		if (!ret_stack)
6058f201ae23SFrederic Weisbecker 			return;
6059868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
606084047e36SSteven Rostedt 	}
6061f201ae23SFrederic Weisbecker }
6062f201ae23SFrederic Weisbecker 
6063fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
6064f201ae23SFrederic Weisbecker {
6065eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
6066eae849caSFrederic Weisbecker 
6067f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
6068eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
6069eae849caSFrederic Weisbecker 	barrier();
6070eae849caSFrederic Weisbecker 
6071eae849caSFrederic Weisbecker 	kfree(ret_stack);
6072f201ae23SFrederic Weisbecker }
607315e6cb36SFrederic Weisbecker #endif
6074