xref: /linux-6.15/kernel/trace/ftrace.c (revision 04cf31a7)
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 
92756d17eeS[email protected] /* List for set_ftrace_pid's pids. */
93756d17eeS[email protected] LIST_HEAD(ftrace_pids);
94756d17eeS[email protected] struct ftrace_pid {
95756d17eeS[email protected] 	struct list_head list;
96756d17eeS[email protected] 	struct pid *pid;
97756d17eeS[email protected] };
98756d17eeS[email protected] 
99e3eea140SSteven Rostedt (Red Hat) static bool ftrace_pids_enabled(void)
100e3eea140SSteven Rostedt (Red Hat) {
101e3eea140SSteven Rostedt (Red Hat) 	return !list_empty(&ftrace_pids);
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 {
1820ef8cde5SSteven Rostedt 	if (!test_tsk_trace_trace(current))
183df4fc315SSteven Rostedt 		return;
184df4fc315SSteven Rostedt 
185e3eea140SSteven Rostedt (Red Hat) 	op->saved_func(ip, parent_ip, op, regs);
186df4fc315SSteven Rostedt }
187df4fc315SSteven Rostedt 
18816444a8aSArnaldo Carvalho de Melo /**
1893d083395SSteven Rostedt  * clear_ftrace_function - reset the ftrace function
19016444a8aSArnaldo Carvalho de Melo  *
1913d083395SSteven Rostedt  * This NULLs the ftrace function and in essence stops
1923d083395SSteven Rostedt  * tracing.  There may be lag
19316444a8aSArnaldo Carvalho de Melo  */
1943d083395SSteven Rostedt void clear_ftrace_function(void)
19516444a8aSArnaldo Carvalho de Melo {
1963d083395SSteven Rostedt 	ftrace_trace_function = ftrace_stub;
1973d083395SSteven Rostedt }
19816444a8aSArnaldo Carvalho de Melo 
199ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_disable_all(struct ftrace_ops *ops)
200e248491aSJiri Olsa {
201e248491aSJiri Olsa 	int cpu;
202e248491aSJiri Olsa 
203e248491aSJiri Olsa 	for_each_possible_cpu(cpu)
204e248491aSJiri Olsa 		*per_cpu_ptr(ops->disabled, cpu) = 1;
205e248491aSJiri Olsa }
206e248491aSJiri Olsa 
207ba27f2bcSSteven Rostedt (Red Hat) static int per_cpu_ops_alloc(struct ftrace_ops *ops)
208e248491aSJiri Olsa {
209e248491aSJiri Olsa 	int __percpu *disabled;
210e248491aSJiri Olsa 
211ba27f2bcSSteven Rostedt (Red Hat) 	if (WARN_ON_ONCE(!(ops->flags & FTRACE_OPS_FL_PER_CPU)))
212ba27f2bcSSteven Rostedt (Red Hat) 		return -EINVAL;
213ba27f2bcSSteven Rostedt (Red Hat) 
214e248491aSJiri Olsa 	disabled = alloc_percpu(int);
215e248491aSJiri Olsa 	if (!disabled)
216e248491aSJiri Olsa 		return -ENOMEM;
217e248491aSJiri Olsa 
218e248491aSJiri Olsa 	ops->disabled = disabled;
219ba27f2bcSSteven Rostedt (Red Hat) 	per_cpu_ops_disable_all(ops);
220e248491aSJiri Olsa 	return 0;
221e248491aSJiri Olsa }
222e248491aSJiri Olsa 
223405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync(struct work_struct *work)
224405e1d83SSteven Rostedt (Red Hat) {
225405e1d83SSteven Rostedt (Red Hat) 	/*
226405e1d83SSteven Rostedt (Red Hat) 	 * This function is just a stub to implement a hard force
227405e1d83SSteven Rostedt (Red Hat) 	 * of synchronize_sched(). This requires synchronizing
228405e1d83SSteven Rostedt (Red Hat) 	 * tasks even in userspace and idle.
229405e1d83SSteven Rostedt (Red Hat) 	 *
230405e1d83SSteven Rostedt (Red Hat) 	 * Yes, function tracing is rude.
231405e1d83SSteven Rostedt (Red Hat) 	 */
232405e1d83SSteven Rostedt (Red Hat) }
233405e1d83SSteven Rostedt (Red Hat) 
234405e1d83SSteven Rostedt (Red Hat) static void ftrace_sync_ipi(void *data)
235405e1d83SSteven Rostedt (Red Hat) {
236405e1d83SSteven Rostedt (Red Hat) 	/* Probably not needed, but do it anyway */
237405e1d83SSteven Rostedt (Red Hat) 	smp_rmb();
238405e1d83SSteven Rostedt (Red Hat) }
239405e1d83SSteven Rostedt (Red Hat) 
24023a8e844SSteven Rostedt (Red Hat) #ifdef CONFIG_FUNCTION_GRAPH_TRACER
24123a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void);
24255577204SSteven Rostedt (Red Hat) 
24355577204SSteven Rostedt (Red Hat) /* Both enabled by default (can be cleared by function_graph tracer flags */
24455577204SSteven Rostedt (Red Hat) static bool fgraph_sleep_time = true;
24555577204SSteven Rostedt (Red Hat) static bool fgraph_graph_time = true;
24655577204SSteven Rostedt (Red Hat) 
24723a8e844SSteven Rostedt (Red Hat) #else
24823a8e844SSteven Rostedt (Red Hat) static inline void update_function_graph_func(void) { }
24923a8e844SSteven Rostedt (Red Hat) #endif
25023a8e844SSteven Rostedt (Red Hat) 
25100ccbf2fSSteven Rostedt (Red Hat) 
25200ccbf2fSSteven Rostedt (Red Hat) static ftrace_func_t ftrace_ops_get_list_func(struct ftrace_ops *ops)
25300ccbf2fSSteven Rostedt (Red Hat) {
25400ccbf2fSSteven Rostedt (Red Hat) 	/*
255ba27f2bcSSteven Rostedt (Red Hat) 	 * If this is a dynamic, RCU, or per CPU ops, or we force list func,
25600ccbf2fSSteven Rostedt (Red Hat) 	 * then it needs to call the list anyway.
25700ccbf2fSSteven Rostedt (Red Hat) 	 */
258ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU |
259ba27f2bcSSteven Rostedt (Red Hat) 			  FTRACE_OPS_FL_RCU) || FTRACE_FORCE_LIST_FUNC)
26000ccbf2fSSteven Rostedt (Red Hat) 		return ftrace_ops_list_func;
26100ccbf2fSSteven Rostedt (Red Hat) 
26200ccbf2fSSteven Rostedt (Red Hat) 	return ftrace_ops_get_func(ops);
26300ccbf2fSSteven Rostedt (Red Hat) }
26400ccbf2fSSteven Rostedt (Red Hat) 
2652b499381SSteven Rostedt static void update_ftrace_function(void)
2662b499381SSteven Rostedt {
2672b499381SSteven Rostedt 	ftrace_func_t func;
2682b499381SSteven Rostedt 
269cdbe61bfSSteven Rostedt 	/*
270f7aad4e1SSteven Rostedt (Red Hat) 	 * Prepare the ftrace_ops that the arch callback will use.
271f7aad4e1SSteven Rostedt (Red Hat) 	 * If there's only one ftrace_ops registered, the ftrace_ops_list
272f7aad4e1SSteven Rostedt (Red Hat) 	 * will point to the ops we want.
273f7aad4e1SSteven Rostedt (Red Hat) 	 */
274f7aad4e1SSteven Rostedt (Red Hat) 	set_function_trace_op = ftrace_ops_list;
275f7aad4e1SSteven Rostedt (Red Hat) 
276f7aad4e1SSteven Rostedt (Red Hat) 	/* If there's no ftrace_ops registered, just call the stub function */
277f7aad4e1SSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
278f7aad4e1SSteven Rostedt (Red Hat) 		func = ftrace_stub;
279f7aad4e1SSteven Rostedt (Red Hat) 
280f7aad4e1SSteven Rostedt (Red Hat) 	/*
281cdbe61bfSSteven Rostedt 	 * If we are at the end of the list and this ops is
2824740974aSSteven Rostedt 	 * recursion safe and not dynamic and the arch supports passing ops,
2834740974aSSteven Rostedt 	 * then have the mcount trampoline call the function directly.
284cdbe61bfSSteven Rostedt 	 */
285f7aad4e1SSteven Rostedt (Red Hat) 	} else if (ftrace_ops_list->next == &ftrace_list_end) {
28600ccbf2fSSteven Rostedt (Red Hat) 		func = ftrace_ops_get_list_func(ftrace_ops_list);
287f7aad4e1SSteven Rostedt (Red Hat) 
2882f5f6ad9SSteven Rostedt 	} else {
2892f5f6ad9SSteven Rostedt 		/* Just use the default ftrace_ops */
290405e1d83SSteven Rostedt (Red Hat) 		set_function_trace_op = &ftrace_list_end;
291b848914cSSteven Rostedt 		func = ftrace_ops_list_func;
2922f5f6ad9SSteven Rostedt 	}
2932b499381SSteven Rostedt 
2945f8bf2d2SSteven Rostedt (Red Hat) 	update_function_graph_func();
2955f8bf2d2SSteven Rostedt (Red Hat) 
296405e1d83SSteven Rostedt (Red Hat) 	/* If there's no change, then do nothing more here */
297405e1d83SSteven Rostedt (Red Hat) 	if (ftrace_trace_function == func)
298405e1d83SSteven Rostedt (Red Hat) 		return;
299405e1d83SSteven Rostedt (Red Hat) 
300405e1d83SSteven Rostedt (Red Hat) 	/*
301405e1d83SSteven Rostedt (Red Hat) 	 * If we are using the list function, it doesn't care
302405e1d83SSteven Rostedt (Red Hat) 	 * about the function_trace_ops.
303405e1d83SSteven Rostedt (Red Hat) 	 */
304405e1d83SSteven Rostedt (Red Hat) 	if (func == ftrace_ops_list_func) {
305405e1d83SSteven Rostedt (Red Hat) 		ftrace_trace_function = func;
306405e1d83SSteven Rostedt (Red Hat) 		/*
307405e1d83SSteven Rostedt (Red Hat) 		 * Don't even bother setting function_trace_ops,
308405e1d83SSteven Rostedt (Red Hat) 		 * it would be racy to do so anyway.
309405e1d83SSteven Rostedt (Red Hat) 		 */
310405e1d83SSteven Rostedt (Red Hat) 		return;
311405e1d83SSteven Rostedt (Red Hat) 	}
312405e1d83SSteven Rostedt (Red Hat) 
313405e1d83SSteven Rostedt (Red Hat) #ifndef CONFIG_DYNAMIC_FTRACE
314405e1d83SSteven Rostedt (Red Hat) 	/*
315405e1d83SSteven Rostedt (Red Hat) 	 * For static tracing, we need to be a bit more careful.
316405e1d83SSteven Rostedt (Red Hat) 	 * The function change takes affect immediately. Thus,
317405e1d83SSteven Rostedt (Red Hat) 	 * we need to coorditate the setting of the function_trace_ops
318405e1d83SSteven Rostedt (Red Hat) 	 * with the setting of the ftrace_trace_function.
319405e1d83SSteven Rostedt (Red Hat) 	 *
320405e1d83SSteven Rostedt (Red Hat) 	 * Set the function to the list ops, which will call the
321405e1d83SSteven Rostedt (Red Hat) 	 * function we want, albeit indirectly, but it handles the
322405e1d83SSteven Rostedt (Red Hat) 	 * ftrace_ops and doesn't depend on function_trace_op.
323405e1d83SSteven Rostedt (Red Hat) 	 */
324405e1d83SSteven Rostedt (Red Hat) 	ftrace_trace_function = ftrace_ops_list_func;
325405e1d83SSteven Rostedt (Red Hat) 	/*
326405e1d83SSteven Rostedt (Red Hat) 	 * Make sure all CPUs see this. Yes this is slow, but static
327405e1d83SSteven Rostedt (Red Hat) 	 * tracing is slow and nasty to have enabled.
328405e1d83SSteven Rostedt (Red Hat) 	 */
329405e1d83SSteven Rostedt (Red Hat) 	schedule_on_each_cpu(ftrace_sync);
330405e1d83SSteven Rostedt (Red Hat) 	/* Now all cpus are using the list ops. */
331405e1d83SSteven Rostedt (Red Hat) 	function_trace_op = set_function_trace_op;
332405e1d83SSteven Rostedt (Red Hat) 	/* Make sure the function_trace_op is visible on all CPUs */
333405e1d83SSteven Rostedt (Red Hat) 	smp_wmb();
334405e1d83SSteven Rostedt (Red Hat) 	/* Nasty way to force a rmb on all cpus */
335405e1d83SSteven Rostedt (Red Hat) 	smp_call_function(ftrace_sync_ipi, NULL, 1);
336405e1d83SSteven Rostedt (Red Hat) 	/* OK, we are all set to update the ftrace_trace_function now! */
337405e1d83SSteven Rostedt (Red Hat) #endif /* !CONFIG_DYNAMIC_FTRACE */
338405e1d83SSteven Rostedt (Red Hat) 
339491d0dcfSSteven Rostedt 	ftrace_trace_function = func;
340491d0dcfSSteven Rostedt }
341491d0dcfSSteven Rostedt 
3427eea4fceSJiaxing Wang int using_ftrace_ops_list_func(void)
3437eea4fceSJiaxing Wang {
3447eea4fceSJiaxing Wang 	return ftrace_trace_function == ftrace_ops_list_func;
3457eea4fceSJiaxing Wang }
3467eea4fceSJiaxing Wang 
3472b499381SSteven Rostedt static void add_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3483d083395SSteven Rostedt {
3492b499381SSteven Rostedt 	ops->next = *list;
35016444a8aSArnaldo Carvalho de Melo 	/*
351b848914cSSteven Rostedt 	 * We are entering ops into the list but another
35216444a8aSArnaldo Carvalho de Melo 	 * CPU might be walking that list. We need to make sure
35316444a8aSArnaldo Carvalho de Melo 	 * the ops->next pointer is valid before another CPU sees
354b848914cSSteven Rostedt 	 * the ops pointer included into the list.
35516444a8aSArnaldo Carvalho de Melo 	 */
3562b499381SSteven Rostedt 	rcu_assign_pointer(*list, ops);
3572b499381SSteven Rostedt }
3583d083395SSteven Rostedt 
3592b499381SSteven Rostedt static int remove_ftrace_ops(struct ftrace_ops **list, struct ftrace_ops *ops)
3602b499381SSteven Rostedt {
3612b499381SSteven Rostedt 	struct ftrace_ops **p;
3622b499381SSteven Rostedt 
3632b499381SSteven Rostedt 	/*
3642b499381SSteven Rostedt 	 * If we are removing the last function, then simply point
3652b499381SSteven Rostedt 	 * to the ftrace_stub.
3662b499381SSteven Rostedt 	 */
3672b499381SSteven Rostedt 	if (*list == ops && ops->next == &ftrace_list_end) {
3682b499381SSteven Rostedt 		*list = &ftrace_list_end;
3692b499381SSteven Rostedt 		return 0;
3702b499381SSteven Rostedt 	}
3712b499381SSteven Rostedt 
3722b499381SSteven Rostedt 	for (p = list; *p != &ftrace_list_end; p = &(*p)->next)
3732b499381SSteven Rostedt 		if (*p == ops)
3742b499381SSteven Rostedt 			break;
3752b499381SSteven Rostedt 
3762b499381SSteven Rostedt 	if (*p != ops)
3772b499381SSteven Rostedt 		return -1;
3782b499381SSteven Rostedt 
3792b499381SSteven Rostedt 	*p = (*p)->next;
3802b499381SSteven Rostedt 	return 0;
3812b499381SSteven Rostedt }
3822b499381SSteven Rostedt 
383f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops);
384f3bea491SSteven Rostedt (Red Hat) 
3852b499381SSteven Rostedt static int __register_ftrace_function(struct ftrace_ops *ops)
3862b499381SSteven Rostedt {
387591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DELETED)
388591dffdaSSteven Rostedt (Red Hat) 		return -EINVAL;
389591dffdaSSteven Rostedt (Red Hat) 
390b848914cSSteven Rostedt 	if (WARN_ON(ops->flags & FTRACE_OPS_FL_ENABLED))
391b848914cSSteven Rostedt 		return -EBUSY;
392b848914cSSteven Rostedt 
39306aeaaeaSMasami Hiramatsu #ifndef CONFIG_DYNAMIC_FTRACE_WITH_REGS
39408f6fba5SSteven Rostedt 	/*
39508f6fba5SSteven Rostedt 	 * If the ftrace_ops specifies SAVE_REGS, then it only can be used
39608f6fba5SSteven Rostedt 	 * if the arch supports it, or SAVE_REGS_IF_SUPPORTED is also set.
39708f6fba5SSteven Rostedt 	 * Setting SAVE_REGS_IF_SUPPORTED makes SAVE_REGS irrelevant.
39808f6fba5SSteven Rostedt 	 */
39908f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS &&
40008f6fba5SSteven Rostedt 	    !(ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED))
40108f6fba5SSteven Rostedt 		return -EINVAL;
40208f6fba5SSteven Rostedt 
40308f6fba5SSteven Rostedt 	if (ops->flags & FTRACE_OPS_FL_SAVE_REGS_IF_SUPPORTED)
40408f6fba5SSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_SAVE_REGS;
40508f6fba5SSteven Rostedt #endif
40608f6fba5SSteven Rostedt 
407cdbe61bfSSteven Rostedt 	if (!core_kernel_data((unsigned long)ops))
408cdbe61bfSSteven Rostedt 		ops->flags |= FTRACE_OPS_FL_DYNAMIC;
409cdbe61bfSSteven Rostedt 
410ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_PER_CPU) {
411ba27f2bcSSteven Rostedt (Red Hat) 		if (per_cpu_ops_alloc(ops))
412e248491aSJiri Olsa 			return -ENOMEM;
413ba27f2bcSSteven Rostedt (Red Hat) 	}
414ba27f2bcSSteven Rostedt (Red Hat) 
415b848914cSSteven Rostedt 	add_ftrace_ops(&ftrace_ops_list, ops);
416b848914cSSteven Rostedt 
417e3eea140SSteven Rostedt (Red Hat) 	/* Always save the function, and reset at unregistering */
418e3eea140SSteven Rostedt (Red Hat) 	ops->saved_func = ops->func;
419e3eea140SSteven Rostedt (Red Hat) 
420e3eea140SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_PID && ftrace_pids_enabled())
421e3eea140SSteven Rostedt (Red Hat) 		ops->func = ftrace_pid_func;
422e3eea140SSteven Rostedt (Red Hat) 
423f3bea491SSteven Rostedt (Red Hat) 	ftrace_update_trampoline(ops);
424f3bea491SSteven Rostedt (Red Hat) 
425491d0dcfSSteven Rostedt 	if (ftrace_enabled)
426491d0dcfSSteven Rostedt 		update_ftrace_function();
4273d083395SSteven Rostedt 
42816444a8aSArnaldo Carvalho de Melo 	return 0;
42916444a8aSArnaldo Carvalho de Melo }
43016444a8aSArnaldo Carvalho de Melo 
431e309b41dSIngo Molnar static int __unregister_ftrace_function(struct ftrace_ops *ops)
43216444a8aSArnaldo Carvalho de Melo {
4332b499381SSteven Rostedt 	int ret;
43416444a8aSArnaldo Carvalho de Melo 
435b848914cSSteven Rostedt 	if (WARN_ON(!(ops->flags & FTRACE_OPS_FL_ENABLED)))
436b848914cSSteven Rostedt 		return -EBUSY;
437b848914cSSteven Rostedt 
438b848914cSSteven Rostedt 	ret = remove_ftrace_ops(&ftrace_ops_list, ops);
439b848914cSSteven Rostedt 
4402b499381SSteven Rostedt 	if (ret < 0)
4412b499381SSteven Rostedt 		return ret;
442b848914cSSteven Rostedt 
443491d0dcfSSteven Rostedt 	if (ftrace_enabled)
444491d0dcfSSteven Rostedt 		update_ftrace_function();
44516444a8aSArnaldo Carvalho de Melo 
446e3eea140SSteven Rostedt (Red Hat) 	ops->func = ops->saved_func;
447e3eea140SSteven Rostedt (Red Hat) 
448e6ea44e9SSteven Rostedt 	return 0;
4493d083395SSteven Rostedt }
4503d083395SSteven Rostedt 
451df4fc315SSteven Rostedt static void ftrace_update_pid_func(void)
452df4fc315SSteven Rostedt {
453e3eea140SSteven Rostedt (Red Hat) 	bool enabled = ftrace_pids_enabled();
454e3eea140SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
455e3eea140SSteven Rostedt (Red Hat) 
456491d0dcfSSteven Rostedt 	/* Only do something if we are tracing something */
457df4fc315SSteven Rostedt 	if (ftrace_trace_function == ftrace_stub)
45810dd3ebeSKOSAKI Motohiro 		return;
459df4fc315SSteven Rostedt 
460e3eea140SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
461e3eea140SSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_PID) {
462e3eea140SSteven Rostedt (Red Hat) 			op->func = enabled ? ftrace_pid_func :
463e3eea140SSteven Rostedt (Red Hat) 				op->saved_func;
464e3eea140SSteven Rostedt (Red Hat) 			ftrace_update_trampoline(op);
465e3eea140SSteven Rostedt (Red Hat) 		}
466e3eea140SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
467e3eea140SSteven Rostedt (Red Hat) 
468491d0dcfSSteven Rostedt 	update_ftrace_function();
469df4fc315SSteven Rostedt }
470df4fc315SSteven Rostedt 
471493762fcSSteven Rostedt #ifdef CONFIG_FUNCTION_PROFILER
472493762fcSSteven Rostedt struct ftrace_profile {
473493762fcSSteven Rostedt 	struct hlist_node		node;
474493762fcSSteven Rostedt 	unsigned long			ip;
475493762fcSSteven Rostedt 	unsigned long			counter;
4760706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4770706f1c4SSteven Rostedt 	unsigned long long		time;
478e330b3bcSChase Douglas 	unsigned long long		time_squared;
4790706f1c4SSteven Rostedt #endif
480493762fcSSteven Rostedt };
481493762fcSSteven Rostedt 
482493762fcSSteven Rostedt struct ftrace_profile_page {
483493762fcSSteven Rostedt 	struct ftrace_profile_page	*next;
484493762fcSSteven Rostedt 	unsigned long			index;
485493762fcSSteven Rostedt 	struct ftrace_profile		records[];
486493762fcSSteven Rostedt };
487493762fcSSteven Rostedt 
488cafb168aSSteven Rostedt struct ftrace_profile_stat {
489cafb168aSSteven Rostedt 	atomic_t			disabled;
490cafb168aSSteven Rostedt 	struct hlist_head		*hash;
491cafb168aSSteven Rostedt 	struct ftrace_profile_page	*pages;
492cafb168aSSteven Rostedt 	struct ftrace_profile_page	*start;
493cafb168aSSteven Rostedt 	struct tracer_stat		stat;
494cafb168aSSteven Rostedt };
495cafb168aSSteven Rostedt 
496493762fcSSteven Rostedt #define PROFILE_RECORDS_SIZE						\
497493762fcSSteven Rostedt 	(PAGE_SIZE - offsetof(struct ftrace_profile_page, records))
498493762fcSSteven Rostedt 
499493762fcSSteven Rostedt #define PROFILES_PER_PAGE					\
500493762fcSSteven Rostedt 	(PROFILE_RECORDS_SIZE / sizeof(struct ftrace_profile))
501493762fcSSteven Rostedt 
502fb9fb015SSteven Rostedt static int ftrace_profile_enabled __read_mostly;
503fb9fb015SSteven Rostedt 
504fb9fb015SSteven Rostedt /* ftrace_profile_lock - synchronize the enable and disable of the profiler */
505493762fcSSteven Rostedt static DEFINE_MUTEX(ftrace_profile_lock);
506493762fcSSteven Rostedt 
507cafb168aSSteven Rostedt static DEFINE_PER_CPU(struct ftrace_profile_stat, ftrace_profile_stats);
508493762fcSSteven Rostedt 
50920079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_BITS 10
51020079ebeSNamhyung Kim #define FTRACE_PROFILE_HASH_SIZE (1 << FTRACE_PROFILE_HASH_BITS)
511493762fcSSteven Rostedt 
512493762fcSSteven Rostedt static void *
513493762fcSSteven Rostedt function_stat_next(void *v, int idx)
514493762fcSSteven Rostedt {
515493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
516493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
517493762fcSSteven Rostedt 
518493762fcSSteven Rostedt 	pg = (struct ftrace_profile_page *)((unsigned long)rec & PAGE_MASK);
519493762fcSSteven Rostedt 
520493762fcSSteven Rostedt  again:
5210296e425SLi Zefan 	if (idx != 0)
522493762fcSSteven Rostedt 		rec++;
5230296e425SLi Zefan 
524493762fcSSteven Rostedt 	if ((void *)rec >= (void *)&pg->records[pg->index]) {
525493762fcSSteven Rostedt 		pg = pg->next;
526493762fcSSteven Rostedt 		if (!pg)
527493762fcSSteven Rostedt 			return NULL;
528493762fcSSteven Rostedt 		rec = &pg->records[0];
529493762fcSSteven Rostedt 		if (!rec->counter)
530493762fcSSteven Rostedt 			goto again;
531493762fcSSteven Rostedt 	}
532493762fcSSteven Rostedt 
533493762fcSSteven Rostedt 	return rec;
534493762fcSSteven Rostedt }
535493762fcSSteven Rostedt 
536493762fcSSteven Rostedt static void *function_stat_start(struct tracer_stat *trace)
537493762fcSSteven Rostedt {
538cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat =
539cafb168aSSteven Rostedt 		container_of(trace, struct ftrace_profile_stat, stat);
540cafb168aSSteven Rostedt 
541cafb168aSSteven Rostedt 	if (!stat || !stat->start)
542cafb168aSSteven Rostedt 		return NULL;
543cafb168aSSteven Rostedt 
544cafb168aSSteven Rostedt 	return function_stat_next(&stat->start->records[0], 0);
545493762fcSSteven Rostedt }
546493762fcSSteven Rostedt 
5470706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5480706f1c4SSteven Rostedt /* function graph compares on total time */
5490706f1c4SSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
5500706f1c4SSteven Rostedt {
5510706f1c4SSteven Rostedt 	struct ftrace_profile *a = p1;
5520706f1c4SSteven Rostedt 	struct ftrace_profile *b = p2;
5530706f1c4SSteven Rostedt 
5540706f1c4SSteven Rostedt 	if (a->time < b->time)
5550706f1c4SSteven Rostedt 		return -1;
5560706f1c4SSteven Rostedt 	if (a->time > b->time)
5570706f1c4SSteven Rostedt 		return 1;
5580706f1c4SSteven Rostedt 	else
5590706f1c4SSteven Rostedt 		return 0;
5600706f1c4SSteven Rostedt }
5610706f1c4SSteven Rostedt #else
5620706f1c4SSteven Rostedt /* not function graph compares against hits */
563493762fcSSteven Rostedt static int function_stat_cmp(void *p1, void *p2)
564493762fcSSteven Rostedt {
565493762fcSSteven Rostedt 	struct ftrace_profile *a = p1;
566493762fcSSteven Rostedt 	struct ftrace_profile *b = p2;
567493762fcSSteven Rostedt 
568493762fcSSteven Rostedt 	if (a->counter < b->counter)
569493762fcSSteven Rostedt 		return -1;
570493762fcSSteven Rostedt 	if (a->counter > b->counter)
571493762fcSSteven Rostedt 		return 1;
572493762fcSSteven Rostedt 	else
573493762fcSSteven Rostedt 		return 0;
574493762fcSSteven Rostedt }
5750706f1c4SSteven Rostedt #endif
576493762fcSSteven Rostedt 
577493762fcSSteven Rostedt static int function_stat_headers(struct seq_file *m)
578493762fcSSteven Rostedt {
5790706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
580fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               "
581e330b3bcSChase Douglas 		 "Hit    Time            Avg             s^2\n"
58234886c8bSSteven Rostedt 		    "  --------                               "
583e330b3bcSChase Douglas 		 "---    ----            ---             ---\n");
5840706f1c4SSteven Rostedt #else
585fa6f0cc7SRasmus Villemoes 	seq_puts(m, "  Function                               Hit\n"
586493762fcSSteven Rostedt 		    "  --------                               ---\n");
5870706f1c4SSteven Rostedt #endif
588493762fcSSteven Rostedt 	return 0;
589493762fcSSteven Rostedt }
590493762fcSSteven Rostedt 
591493762fcSSteven Rostedt static int function_stat_show(struct seq_file *m, void *v)
592493762fcSSteven Rostedt {
593493762fcSSteven Rostedt 	struct ftrace_profile *rec = v;
594493762fcSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
5953aaba20fSLi Zefan 	int ret = 0;
5960706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
59734886c8bSSteven Rostedt 	static struct trace_seq s;
59834886c8bSSteven Rostedt 	unsigned long long avg;
599e330b3bcSChase Douglas 	unsigned long long stddev;
6000706f1c4SSteven Rostedt #endif
6013aaba20fSLi Zefan 	mutex_lock(&ftrace_profile_lock);
6023aaba20fSLi Zefan 
6033aaba20fSLi Zefan 	/* we raced with function_profile_reset() */
6043aaba20fSLi Zefan 	if (unlikely(rec->counter == 0)) {
6053aaba20fSLi Zefan 		ret = -EBUSY;
6063aaba20fSLi Zefan 		goto out;
6073aaba20fSLi Zefan 	}
608493762fcSSteven Rostedt 
6098e436ca0SUmesh Tiwari #ifdef CONFIG_FUNCTION_GRAPH_TRACER
6108e436ca0SUmesh Tiwari 	avg = rec->time;
6118e436ca0SUmesh Tiwari 	do_div(avg, rec->counter);
6128e436ca0SUmesh Tiwari 	if (tracing_thresh && (avg < tracing_thresh))
6138e436ca0SUmesh Tiwari 		goto out;
6148e436ca0SUmesh Tiwari #endif
6158e436ca0SUmesh Tiwari 
616493762fcSSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, NULL, str);
6170706f1c4SSteven Rostedt 	seq_printf(m, "  %-30.30s  %10lu", str, rec->counter);
618493762fcSSteven Rostedt 
6190706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
620fa6f0cc7SRasmus Villemoes 	seq_puts(m, "    ");
62134886c8bSSteven Rostedt 
622e330b3bcSChase Douglas 	/* Sample standard deviation (s^2) */
623e330b3bcSChase Douglas 	if (rec->counter <= 1)
624e330b3bcSChase Douglas 		stddev = 0;
625e330b3bcSChase Douglas 	else {
62652d85d76SJuri Lelli 		/*
62752d85d76SJuri Lelli 		 * Apply Welford's method:
62852d85d76SJuri Lelli 		 * s^2 = 1 / (n * (n-1)) * (n * \Sum (x_i)^2 - (\Sum x_i)^2)
62952d85d76SJuri Lelli 		 */
63052d85d76SJuri Lelli 		stddev = rec->counter * rec->time_squared -
63152d85d76SJuri Lelli 			 rec->time * rec->time;
63252d85d76SJuri Lelli 
633e330b3bcSChase Douglas 		/*
634e330b3bcSChase Douglas 		 * Divide only 1000 for ns^2 -> us^2 conversion.
635e330b3bcSChase Douglas 		 * trace_print_graph_duration will divide 1000 again.
636e330b3bcSChase Douglas 		 */
63752d85d76SJuri Lelli 		do_div(stddev, rec->counter * (rec->counter - 1) * 1000);
638e330b3bcSChase Douglas 	}
639e330b3bcSChase Douglas 
64034886c8bSSteven Rostedt 	trace_seq_init(&s);
64134886c8bSSteven Rostedt 	trace_print_graph_duration(rec->time, &s);
64234886c8bSSteven Rostedt 	trace_seq_puts(&s, "    ");
64334886c8bSSteven Rostedt 	trace_print_graph_duration(avg, &s);
644e330b3bcSChase Douglas 	trace_seq_puts(&s, "    ");
645e330b3bcSChase Douglas 	trace_print_graph_duration(stddev, &s);
6460706f1c4SSteven Rostedt 	trace_print_seq(m, &s);
6470706f1c4SSteven Rostedt #endif
6480706f1c4SSteven Rostedt 	seq_putc(m, '\n');
6493aaba20fSLi Zefan out:
6503aaba20fSLi Zefan 	mutex_unlock(&ftrace_profile_lock);
6510706f1c4SSteven Rostedt 
6523aaba20fSLi Zefan 	return ret;
653493762fcSSteven Rostedt }
654493762fcSSteven Rostedt 
655cafb168aSSteven Rostedt static void ftrace_profile_reset(struct ftrace_profile_stat *stat)
656493762fcSSteven Rostedt {
657493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
658493762fcSSteven Rostedt 
659cafb168aSSteven Rostedt 	pg = stat->pages = stat->start;
660493762fcSSteven Rostedt 
661493762fcSSteven Rostedt 	while (pg) {
662493762fcSSteven Rostedt 		memset(pg->records, 0, PROFILE_RECORDS_SIZE);
663493762fcSSteven Rostedt 		pg->index = 0;
664493762fcSSteven Rostedt 		pg = pg->next;
665493762fcSSteven Rostedt 	}
666493762fcSSteven Rostedt 
667cafb168aSSteven Rostedt 	memset(stat->hash, 0,
668493762fcSSteven Rostedt 	       FTRACE_PROFILE_HASH_SIZE * sizeof(struct hlist_head));
669493762fcSSteven Rostedt }
670493762fcSSteven Rostedt 
671cafb168aSSteven Rostedt int ftrace_profile_pages_init(struct ftrace_profile_stat *stat)
672493762fcSSteven Rostedt {
673493762fcSSteven Rostedt 	struct ftrace_profile_page *pg;
674318e0a73SSteven Rostedt 	int functions;
675318e0a73SSteven Rostedt 	int pages;
676493762fcSSteven Rostedt 	int i;
677493762fcSSteven Rostedt 
678493762fcSSteven Rostedt 	/* If we already allocated, do nothing */
679cafb168aSSteven Rostedt 	if (stat->pages)
680493762fcSSteven Rostedt 		return 0;
681493762fcSSteven Rostedt 
682cafb168aSSteven Rostedt 	stat->pages = (void *)get_zeroed_page(GFP_KERNEL);
683cafb168aSSteven Rostedt 	if (!stat->pages)
684493762fcSSteven Rostedt 		return -ENOMEM;
685493762fcSSteven Rostedt 
686318e0a73SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
687318e0a73SSteven Rostedt 	functions = ftrace_update_tot_cnt;
688318e0a73SSteven Rostedt #else
689318e0a73SSteven Rostedt 	/*
690318e0a73SSteven Rostedt 	 * We do not know the number of functions that exist because
691318e0a73SSteven Rostedt 	 * dynamic tracing is what counts them. With past experience
692318e0a73SSteven Rostedt 	 * we have around 20K functions. That should be more than enough.
693318e0a73SSteven Rostedt 	 * It is highly unlikely we will execute every function in
694318e0a73SSteven Rostedt 	 * the kernel.
695318e0a73SSteven Rostedt 	 */
696318e0a73SSteven Rostedt 	functions = 20000;
697318e0a73SSteven Rostedt #endif
698318e0a73SSteven Rostedt 
699cafb168aSSteven Rostedt 	pg = stat->start = stat->pages;
700493762fcSSteven Rostedt 
701318e0a73SSteven Rostedt 	pages = DIV_ROUND_UP(functions, PROFILES_PER_PAGE);
702318e0a73SSteven Rostedt 
70339e30cd1SNamhyung Kim 	for (i = 1; i < pages; i++) {
704493762fcSSteven Rostedt 		pg->next = (void *)get_zeroed_page(GFP_KERNEL);
705493762fcSSteven Rostedt 		if (!pg->next)
706318e0a73SSteven Rostedt 			goto out_free;
707493762fcSSteven Rostedt 		pg = pg->next;
708493762fcSSteven Rostedt 	}
709493762fcSSteven Rostedt 
710493762fcSSteven Rostedt 	return 0;
711318e0a73SSteven Rostedt 
712318e0a73SSteven Rostedt  out_free:
713318e0a73SSteven Rostedt 	pg = stat->start;
714318e0a73SSteven Rostedt 	while (pg) {
715318e0a73SSteven Rostedt 		unsigned long tmp = (unsigned long)pg;
716318e0a73SSteven Rostedt 
717318e0a73SSteven Rostedt 		pg = pg->next;
718318e0a73SSteven Rostedt 		free_page(tmp);
719318e0a73SSteven Rostedt 	}
720318e0a73SSteven Rostedt 
721318e0a73SSteven Rostedt 	stat->pages = NULL;
722318e0a73SSteven Rostedt 	stat->start = NULL;
723318e0a73SSteven Rostedt 
724318e0a73SSteven Rostedt 	return -ENOMEM;
725493762fcSSteven Rostedt }
726493762fcSSteven Rostedt 
727cafb168aSSteven Rostedt static int ftrace_profile_init_cpu(int cpu)
728493762fcSSteven Rostedt {
729cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
730493762fcSSteven Rostedt 	int size;
731493762fcSSteven Rostedt 
732cafb168aSSteven Rostedt 	stat = &per_cpu(ftrace_profile_stats, cpu);
733cafb168aSSteven Rostedt 
734cafb168aSSteven Rostedt 	if (stat->hash) {
735493762fcSSteven Rostedt 		/* If the profile is already created, simply reset it */
736cafb168aSSteven Rostedt 		ftrace_profile_reset(stat);
737493762fcSSteven Rostedt 		return 0;
738493762fcSSteven Rostedt 	}
739493762fcSSteven Rostedt 
740493762fcSSteven Rostedt 	/*
741493762fcSSteven Rostedt 	 * We are profiling all functions, but usually only a few thousand
742493762fcSSteven Rostedt 	 * functions are hit. We'll make a hash of 1024 items.
743493762fcSSteven Rostedt 	 */
744493762fcSSteven Rostedt 	size = FTRACE_PROFILE_HASH_SIZE;
745493762fcSSteven Rostedt 
746cafb168aSSteven Rostedt 	stat->hash = kzalloc(sizeof(struct hlist_head) * size, GFP_KERNEL);
747493762fcSSteven Rostedt 
748cafb168aSSteven Rostedt 	if (!stat->hash)
749493762fcSSteven Rostedt 		return -ENOMEM;
750493762fcSSteven Rostedt 
751318e0a73SSteven Rostedt 	/* Preallocate the function profiling pages */
752cafb168aSSteven Rostedt 	if (ftrace_profile_pages_init(stat) < 0) {
753cafb168aSSteven Rostedt 		kfree(stat->hash);
754cafb168aSSteven Rostedt 		stat->hash = NULL;
755493762fcSSteven Rostedt 		return -ENOMEM;
756493762fcSSteven Rostedt 	}
757493762fcSSteven Rostedt 
758493762fcSSteven Rostedt 	return 0;
759493762fcSSteven Rostedt }
760493762fcSSteven Rostedt 
761cafb168aSSteven Rostedt static int ftrace_profile_init(void)
762cafb168aSSteven Rostedt {
763cafb168aSSteven Rostedt 	int cpu;
764cafb168aSSteven Rostedt 	int ret = 0;
765cafb168aSSteven Rostedt 
766c4602c1cSMiao Xie 	for_each_possible_cpu(cpu) {
767cafb168aSSteven Rostedt 		ret = ftrace_profile_init_cpu(cpu);
768cafb168aSSteven Rostedt 		if (ret)
769cafb168aSSteven Rostedt 			break;
770cafb168aSSteven Rostedt 	}
771cafb168aSSteven Rostedt 
772cafb168aSSteven Rostedt 	return ret;
773cafb168aSSteven Rostedt }
774cafb168aSSteven Rostedt 
775493762fcSSteven Rostedt /* interrupts must be disabled */
776cafb168aSSteven Rostedt static struct ftrace_profile *
777cafb168aSSteven Rostedt ftrace_find_profiled_func(struct ftrace_profile_stat *stat, unsigned long ip)
778493762fcSSteven Rostedt {
779493762fcSSteven Rostedt 	struct ftrace_profile *rec;
780493762fcSSteven Rostedt 	struct hlist_head *hhd;
781493762fcSSteven Rostedt 	unsigned long key;
782493762fcSSteven Rostedt 
78320079ebeSNamhyung Kim 	key = hash_long(ip, FTRACE_PROFILE_HASH_BITS);
784cafb168aSSteven Rostedt 	hhd = &stat->hash[key];
785493762fcSSteven Rostedt 
786493762fcSSteven Rostedt 	if (hlist_empty(hhd))
787493762fcSSteven Rostedt 		return NULL;
788493762fcSSteven Rostedt 
7891bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(rec, hhd, node) {
790493762fcSSteven Rostedt 		if (rec->ip == ip)
791493762fcSSteven Rostedt 			return rec;
792493762fcSSteven Rostedt 	}
793493762fcSSteven Rostedt 
794493762fcSSteven Rostedt 	return NULL;
795493762fcSSteven Rostedt }
796493762fcSSteven Rostedt 
797cafb168aSSteven Rostedt static void ftrace_add_profile(struct ftrace_profile_stat *stat,
798cafb168aSSteven Rostedt 			       struct ftrace_profile *rec)
799493762fcSSteven Rostedt {
800493762fcSSteven Rostedt 	unsigned long key;
801493762fcSSteven Rostedt 
80220079ebeSNamhyung Kim 	key = hash_long(rec->ip, FTRACE_PROFILE_HASH_BITS);
803cafb168aSSteven Rostedt 	hlist_add_head_rcu(&rec->node, &stat->hash[key]);
804493762fcSSteven Rostedt }
805493762fcSSteven Rostedt 
806318e0a73SSteven Rostedt /*
807318e0a73SSteven Rostedt  * The memory is already allocated, this simply finds a new record to use.
808318e0a73SSteven Rostedt  */
809493762fcSSteven Rostedt static struct ftrace_profile *
810318e0a73SSteven Rostedt ftrace_profile_alloc(struct ftrace_profile_stat *stat, unsigned long ip)
811493762fcSSteven Rostedt {
812493762fcSSteven Rostedt 	struct ftrace_profile *rec = NULL;
813493762fcSSteven Rostedt 
814318e0a73SSteven Rostedt 	/* prevent recursion (from NMIs) */
815cafb168aSSteven Rostedt 	if (atomic_inc_return(&stat->disabled) != 1)
816493762fcSSteven Rostedt 		goto out;
817493762fcSSteven Rostedt 
818493762fcSSteven Rostedt 	/*
819318e0a73SSteven Rostedt 	 * Try to find the function again since an NMI
820318e0a73SSteven Rostedt 	 * could have added it
821493762fcSSteven Rostedt 	 */
822cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
823493762fcSSteven Rostedt 	if (rec)
824cafb168aSSteven Rostedt 		goto out;
825493762fcSSteven Rostedt 
826cafb168aSSteven Rostedt 	if (stat->pages->index == PROFILES_PER_PAGE) {
827cafb168aSSteven Rostedt 		if (!stat->pages->next)
828cafb168aSSteven Rostedt 			goto out;
829cafb168aSSteven Rostedt 		stat->pages = stat->pages->next;
830493762fcSSteven Rostedt 	}
831493762fcSSteven Rostedt 
832cafb168aSSteven Rostedt 	rec = &stat->pages->records[stat->pages->index++];
833493762fcSSteven Rostedt 	rec->ip = ip;
834cafb168aSSteven Rostedt 	ftrace_add_profile(stat, rec);
835493762fcSSteven Rostedt 
836493762fcSSteven Rostedt  out:
837cafb168aSSteven Rostedt 	atomic_dec(&stat->disabled);
838493762fcSSteven Rostedt 
839493762fcSSteven Rostedt 	return rec;
840493762fcSSteven Rostedt }
841493762fcSSteven Rostedt 
842493762fcSSteven Rostedt static void
8432f5f6ad9SSteven Rostedt function_profile_call(unsigned long ip, unsigned long parent_ip,
844a1e2e31dSSteven Rostedt 		      struct ftrace_ops *ops, struct pt_regs *regs)
845493762fcSSteven Rostedt {
846cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
847493762fcSSteven Rostedt 	struct ftrace_profile *rec;
848493762fcSSteven Rostedt 	unsigned long flags;
849493762fcSSteven Rostedt 
850493762fcSSteven Rostedt 	if (!ftrace_profile_enabled)
851493762fcSSteven Rostedt 		return;
852493762fcSSteven Rostedt 
853493762fcSSteven Rostedt 	local_irq_save(flags);
854cafb168aSSteven Rostedt 
855bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8560f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
857cafb168aSSteven Rostedt 		goto out;
858cafb168aSSteven Rostedt 
859cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, ip);
860493762fcSSteven Rostedt 	if (!rec) {
861318e0a73SSteven Rostedt 		rec = ftrace_profile_alloc(stat, ip);
862493762fcSSteven Rostedt 		if (!rec)
863493762fcSSteven Rostedt 			goto out;
864493762fcSSteven Rostedt 	}
865493762fcSSteven Rostedt 
866493762fcSSteven Rostedt 	rec->counter++;
867493762fcSSteven Rostedt  out:
868493762fcSSteven Rostedt 	local_irq_restore(flags);
869493762fcSSteven Rostedt }
870493762fcSSteven Rostedt 
8710706f1c4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
8720706f1c4SSteven Rostedt static int profile_graph_entry(struct ftrace_graph_ent *trace)
8730706f1c4SSteven Rostedt {
874a1e2e31dSSteven Rostedt 	function_profile_call(trace->func, 0, NULL, NULL);
8750706f1c4SSteven Rostedt 	return 1;
8760706f1c4SSteven Rostedt }
8770706f1c4SSteven Rostedt 
8780706f1c4SSteven Rostedt static void profile_graph_return(struct ftrace_graph_ret *trace)
8790706f1c4SSteven Rostedt {
880cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
881a2a16d6aSSteven Rostedt 	unsigned long long calltime;
8820706f1c4SSteven Rostedt 	struct ftrace_profile *rec;
883cafb168aSSteven Rostedt 	unsigned long flags;
8840706f1c4SSteven Rostedt 
8850706f1c4SSteven Rostedt 	local_irq_save(flags);
886bdffd893SChristoph Lameter 	stat = this_cpu_ptr(&ftrace_profile_stats);
8870f6ce3deSSteven Rostedt 	if (!stat->hash || !ftrace_profile_enabled)
888cafb168aSSteven Rostedt 		goto out;
889cafb168aSSteven Rostedt 
89037e44bc5SSteven Rostedt 	/* If the calltime was zero'd ignore it */
89137e44bc5SSteven Rostedt 	if (!trace->calltime)
89237e44bc5SSteven Rostedt 		goto out;
89337e44bc5SSteven Rostedt 
894a2a16d6aSSteven Rostedt 	calltime = trace->rettime - trace->calltime;
895a2a16d6aSSteven Rostedt 
89655577204SSteven Rostedt (Red Hat) 	if (!fgraph_graph_time) {
897a2a16d6aSSteven Rostedt 		int index;
898a2a16d6aSSteven Rostedt 
899a2a16d6aSSteven Rostedt 		index = trace->depth;
900a2a16d6aSSteven Rostedt 
901a2a16d6aSSteven Rostedt 		/* Append this call time to the parent time to subtract */
902a2a16d6aSSteven Rostedt 		if (index)
903a2a16d6aSSteven Rostedt 			current->ret_stack[index - 1].subtime += calltime;
904a2a16d6aSSteven Rostedt 
905a2a16d6aSSteven Rostedt 		if (current->ret_stack[index].subtime < calltime)
906a2a16d6aSSteven Rostedt 			calltime -= current->ret_stack[index].subtime;
907a2a16d6aSSteven Rostedt 		else
908a2a16d6aSSteven Rostedt 			calltime = 0;
909a2a16d6aSSteven Rostedt 	}
910a2a16d6aSSteven Rostedt 
911cafb168aSSteven Rostedt 	rec = ftrace_find_profiled_func(stat, trace->func);
912e330b3bcSChase Douglas 	if (rec) {
913a2a16d6aSSteven Rostedt 		rec->time += calltime;
914e330b3bcSChase Douglas 		rec->time_squared += calltime * calltime;
915e330b3bcSChase Douglas 	}
916a2a16d6aSSteven Rostedt 
917cafb168aSSteven Rostedt  out:
9180706f1c4SSteven Rostedt 	local_irq_restore(flags);
9190706f1c4SSteven Rostedt }
9200706f1c4SSteven Rostedt 
9210706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9220706f1c4SSteven Rostedt {
9230706f1c4SSteven Rostedt 	return register_ftrace_graph(&profile_graph_return,
9240706f1c4SSteven Rostedt 				     &profile_graph_entry);
9250706f1c4SSteven Rostedt }
9260706f1c4SSteven Rostedt 
9270706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9280706f1c4SSteven Rostedt {
9290706f1c4SSteven Rostedt 	unregister_ftrace_graph();
9300706f1c4SSteven Rostedt }
9310706f1c4SSteven Rostedt #else
932bd38c0e6SPaul McQuade static struct ftrace_ops ftrace_profile_ops __read_mostly = {
933493762fcSSteven Rostedt 	.func		= function_profile_call,
934f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_RECURSION_SAFE | FTRACE_OPS_FL_INITIALIZED,
93533b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(ftrace_profile_ops)
936493762fcSSteven Rostedt };
937493762fcSSteven Rostedt 
9380706f1c4SSteven Rostedt static int register_ftrace_profiler(void)
9390706f1c4SSteven Rostedt {
9400706f1c4SSteven Rostedt 	return register_ftrace_function(&ftrace_profile_ops);
9410706f1c4SSteven Rostedt }
9420706f1c4SSteven Rostedt 
9430706f1c4SSteven Rostedt static void unregister_ftrace_profiler(void)
9440706f1c4SSteven Rostedt {
9450706f1c4SSteven Rostedt 	unregister_ftrace_function(&ftrace_profile_ops);
9460706f1c4SSteven Rostedt }
9470706f1c4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
9480706f1c4SSteven Rostedt 
949493762fcSSteven Rostedt static ssize_t
950493762fcSSteven Rostedt ftrace_profile_write(struct file *filp, const char __user *ubuf,
951493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
952493762fcSSteven Rostedt {
953493762fcSSteven Rostedt 	unsigned long val;
954493762fcSSteven Rostedt 	int ret;
955493762fcSSteven Rostedt 
95622fe9b54SPeter Huewe 	ret = kstrtoul_from_user(ubuf, cnt, 10, &val);
95722fe9b54SPeter Huewe 	if (ret)
958493762fcSSteven Rostedt 		return ret;
959493762fcSSteven Rostedt 
960493762fcSSteven Rostedt 	val = !!val;
961493762fcSSteven Rostedt 
962493762fcSSteven Rostedt 	mutex_lock(&ftrace_profile_lock);
963493762fcSSteven Rostedt 	if (ftrace_profile_enabled ^ val) {
964493762fcSSteven Rostedt 		if (val) {
965493762fcSSteven Rostedt 			ret = ftrace_profile_init();
966493762fcSSteven Rostedt 			if (ret < 0) {
967493762fcSSteven Rostedt 				cnt = ret;
968493762fcSSteven Rostedt 				goto out;
969493762fcSSteven Rostedt 			}
970493762fcSSteven Rostedt 
9710706f1c4SSteven Rostedt 			ret = register_ftrace_profiler();
9720706f1c4SSteven Rostedt 			if (ret < 0) {
9730706f1c4SSteven Rostedt 				cnt = ret;
9740706f1c4SSteven Rostedt 				goto out;
9750706f1c4SSteven Rostedt 			}
976493762fcSSteven Rostedt 			ftrace_profile_enabled = 1;
977493762fcSSteven Rostedt 		} else {
978493762fcSSteven Rostedt 			ftrace_profile_enabled = 0;
9790f6ce3deSSteven Rostedt 			/*
9800f6ce3deSSteven Rostedt 			 * unregister_ftrace_profiler calls stop_machine
9810f6ce3deSSteven Rostedt 			 * so this acts like an synchronize_sched.
9820f6ce3deSSteven Rostedt 			 */
9830706f1c4SSteven Rostedt 			unregister_ftrace_profiler();
984493762fcSSteven Rostedt 		}
985493762fcSSteven Rostedt 	}
986493762fcSSteven Rostedt  out:
987493762fcSSteven Rostedt 	mutex_unlock(&ftrace_profile_lock);
988493762fcSSteven Rostedt 
989cf8517cfSJiri Olsa 	*ppos += cnt;
990493762fcSSteven Rostedt 
991493762fcSSteven Rostedt 	return cnt;
992493762fcSSteven Rostedt }
993493762fcSSteven Rostedt 
994493762fcSSteven Rostedt static ssize_t
995493762fcSSteven Rostedt ftrace_profile_read(struct file *filp, char __user *ubuf,
996493762fcSSteven Rostedt 		     size_t cnt, loff_t *ppos)
997493762fcSSteven Rostedt {
998fb9fb015SSteven Rostedt 	char buf[64];		/* big enough to hold a number */
999493762fcSSteven Rostedt 	int r;
1000493762fcSSteven Rostedt 
1001493762fcSSteven Rostedt 	r = sprintf(buf, "%u\n", ftrace_profile_enabled);
1002493762fcSSteven Rostedt 	return simple_read_from_buffer(ubuf, cnt, ppos, buf, r);
1003493762fcSSteven Rostedt }
1004493762fcSSteven Rostedt 
1005493762fcSSteven Rostedt static const struct file_operations ftrace_profile_fops = {
1006493762fcSSteven Rostedt 	.open		= tracing_open_generic,
1007493762fcSSteven Rostedt 	.read		= ftrace_profile_read,
1008493762fcSSteven Rostedt 	.write		= ftrace_profile_write,
10096038f373SArnd Bergmann 	.llseek		= default_llseek,
1010493762fcSSteven Rostedt };
1011493762fcSSteven Rostedt 
1012cafb168aSSteven Rostedt /* used to initialize the real stat files */
1013cafb168aSSteven Rostedt static struct tracer_stat function_stats __initdata = {
1014cafb168aSSteven Rostedt 	.name		= "functions",
1015cafb168aSSteven Rostedt 	.stat_start	= function_stat_start,
1016cafb168aSSteven Rostedt 	.stat_next	= function_stat_next,
1017cafb168aSSteven Rostedt 	.stat_cmp	= function_stat_cmp,
1018cafb168aSSteven Rostedt 	.stat_headers	= function_stat_headers,
1019cafb168aSSteven Rostedt 	.stat_show	= function_stat_show
1020cafb168aSSteven Rostedt };
1021cafb168aSSteven Rostedt 
10228434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1023493762fcSSteven Rostedt {
1024cafb168aSSteven Rostedt 	struct ftrace_profile_stat *stat;
1025493762fcSSteven Rostedt 	struct dentry *entry;
1026cafb168aSSteven Rostedt 	char *name;
1027493762fcSSteven Rostedt 	int ret;
1028cafb168aSSteven Rostedt 	int cpu;
1029493762fcSSteven Rostedt 
1030cafb168aSSteven Rostedt 	for_each_possible_cpu(cpu) {
1031cafb168aSSteven Rostedt 		stat = &per_cpu(ftrace_profile_stats, cpu);
1032cafb168aSSteven Rostedt 
1033cafb168aSSteven Rostedt 		/* allocate enough for function name + cpu number */
1034cafb168aSSteven Rostedt 		name = kmalloc(32, GFP_KERNEL);
1035cafb168aSSteven Rostedt 		if (!name) {
1036cafb168aSSteven Rostedt 			/*
1037cafb168aSSteven Rostedt 			 * The files created are permanent, if something happens
1038cafb168aSSteven Rostedt 			 * we still do not free memory.
1039cafb168aSSteven Rostedt 			 */
1040cafb168aSSteven Rostedt 			WARN(1,
1041cafb168aSSteven Rostedt 			     "Could not allocate stat file for cpu %d\n",
1042cafb168aSSteven Rostedt 			     cpu);
1043493762fcSSteven Rostedt 			return;
1044493762fcSSteven Rostedt 		}
1045cafb168aSSteven Rostedt 		stat->stat = function_stats;
1046cafb168aSSteven Rostedt 		snprintf(name, 32, "function%d", cpu);
1047cafb168aSSteven Rostedt 		stat->stat.name = name;
1048cafb168aSSteven Rostedt 		ret = register_stat_tracer(&stat->stat);
1049cafb168aSSteven Rostedt 		if (ret) {
1050cafb168aSSteven Rostedt 			WARN(1,
1051cafb168aSSteven Rostedt 			     "Could not register function stat for cpu %d\n",
1052cafb168aSSteven Rostedt 			     cpu);
1053cafb168aSSteven Rostedt 			kfree(name);
1054cafb168aSSteven Rostedt 			return;
1055cafb168aSSteven Rostedt 		}
1056cafb168aSSteven Rostedt 	}
1057493762fcSSteven Rostedt 
10588434dc93SSteven Rostedt (Red Hat) 	entry = tracefs_create_file("function_profile_enabled", 0644,
1059493762fcSSteven Rostedt 				    d_tracer, NULL, &ftrace_profile_fops);
1060493762fcSSteven Rostedt 	if (!entry)
10618434dc93SSteven Rostedt (Red Hat) 		pr_warning("Could not create tracefs "
1062493762fcSSteven Rostedt 			   "'function_profile_enabled' entry\n");
1063493762fcSSteven Rostedt }
1064493762fcSSteven Rostedt 
1065493762fcSSteven Rostedt #else /* CONFIG_FUNCTION_PROFILER */
10668434dc93SSteven Rostedt (Red Hat) static __init void ftrace_profile_tracefs(struct dentry *d_tracer)
1067493762fcSSteven Rostedt {
1068493762fcSSteven Rostedt }
1069493762fcSSteven Rostedt #endif /* CONFIG_FUNCTION_PROFILER */
1070493762fcSSteven Rostedt 
107173d3fd96SIngo Molnar static struct pid * const ftrace_swapper_pid = &init_struct_pid;
107273d3fd96SIngo Molnar 
10731619dc3fSPratyush Anand #ifdef CONFIG_FUNCTION_GRAPH_TRACER
10741619dc3fSPratyush Anand static int ftrace_graph_active;
10751619dc3fSPratyush Anand #else
10761619dc3fSPratyush Anand # define ftrace_graph_active 0
10771619dc3fSPratyush Anand #endif
10781619dc3fSPratyush Anand 
10793d083395SSteven Rostedt #ifdef CONFIG_DYNAMIC_FTRACE
108073d3fd96SIngo Molnar 
108179922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *removed_ops;
108279922b80SSteven Rostedt (Red Hat) 
1083e1effa01SSteven Rostedt (Red Hat) /*
1084e1effa01SSteven Rostedt (Red Hat)  * Set when doing a global update, like enabling all recs or disabling them.
1085e1effa01SSteven Rostedt (Red Hat)  * It is not set when just updating a single ftrace_ops.
1086e1effa01SSteven Rostedt (Red Hat)  */
1087e1effa01SSteven Rostedt (Red Hat) static bool update_all_ops;
1088e1effa01SSteven Rostedt (Red Hat) 
108999ecdc43SSteven Rostedt #ifndef CONFIG_FTRACE_MCOUNT_RECORD
1090cb7be3b2SSteven Rostedt # error Dynamic ftrace depends on MCOUNT_RECORD
109199ecdc43SSteven Rostedt #endif
109299ecdc43SSteven Rostedt 
10938fc0c701SSteven Rostedt static struct hlist_head ftrace_func_hash[FTRACE_FUNC_HASHSIZE] __read_mostly;
10948fc0c701SSteven Rostedt 
1095b6887d79SSteven Rostedt struct ftrace_func_probe {
10968fc0c701SSteven Rostedt 	struct hlist_node	node;
1097b6887d79SSteven Rostedt 	struct ftrace_probe_ops	*ops;
10988fc0c701SSteven Rostedt 	unsigned long		flags;
10998fc0c701SSteven Rostedt 	unsigned long		ip;
11008fc0c701SSteven Rostedt 	void			*data;
11017818b388SSteven Rostedt (Red Hat) 	struct list_head	free_list;
11028fc0c701SSteven Rostedt };
11038fc0c701SSteven Rostedt 
1104b448c4e3SSteven Rostedt struct ftrace_func_entry {
1105b448c4e3SSteven Rostedt 	struct hlist_node hlist;
1106b448c4e3SSteven Rostedt 	unsigned long ip;
1107b448c4e3SSteven Rostedt };
1108b448c4e3SSteven Rostedt 
1109b448c4e3SSteven Rostedt struct ftrace_hash {
1110b448c4e3SSteven Rostedt 	unsigned long		size_bits;
1111b448c4e3SSteven Rostedt 	struct hlist_head	*buckets;
1112b448c4e3SSteven Rostedt 	unsigned long		count;
111307fd5515SSteven Rostedt 	struct rcu_head		rcu;
1114b448c4e3SSteven Rostedt };
1115b448c4e3SSteven Rostedt 
111633dc9b12SSteven Rostedt /*
111733dc9b12SSteven Rostedt  * We make these constant because no one should touch them,
111833dc9b12SSteven Rostedt  * but they are used as the default "empty hash", to avoid allocating
111933dc9b12SSteven Rostedt  * it all the time. These are in a read only section such that if
112033dc9b12SSteven Rostedt  * anyone does try to modify it, it will cause an exception.
112133dc9b12SSteven Rostedt  */
112233dc9b12SSteven Rostedt static const struct hlist_head empty_buckets[1];
112333dc9b12SSteven Rostedt static const struct ftrace_hash empty_hash = {
112433dc9b12SSteven Rostedt 	.buckets = (struct hlist_head *)empty_buckets,
1125b448c4e3SSteven Rostedt };
112633dc9b12SSteven Rostedt #define EMPTY_HASH	((struct ftrace_hash *)&empty_hash)
11275072c59fSSteven Rostedt 
11282b499381SSteven Rostedt static struct ftrace_ops global_ops = {
1129f45948e8SSteven Rostedt 	.func				= ftrace_stub,
113033b7f99cSSteven Rostedt (Red Hat) 	.local_hash.notrace_hash	= EMPTY_HASH,
113133b7f99cSSteven Rostedt (Red Hat) 	.local_hash.filter_hash		= EMPTY_HASH,
113233b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(global_ops)
113333b7f99cSSteven Rostedt (Red Hat) 	.flags				= FTRACE_OPS_FL_RECURSION_SAFE |
1134e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_INITIALIZED |
1135e3eea140SSteven Rostedt (Red Hat) 					  FTRACE_OPS_FL_PID,
1136f45948e8SSteven Rostedt };
1137f45948e8SSteven Rostedt 
1138aec0be2dSSteven Rostedt (Red Hat) /*
1139aec0be2dSSteven Rostedt (Red Hat)  * This is used by __kernel_text_address() to return true if the
11400af26492SSteven Rostedt (Red Hat)  * address is on a dynamically allocated trampoline that would
1141aec0be2dSSteven Rostedt (Red Hat)  * not return true for either core_kernel_text() or
1142aec0be2dSSteven Rostedt (Red Hat)  * is_module_text_address().
1143aec0be2dSSteven Rostedt (Red Hat)  */
1144aec0be2dSSteven Rostedt (Red Hat) bool is_ftrace_trampoline(unsigned long addr)
1145aec0be2dSSteven Rostedt (Red Hat) {
1146aec0be2dSSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
1147aec0be2dSSteven Rostedt (Red Hat) 	bool ret = false;
1148aec0be2dSSteven Rostedt (Red Hat) 
1149aec0be2dSSteven Rostedt (Red Hat) 	/*
1150aec0be2dSSteven Rostedt (Red Hat) 	 * Some of the ops may be dynamically allocated,
1151aec0be2dSSteven Rostedt (Red Hat) 	 * they are freed after a synchronize_sched().
1152aec0be2dSSteven Rostedt (Red Hat) 	 */
1153aec0be2dSSteven Rostedt (Red Hat) 	preempt_disable_notrace();
1154aec0be2dSSteven Rostedt (Red Hat) 
1155aec0be2dSSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
1156aec0be2dSSteven Rostedt (Red Hat) 		/*
1157aec0be2dSSteven Rostedt (Red Hat) 		 * This is to check for dynamically allocated trampolines.
1158aec0be2dSSteven Rostedt (Red Hat) 		 * Trampolines that are in kernel text will have
1159aec0be2dSSteven Rostedt (Red Hat) 		 * core_kernel_text() return true.
1160aec0be2dSSteven Rostedt (Red Hat) 		 */
1161aec0be2dSSteven Rostedt (Red Hat) 		if (op->trampoline && op->trampoline_size)
1162aec0be2dSSteven Rostedt (Red Hat) 			if (addr >= op->trampoline &&
1163aec0be2dSSteven Rostedt (Red Hat) 			    addr < op->trampoline + op->trampoline_size) {
1164aec0be2dSSteven Rostedt (Red Hat) 				ret = true;
1165aec0be2dSSteven Rostedt (Red Hat) 				goto out;
1166aec0be2dSSteven Rostedt (Red Hat) 			}
1167aec0be2dSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
1168aec0be2dSSteven Rostedt (Red Hat) 
1169aec0be2dSSteven Rostedt (Red Hat)  out:
1170aec0be2dSSteven Rostedt (Red Hat) 	preempt_enable_notrace();
1171aec0be2dSSteven Rostedt (Red Hat) 
1172aec0be2dSSteven Rostedt (Red Hat) 	return ret;
1173aec0be2dSSteven Rostedt (Red Hat) }
1174aec0be2dSSteven Rostedt (Red Hat) 
11753c1720f0SSteven Rostedt struct ftrace_page {
11763c1720f0SSteven Rostedt 	struct ftrace_page	*next;
1177a7900875SSteven Rostedt 	struct dyn_ftrace	*records;
1178431aa3fbSSteven Rostedt 	int			index;
1179a7900875SSteven Rostedt 	int			size;
1180aa5e5ceaSDavid Miller };
11813c1720f0SSteven Rostedt 
1182a7900875SSteven Rostedt #define ENTRY_SIZE sizeof(struct dyn_ftrace)
1183a7900875SSteven Rostedt #define ENTRIES_PER_PAGE (PAGE_SIZE / ENTRY_SIZE)
11843c1720f0SSteven Rostedt 
11853c1720f0SSteven Rostedt /* estimate from running different kernels */
11863c1720f0SSteven Rostedt #define NR_TO_INIT		10000
11873c1720f0SSteven Rostedt 
11883c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages_start;
11893c1720f0SSteven Rostedt static struct ftrace_page	*ftrace_pages;
11903c1720f0SSteven Rostedt 
119168f40969SSteven Rostedt (Red Hat) static bool __always_inline ftrace_hash_empty(struct ftrace_hash *hash)
119206a51d93SSteven Rostedt {
119306a51d93SSteven Rostedt 	return !hash || !hash->count;
119406a51d93SSteven Rostedt }
119506a51d93SSteven Rostedt 
1196b448c4e3SSteven Rostedt static struct ftrace_func_entry *
1197b448c4e3SSteven Rostedt ftrace_lookup_ip(struct ftrace_hash *hash, unsigned long ip)
1198b448c4e3SSteven Rostedt {
1199b448c4e3SSteven Rostedt 	unsigned long key;
1200b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1201b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1202b448c4e3SSteven Rostedt 
120306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
1204b448c4e3SSteven Rostedt 		return NULL;
1205b448c4e3SSteven Rostedt 
1206b448c4e3SSteven Rostedt 	if (hash->size_bits > 0)
1207b448c4e3SSteven Rostedt 		key = hash_long(ip, hash->size_bits);
1208b448c4e3SSteven Rostedt 	else
1209b448c4e3SSteven Rostedt 		key = 0;
1210b448c4e3SSteven Rostedt 
1211b448c4e3SSteven Rostedt 	hhd = &hash->buckets[key];
1212b448c4e3SSteven Rostedt 
12131bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, hlist) {
1214b448c4e3SSteven Rostedt 		if (entry->ip == ip)
1215b448c4e3SSteven Rostedt 			return entry;
1216b448c4e3SSteven Rostedt 	}
1217b448c4e3SSteven Rostedt 	return NULL;
1218b448c4e3SSteven Rostedt }
1219b448c4e3SSteven Rostedt 
122033dc9b12SSteven Rostedt static void __add_hash_entry(struct ftrace_hash *hash,
122133dc9b12SSteven Rostedt 			     struct ftrace_func_entry *entry)
122233dc9b12SSteven Rostedt {
122333dc9b12SSteven Rostedt 	struct hlist_head *hhd;
122433dc9b12SSteven Rostedt 	unsigned long key;
122533dc9b12SSteven Rostedt 
122633dc9b12SSteven Rostedt 	if (hash->size_bits)
122733dc9b12SSteven Rostedt 		key = hash_long(entry->ip, hash->size_bits);
122833dc9b12SSteven Rostedt 	else
122933dc9b12SSteven Rostedt 		key = 0;
123033dc9b12SSteven Rostedt 
123133dc9b12SSteven Rostedt 	hhd = &hash->buckets[key];
123233dc9b12SSteven Rostedt 	hlist_add_head(&entry->hlist, hhd);
123333dc9b12SSteven Rostedt 	hash->count++;
123433dc9b12SSteven Rostedt }
123533dc9b12SSteven Rostedt 
1236b448c4e3SSteven Rostedt static int add_hash_entry(struct ftrace_hash *hash, unsigned long ip)
1237b448c4e3SSteven Rostedt {
1238b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1239b448c4e3SSteven Rostedt 
1240b448c4e3SSteven Rostedt 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
1241b448c4e3SSteven Rostedt 	if (!entry)
1242b448c4e3SSteven Rostedt 		return -ENOMEM;
1243b448c4e3SSteven Rostedt 
1244b448c4e3SSteven Rostedt 	entry->ip = ip;
124533dc9b12SSteven Rostedt 	__add_hash_entry(hash, entry);
1246b448c4e3SSteven Rostedt 
1247b448c4e3SSteven Rostedt 	return 0;
1248b448c4e3SSteven Rostedt }
1249b448c4e3SSteven Rostedt 
1250b448c4e3SSteven Rostedt static void
125133dc9b12SSteven Rostedt free_hash_entry(struct ftrace_hash *hash,
125233dc9b12SSteven Rostedt 		  struct ftrace_func_entry *entry)
125333dc9b12SSteven Rostedt {
125433dc9b12SSteven Rostedt 	hlist_del(&entry->hlist);
125533dc9b12SSteven Rostedt 	kfree(entry);
125633dc9b12SSteven Rostedt 	hash->count--;
125733dc9b12SSteven Rostedt }
125833dc9b12SSteven Rostedt 
125933dc9b12SSteven Rostedt static void
1260b448c4e3SSteven Rostedt remove_hash_entry(struct ftrace_hash *hash,
1261b448c4e3SSteven Rostedt 		  struct ftrace_func_entry *entry)
1262b448c4e3SSteven Rostedt {
1263b448c4e3SSteven Rostedt 	hlist_del(&entry->hlist);
1264b448c4e3SSteven Rostedt 	hash->count--;
1265b448c4e3SSteven Rostedt }
1266b448c4e3SSteven Rostedt 
1267b448c4e3SSteven Rostedt static void ftrace_hash_clear(struct ftrace_hash *hash)
1268b448c4e3SSteven Rostedt {
1269b448c4e3SSteven Rostedt 	struct hlist_head *hhd;
1270b67bfe0dSSasha Levin 	struct hlist_node *tn;
1271b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
1272b448c4e3SSteven Rostedt 	int size = 1 << hash->size_bits;
1273b448c4e3SSteven Rostedt 	int i;
1274b448c4e3SSteven Rostedt 
127533dc9b12SSteven Rostedt 	if (!hash->count)
127633dc9b12SSteven Rostedt 		return;
127733dc9b12SSteven Rostedt 
1278b448c4e3SSteven Rostedt 	for (i = 0; i < size; i++) {
1279b448c4e3SSteven Rostedt 		hhd = &hash->buckets[i];
1280b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist)
128133dc9b12SSteven Rostedt 			free_hash_entry(hash, entry);
1282b448c4e3SSteven Rostedt 	}
1283b448c4e3SSteven Rostedt 	FTRACE_WARN_ON(hash->count);
1284b448c4e3SSteven Rostedt }
1285b448c4e3SSteven Rostedt 
128633dc9b12SSteven Rostedt static void free_ftrace_hash(struct ftrace_hash *hash)
128733dc9b12SSteven Rostedt {
128833dc9b12SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
128933dc9b12SSteven Rostedt 		return;
129033dc9b12SSteven Rostedt 	ftrace_hash_clear(hash);
129133dc9b12SSteven Rostedt 	kfree(hash->buckets);
129233dc9b12SSteven Rostedt 	kfree(hash);
129333dc9b12SSteven Rostedt }
129433dc9b12SSteven Rostedt 
129507fd5515SSteven Rostedt static void __free_ftrace_hash_rcu(struct rcu_head *rcu)
129607fd5515SSteven Rostedt {
129707fd5515SSteven Rostedt 	struct ftrace_hash *hash;
129807fd5515SSteven Rostedt 
129907fd5515SSteven Rostedt 	hash = container_of(rcu, struct ftrace_hash, rcu);
130007fd5515SSteven Rostedt 	free_ftrace_hash(hash);
130107fd5515SSteven Rostedt }
130207fd5515SSteven Rostedt 
130307fd5515SSteven Rostedt static void free_ftrace_hash_rcu(struct ftrace_hash *hash)
130407fd5515SSteven Rostedt {
130507fd5515SSteven Rostedt 	if (!hash || hash == EMPTY_HASH)
130607fd5515SSteven Rostedt 		return;
130707fd5515SSteven Rostedt 	call_rcu_sched(&hash->rcu, __free_ftrace_hash_rcu);
130807fd5515SSteven Rostedt }
130907fd5515SSteven Rostedt 
13105500fa51SJiri Olsa void ftrace_free_filter(struct ftrace_ops *ops)
13115500fa51SJiri Olsa {
1312f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
131333b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->filter_hash);
131433b7f99cSSteven Rostedt (Red Hat) 	free_ftrace_hash(ops->func_hash->notrace_hash);
13155500fa51SJiri Olsa }
13165500fa51SJiri Olsa 
131733dc9b12SSteven Rostedt static struct ftrace_hash *alloc_ftrace_hash(int size_bits)
131833dc9b12SSteven Rostedt {
131933dc9b12SSteven Rostedt 	struct ftrace_hash *hash;
132033dc9b12SSteven Rostedt 	int size;
132133dc9b12SSteven Rostedt 
132233dc9b12SSteven Rostedt 	hash = kzalloc(sizeof(*hash), GFP_KERNEL);
132333dc9b12SSteven Rostedt 	if (!hash)
132433dc9b12SSteven Rostedt 		return NULL;
132533dc9b12SSteven Rostedt 
132633dc9b12SSteven Rostedt 	size = 1 << size_bits;
132747b0edcbSThomas Meyer 	hash->buckets = kcalloc(size, sizeof(*hash->buckets), GFP_KERNEL);
132833dc9b12SSteven Rostedt 
132933dc9b12SSteven Rostedt 	if (!hash->buckets) {
133033dc9b12SSteven Rostedt 		kfree(hash);
133133dc9b12SSteven Rostedt 		return NULL;
133233dc9b12SSteven Rostedt 	}
133333dc9b12SSteven Rostedt 
133433dc9b12SSteven Rostedt 	hash->size_bits = size_bits;
133533dc9b12SSteven Rostedt 
133633dc9b12SSteven Rostedt 	return hash;
133733dc9b12SSteven Rostedt }
133833dc9b12SSteven Rostedt 
133933dc9b12SSteven Rostedt static struct ftrace_hash *
134033dc9b12SSteven Rostedt alloc_and_copy_ftrace_hash(int size_bits, struct ftrace_hash *hash)
134133dc9b12SSteven Rostedt {
134233dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
134333dc9b12SSteven Rostedt 	struct ftrace_hash *new_hash;
134433dc9b12SSteven Rostedt 	int size;
134533dc9b12SSteven Rostedt 	int ret;
134633dc9b12SSteven Rostedt 	int i;
134733dc9b12SSteven Rostedt 
134833dc9b12SSteven Rostedt 	new_hash = alloc_ftrace_hash(size_bits);
134933dc9b12SSteven Rostedt 	if (!new_hash)
135033dc9b12SSteven Rostedt 		return NULL;
135133dc9b12SSteven Rostedt 
135233dc9b12SSteven Rostedt 	/* Empty hash? */
135306a51d93SSteven Rostedt 	if (ftrace_hash_empty(hash))
135433dc9b12SSteven Rostedt 		return new_hash;
135533dc9b12SSteven Rostedt 
135633dc9b12SSteven Rostedt 	size = 1 << hash->size_bits;
135733dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
1358b67bfe0dSSasha Levin 		hlist_for_each_entry(entry, &hash->buckets[i], hlist) {
135933dc9b12SSteven Rostedt 			ret = add_hash_entry(new_hash, entry->ip);
136033dc9b12SSteven Rostedt 			if (ret < 0)
136133dc9b12SSteven Rostedt 				goto free_hash;
136233dc9b12SSteven Rostedt 		}
136333dc9b12SSteven Rostedt 	}
136433dc9b12SSteven Rostedt 
136533dc9b12SSteven Rostedt 	FTRACE_WARN_ON(new_hash->count != hash->count);
136633dc9b12SSteven Rostedt 
136733dc9b12SSteven Rostedt 	return new_hash;
136833dc9b12SSteven Rostedt 
136933dc9b12SSteven Rostedt  free_hash:
137033dc9b12SSteven Rostedt 	free_ftrace_hash(new_hash);
137133dc9b12SSteven Rostedt 	return NULL;
137233dc9b12SSteven Rostedt }
137333dc9b12SSteven Rostedt 
137441fb61c2SSteven Rostedt static void
137584261912SSteven Rostedt (Red Hat) ftrace_hash_rec_disable_modify(struct ftrace_ops *ops, int filter_hash);
137641fb61c2SSteven Rostedt static void
137784261912SSteven Rostedt (Red Hat) ftrace_hash_rec_enable_modify(struct ftrace_ops *ops, int filter_hash);
137841fb61c2SSteven Rostedt 
1379f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1380f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash);
1381f8b8be8aSMasami Hiramatsu 
138233dc9b12SSteven Rostedt static int
138341fb61c2SSteven Rostedt ftrace_hash_move(struct ftrace_ops *ops, int enable,
138441fb61c2SSteven Rostedt 		 struct ftrace_hash **dst, struct ftrace_hash *src)
138533dc9b12SSteven Rostedt {
138633dc9b12SSteven Rostedt 	struct ftrace_func_entry *entry;
1387b67bfe0dSSasha Levin 	struct hlist_node *tn;
138833dc9b12SSteven Rostedt 	struct hlist_head *hhd;
138907fd5515SSteven Rostedt 	struct ftrace_hash *new_hash;
139033dc9b12SSteven Rostedt 	int size = src->count;
139133dc9b12SSteven Rostedt 	int bits = 0;
1392f8b8be8aSMasami Hiramatsu 	int ret;
139333dc9b12SSteven Rostedt 	int i;
139433dc9b12SSteven Rostedt 
1395f8b8be8aSMasami Hiramatsu 	/* Reject setting notrace hash on IPMODIFY ftrace_ops */
1396f8b8be8aSMasami Hiramatsu 	if (ops->flags & FTRACE_OPS_FL_IPMODIFY && !enable)
1397f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1398f8b8be8aSMasami Hiramatsu 
139933dc9b12SSteven Rostedt 	/*
140033dc9b12SSteven Rostedt 	 * If the new source is empty, just free dst and assign it
140133dc9b12SSteven Rostedt 	 * the empty_hash.
140233dc9b12SSteven Rostedt 	 */
140333dc9b12SSteven Rostedt 	if (!src->count) {
14045c27c775SMasami Hiramatsu 		new_hash = EMPTY_HASH;
14055c27c775SMasami Hiramatsu 		goto update;
140633dc9b12SSteven Rostedt 	}
140733dc9b12SSteven Rostedt 
140833dc9b12SSteven Rostedt 	/*
140933dc9b12SSteven Rostedt 	 * Make the hash size about 1/2 the # found
141033dc9b12SSteven Rostedt 	 */
141133dc9b12SSteven Rostedt 	for (size /= 2; size; size >>= 1)
141233dc9b12SSteven Rostedt 		bits++;
141333dc9b12SSteven Rostedt 
141433dc9b12SSteven Rostedt 	/* Don't allocate too much */
141533dc9b12SSteven Rostedt 	if (bits > FTRACE_HASH_MAX_BITS)
141633dc9b12SSteven Rostedt 		bits = FTRACE_HASH_MAX_BITS;
141733dc9b12SSteven Rostedt 
141807fd5515SSteven Rostedt 	new_hash = alloc_ftrace_hash(bits);
141907fd5515SSteven Rostedt 	if (!new_hash)
14205c27c775SMasami Hiramatsu 		return -ENOMEM;
142133dc9b12SSteven Rostedt 
142233dc9b12SSteven Rostedt 	size = 1 << src->size_bits;
142333dc9b12SSteven Rostedt 	for (i = 0; i < size; i++) {
142433dc9b12SSteven Rostedt 		hhd = &src->buckets[i];
1425b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tn, hhd, hlist) {
142633dc9b12SSteven Rostedt 			remove_hash_entry(src, entry);
142707fd5515SSteven Rostedt 			__add_hash_entry(new_hash, entry);
142833dc9b12SSteven Rostedt 		}
142933dc9b12SSteven Rostedt 	}
143033dc9b12SSteven Rostedt 
14315c27c775SMasami Hiramatsu update:
1432f8b8be8aSMasami Hiramatsu 	/* Make sure this can be applied if it is IPMODIFY ftrace_ops */
1433f8b8be8aSMasami Hiramatsu 	if (enable) {
1434f8b8be8aSMasami Hiramatsu 		/* IPMODIFY should be updated only when filter_hash updating */
1435f8b8be8aSMasami Hiramatsu 		ret = ftrace_hash_ipmodify_update(ops, new_hash);
1436f8b8be8aSMasami Hiramatsu 		if (ret < 0) {
1437f8b8be8aSMasami Hiramatsu 			free_ftrace_hash(new_hash);
1438f8b8be8aSMasami Hiramatsu 			return ret;
1439f8b8be8aSMasami Hiramatsu 		}
1440f8b8be8aSMasami Hiramatsu 	}
1441f8b8be8aSMasami Hiramatsu 
14425c27c775SMasami Hiramatsu 	/*
14435c27c775SMasami Hiramatsu 	 * Remove the current set, update the hash and add
14445c27c775SMasami Hiramatsu 	 * them back.
14455c27c775SMasami Hiramatsu 	 */
144684261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_disable_modify(ops, enable);
14475c27c775SMasami Hiramatsu 
144807fd5515SSteven Rostedt 	rcu_assign_pointer(*dst, new_hash);
144907fd5515SSteven Rostedt 
145084261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_enable_modify(ops, enable);
145141fb61c2SSteven Rostedt 
14525c27c775SMasami Hiramatsu 	return 0;
145333dc9b12SSteven Rostedt }
145433dc9b12SSteven Rostedt 
1455fef5aeeeSSteven Rostedt (Red Hat) static bool hash_contains_ip(unsigned long ip,
1456fef5aeeeSSteven Rostedt (Red Hat) 			     struct ftrace_ops_hash *hash)
1457fef5aeeeSSteven Rostedt (Red Hat) {
1458fef5aeeeSSteven Rostedt (Red Hat) 	/*
1459fef5aeeeSSteven Rostedt (Red Hat) 	 * The function record is a match if it exists in the filter
1460fef5aeeeSSteven Rostedt (Red Hat) 	 * hash and not in the notrace hash. Note, an emty hash is
1461fef5aeeeSSteven Rostedt (Red Hat) 	 * considered a match for the filter hash, but an empty
1462fef5aeeeSSteven Rostedt (Red Hat) 	 * notrace hash is considered not in the notrace hash.
1463fef5aeeeSSteven Rostedt (Red Hat) 	 */
1464fef5aeeeSSteven Rostedt (Red Hat) 	return (ftrace_hash_empty(hash->filter_hash) ||
1465fef5aeeeSSteven Rostedt (Red Hat) 		ftrace_lookup_ip(hash->filter_hash, ip)) &&
1466fef5aeeeSSteven Rostedt (Red Hat) 		(ftrace_hash_empty(hash->notrace_hash) ||
1467fef5aeeeSSteven Rostedt (Red Hat) 		 !ftrace_lookup_ip(hash->notrace_hash, ip));
1468fef5aeeeSSteven Rostedt (Red Hat) }
1469fef5aeeeSSteven Rostedt (Red Hat) 
1470265c831cSSteven Rostedt /*
1471b848914cSSteven Rostedt  * Test the hashes for this ops to see if we want to call
1472b848914cSSteven Rostedt  * the ops->func or not.
1473b848914cSSteven Rostedt  *
1474b848914cSSteven Rostedt  * It's a match if the ip is in the ops->filter_hash or
1475b848914cSSteven Rostedt  * the filter_hash does not exist or is empty,
1476b848914cSSteven Rostedt  *  AND
1477b848914cSSteven Rostedt  * the ip is not in the ops->notrace_hash.
1478cdbe61bfSSteven Rostedt  *
1479cdbe61bfSSteven Rostedt  * This needs to be called with preemption disabled as
1480cdbe61bfSSteven Rostedt  * the hashes are freed with call_rcu_sched().
1481b848914cSSteven Rostedt  */
1482b848914cSSteven Rostedt static int
1483195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
1484b848914cSSteven Rostedt {
1485fef5aeeeSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash hash;
1486b848914cSSteven Rostedt 	int ret;
1487b848914cSSteven Rostedt 
1488195a8afcSSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE_WITH_REGS
1489195a8afcSSteven Rostedt (Red Hat) 	/*
1490195a8afcSSteven Rostedt (Red Hat) 	 * There's a small race when adding ops that the ftrace handler
1491195a8afcSSteven Rostedt (Red Hat) 	 * that wants regs, may be called without them. We can not
1492195a8afcSSteven Rostedt (Red Hat) 	 * allow that handler to be called if regs is NULL.
1493195a8afcSSteven Rostedt (Red Hat) 	 */
1494195a8afcSSteven Rostedt (Red Hat) 	if (regs == NULL && (ops->flags & FTRACE_OPS_FL_SAVE_REGS))
1495195a8afcSSteven Rostedt (Red Hat) 		return 0;
1496195a8afcSSteven Rostedt (Red Hat) #endif
1497195a8afcSSteven Rostedt (Red Hat) 
1498fef5aeeeSSteven Rostedt (Red Hat) 	hash.filter_hash = rcu_dereference_raw_notrace(ops->func_hash->filter_hash);
1499fef5aeeeSSteven Rostedt (Red Hat) 	hash.notrace_hash = rcu_dereference_raw_notrace(ops->func_hash->notrace_hash);
1500b848914cSSteven Rostedt 
1501fef5aeeeSSteven Rostedt (Red Hat) 	if (hash_contains_ip(ip, &hash))
1502b848914cSSteven Rostedt 		ret = 1;
1503b848914cSSteven Rostedt 	else
1504b848914cSSteven Rostedt 		ret = 0;
1505b848914cSSteven Rostedt 
1506b848914cSSteven Rostedt 	return ret;
1507b848914cSSteven Rostedt }
1508b848914cSSteven Rostedt 
1509b848914cSSteven Rostedt /*
1510265c831cSSteven Rostedt  * This is a double for. Do not use 'break' to break out of the loop,
1511265c831cSSteven Rostedt  * you must use a goto.
1512265c831cSSteven Rostedt  */
1513265c831cSSteven Rostedt #define do_for_each_ftrace_rec(pg, rec)					\
1514265c831cSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {		\
1515265c831cSSteven Rostedt 		int _____i;						\
1516265c831cSSteven Rostedt 		for (_____i = 0; _____i < pg->index; _____i++) {	\
1517265c831cSSteven Rostedt 			rec = &pg->records[_____i];
1518265c831cSSteven Rostedt 
1519265c831cSSteven Rostedt #define while_for_each_ftrace_rec()		\
1520265c831cSSteven Rostedt 		}				\
1521265c831cSSteven Rostedt 	}
1522ecea656dSAbhishek Sagar 
15235855feadSSteven Rostedt 
15245855feadSSteven Rostedt static int ftrace_cmp_recs(const void *a, const void *b)
15255855feadSSteven Rostedt {
1526a650e02aSSteven Rostedt 	const struct dyn_ftrace *key = a;
1527a650e02aSSteven Rostedt 	const struct dyn_ftrace *rec = b;
15285855feadSSteven Rostedt 
1529a650e02aSSteven Rostedt 	if (key->flags < rec->ip)
15305855feadSSteven Rostedt 		return -1;
1531a650e02aSSteven Rostedt 	if (key->ip >= rec->ip + MCOUNT_INSN_SIZE)
1532a650e02aSSteven Rostedt 		return 1;
1533a650e02aSSteven Rostedt 	return 0;
1534a650e02aSSteven Rostedt }
1535a650e02aSSteven Rostedt 
1536*04cf31a7SMichael Ellerman /**
1537*04cf31a7SMichael Ellerman  * ftrace_location_range - return the first address of a traced location
1538*04cf31a7SMichael Ellerman  *	if it touches the given ip range
1539*04cf31a7SMichael Ellerman  * @start: start of range to search.
1540*04cf31a7SMichael Ellerman  * @end: end of range to search (inclusive). @end points to the last byte
1541*04cf31a7SMichael Ellerman  *	to check.
1542*04cf31a7SMichael Ellerman  *
1543*04cf31a7SMichael Ellerman  * Returns rec->ip if the related ftrace location is a least partly within
1544*04cf31a7SMichael Ellerman  * the given address range. That is, the first address of the instruction
1545*04cf31a7SMichael Ellerman  * that is either a NOP or call to the function tracer. It checks the ftrace
1546*04cf31a7SMichael Ellerman  * internal tables to determine if the address belongs or not.
1547*04cf31a7SMichael Ellerman  */
1548*04cf31a7SMichael Ellerman unsigned long ftrace_location_range(unsigned long start, unsigned long end)
1549a650e02aSSteven Rostedt {
1550a650e02aSSteven Rostedt 	struct ftrace_page *pg;
1551a650e02aSSteven Rostedt 	struct dyn_ftrace *rec;
1552a650e02aSSteven Rostedt 	struct dyn_ftrace key;
1553a650e02aSSteven Rostedt 
1554a650e02aSSteven Rostedt 	key.ip = start;
1555a650e02aSSteven Rostedt 	key.flags = end;	/* overload flags, as it is unsigned long */
1556a650e02aSSteven Rostedt 
1557a650e02aSSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = pg->next) {
1558a650e02aSSteven Rostedt 		if (end < pg->records[0].ip ||
1559a650e02aSSteven Rostedt 		    start >= (pg->records[pg->index - 1].ip + MCOUNT_INSN_SIZE))
1560a650e02aSSteven Rostedt 			continue;
1561a650e02aSSteven Rostedt 		rec = bsearch(&key, pg->records, pg->index,
1562a650e02aSSteven Rostedt 			      sizeof(struct dyn_ftrace),
1563a650e02aSSteven Rostedt 			      ftrace_cmp_recs);
1564a650e02aSSteven Rostedt 		if (rec)
1565f0cf973aSSteven Rostedt 			return rec->ip;
1566a650e02aSSteven Rostedt 	}
1567a650e02aSSteven Rostedt 
15685855feadSSteven Rostedt 	return 0;
15695855feadSSteven Rostedt }
15705855feadSSteven Rostedt 
1571c88fd863SSteven Rostedt /**
1572c88fd863SSteven Rostedt  * ftrace_location - return true if the ip giving is a traced location
1573c88fd863SSteven Rostedt  * @ip: the instruction pointer to check
1574c88fd863SSteven Rostedt  *
1575f0cf973aSSteven Rostedt  * Returns rec->ip if @ip given is a pointer to a ftrace location.
1576c88fd863SSteven Rostedt  * That is, the instruction that is either a NOP or call to
1577c88fd863SSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1578c88fd863SSteven Rostedt  * determine if the address belongs or not.
1579c88fd863SSteven Rostedt  */
1580f0cf973aSSteven Rostedt unsigned long ftrace_location(unsigned long ip)
1581c88fd863SSteven Rostedt {
1582a650e02aSSteven Rostedt 	return ftrace_location_range(ip, ip);
15835855feadSSteven Rostedt }
1584c88fd863SSteven Rostedt 
1585a650e02aSSteven Rostedt /**
1586a650e02aSSteven Rostedt  * ftrace_text_reserved - return true if range contains an ftrace location
1587a650e02aSSteven Rostedt  * @start: start of range to search
1588a650e02aSSteven Rostedt  * @end: end of range to search (inclusive). @end points to the last byte to check.
1589a650e02aSSteven Rostedt  *
1590a650e02aSSteven Rostedt  * Returns 1 if @start and @end contains a ftrace location.
1591a650e02aSSteven Rostedt  * That is, the instruction that is either a NOP or call to
1592a650e02aSSteven Rostedt  * the function tracer. It checks the ftrace internal tables to
1593a650e02aSSteven Rostedt  * determine if the address belongs or not.
1594a650e02aSSteven Rostedt  */
1595d88471cbSSasha Levin int ftrace_text_reserved(const void *start, const void *end)
1596a650e02aSSteven Rostedt {
1597f0cf973aSSteven Rostedt 	unsigned long ret;
1598f0cf973aSSteven Rostedt 
1599f0cf973aSSteven Rostedt 	ret = ftrace_location_range((unsigned long)start,
1600a650e02aSSteven Rostedt 				    (unsigned long)end);
1601f0cf973aSSteven Rostedt 
1602f0cf973aSSteven Rostedt 	return (int)!!ret;
1603c88fd863SSteven Rostedt }
1604c88fd863SSteven Rostedt 
16054fbb48cbSSteven Rostedt (Red Hat) /* Test if ops registered to this rec needs regs */
16064fbb48cbSSteven Rostedt (Red Hat) static bool test_rec_ops_needs_regs(struct dyn_ftrace *rec)
16074fbb48cbSSteven Rostedt (Red Hat) {
16084fbb48cbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
16094fbb48cbSSteven Rostedt (Red Hat) 	bool keep_regs = false;
16104fbb48cbSSteven Rostedt (Red Hat) 
16114fbb48cbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list;
16124fbb48cbSSteven Rostedt (Red Hat) 	     ops != &ftrace_list_end; ops = ops->next) {
16134fbb48cbSSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
16144fbb48cbSSteven Rostedt (Red Hat) 		if (ftrace_ops_test(ops, rec->ip, rec)) {
16154fbb48cbSSteven Rostedt (Red Hat) 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
16164fbb48cbSSteven Rostedt (Red Hat) 				keep_regs = true;
16174fbb48cbSSteven Rostedt (Red Hat) 				break;
16184fbb48cbSSteven Rostedt (Red Hat) 			}
16194fbb48cbSSteven Rostedt (Red Hat) 		}
16204fbb48cbSSteven Rostedt (Red Hat) 	}
16214fbb48cbSSteven Rostedt (Red Hat) 
16224fbb48cbSSteven Rostedt (Red Hat) 	return  keep_regs;
16234fbb48cbSSteven Rostedt (Red Hat) }
16244fbb48cbSSteven Rostedt (Red Hat) 
1625ed926f9bSSteven Rostedt static void __ftrace_hash_rec_update(struct ftrace_ops *ops,
1626ed926f9bSSteven Rostedt 				     int filter_hash,
1627ed926f9bSSteven Rostedt 				     bool inc)
1628ed926f9bSSteven Rostedt {
1629ed926f9bSSteven Rostedt 	struct ftrace_hash *hash;
1630ed926f9bSSteven Rostedt 	struct ftrace_hash *other_hash;
1631ed926f9bSSteven Rostedt 	struct ftrace_page *pg;
1632ed926f9bSSteven Rostedt 	struct dyn_ftrace *rec;
1633ed926f9bSSteven Rostedt 	int count = 0;
1634ed926f9bSSteven Rostedt 	int all = 0;
1635ed926f9bSSteven Rostedt 
1636ed926f9bSSteven Rostedt 	/* Only update if the ops has been registered */
1637ed926f9bSSteven Rostedt 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1638ed926f9bSSteven Rostedt 		return;
1639ed926f9bSSteven Rostedt 
1640ed926f9bSSteven Rostedt 	/*
1641ed926f9bSSteven Rostedt 	 * In the filter_hash case:
1642ed926f9bSSteven Rostedt 	 *   If the count is zero, we update all records.
1643ed926f9bSSteven Rostedt 	 *   Otherwise we just update the items in the hash.
1644ed926f9bSSteven Rostedt 	 *
1645ed926f9bSSteven Rostedt 	 * In the notrace_hash case:
1646ed926f9bSSteven Rostedt 	 *   We enable the update in the hash.
1647ed926f9bSSteven Rostedt 	 *   As disabling notrace means enabling the tracing,
1648ed926f9bSSteven Rostedt 	 *   and enabling notrace means disabling, the inc variable
1649ed926f9bSSteven Rostedt 	 *   gets inversed.
1650ed926f9bSSteven Rostedt 	 */
1651ed926f9bSSteven Rostedt 	if (filter_hash) {
165233b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
165333b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->notrace_hash;
165406a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1655ed926f9bSSteven Rostedt 			all = 1;
1656ed926f9bSSteven Rostedt 	} else {
1657ed926f9bSSteven Rostedt 		inc = !inc;
165833b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
165933b7f99cSSteven Rostedt (Red Hat) 		other_hash = ops->func_hash->filter_hash;
1660ed926f9bSSteven Rostedt 		/*
1661ed926f9bSSteven Rostedt 		 * If the notrace hash has no items,
1662ed926f9bSSteven Rostedt 		 * then there's nothing to do.
1663ed926f9bSSteven Rostedt 		 */
166406a51d93SSteven Rostedt 		if (ftrace_hash_empty(hash))
1665ed926f9bSSteven Rostedt 			return;
1666ed926f9bSSteven Rostedt 	}
1667ed926f9bSSteven Rostedt 
1668ed926f9bSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
1669ed926f9bSSteven Rostedt 		int in_other_hash = 0;
1670ed926f9bSSteven Rostedt 		int in_hash = 0;
1671ed926f9bSSteven Rostedt 		int match = 0;
1672ed926f9bSSteven Rostedt 
1673b7ffffbbSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_DISABLED)
1674b7ffffbbSSteven Rostedt (Red Hat) 			continue;
1675b7ffffbbSSteven Rostedt (Red Hat) 
1676ed926f9bSSteven Rostedt 		if (all) {
1677ed926f9bSSteven Rostedt 			/*
1678ed926f9bSSteven Rostedt 			 * Only the filter_hash affects all records.
1679ed926f9bSSteven Rostedt 			 * Update if the record is not in the notrace hash.
1680ed926f9bSSteven Rostedt 			 */
1681b848914cSSteven Rostedt 			if (!other_hash || !ftrace_lookup_ip(other_hash, rec->ip))
1682ed926f9bSSteven Rostedt 				match = 1;
1683ed926f9bSSteven Rostedt 		} else {
168406a51d93SSteven Rostedt 			in_hash = !!ftrace_lookup_ip(hash, rec->ip);
168506a51d93SSteven Rostedt 			in_other_hash = !!ftrace_lookup_ip(other_hash, rec->ip);
1686ed926f9bSSteven Rostedt 
1687ed926f9bSSteven Rostedt 			/*
168819eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is set, we want to match all functions
168919eab4a4SSteven Rostedt (Red Hat) 			 * that are in the hash but not in the other hash.
1690ed926f9bSSteven Rostedt 			 *
169119eab4a4SSteven Rostedt (Red Hat) 			 * If filter_hash is not set, then we are decrementing.
169219eab4a4SSteven Rostedt (Red Hat) 			 * That means we match anything that is in the hash
169319eab4a4SSteven Rostedt (Red Hat) 			 * and also in the other_hash. That is, we need to turn
169419eab4a4SSteven Rostedt (Red Hat) 			 * off functions in the other hash because they are disabled
169519eab4a4SSteven Rostedt (Red Hat) 			 * by this hash.
1696ed926f9bSSteven Rostedt 			 */
1697ed926f9bSSteven Rostedt 			if (filter_hash && in_hash && !in_other_hash)
1698ed926f9bSSteven Rostedt 				match = 1;
1699ed926f9bSSteven Rostedt 			else if (!filter_hash && in_hash &&
170006a51d93SSteven Rostedt 				 (in_other_hash || ftrace_hash_empty(other_hash)))
1701ed926f9bSSteven Rostedt 				match = 1;
1702ed926f9bSSteven Rostedt 		}
1703ed926f9bSSteven Rostedt 		if (!match)
1704ed926f9bSSteven Rostedt 			continue;
1705ed926f9bSSteven Rostedt 
1706ed926f9bSSteven Rostedt 		if (inc) {
1707ed926f9bSSteven Rostedt 			rec->flags++;
17080376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == FTRACE_REF_MAX))
1709ed926f9bSSteven Rostedt 				return;
171079922b80SSteven Rostedt (Red Hat) 
171179922b80SSteven Rostedt (Red Hat) 			/*
171279922b80SSteven Rostedt (Red Hat) 			 * If there's only a single callback registered to a
171379922b80SSteven Rostedt (Red Hat) 			 * function, and the ops has a trampoline registered
171479922b80SSteven Rostedt (Red Hat) 			 * for it, then we can call it directly.
171579922b80SSteven Rostedt (Red Hat) 			 */
1716fef5aeeeSSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) == 1 && ops->trampoline)
171779922b80SSteven Rostedt (Red Hat) 				rec->flags |= FTRACE_FL_TRAMP;
1718fef5aeeeSSteven Rostedt (Red Hat) 			else
171979922b80SSteven Rostedt (Red Hat) 				/*
172079922b80SSteven Rostedt (Red Hat) 				 * If we are adding another function callback
172179922b80SSteven Rostedt (Red Hat) 				 * to this function, and the previous had a
1722bce0b6c5SSteven Rostedt (Red Hat) 				 * custom trampoline in use, then we need to go
1723bce0b6c5SSteven Rostedt (Red Hat) 				 * back to the default trampoline.
172479922b80SSteven Rostedt (Red Hat) 				 */
1725fef5aeeeSSteven Rostedt (Red Hat) 				rec->flags &= ~FTRACE_FL_TRAMP;
172679922b80SSteven Rostedt (Red Hat) 
172708f6fba5SSteven Rostedt 			/*
172808f6fba5SSteven Rostedt 			 * If any ops wants regs saved for this function
172908f6fba5SSteven Rostedt 			 * then all ops will get saved regs.
173008f6fba5SSteven Rostedt 			 */
173108f6fba5SSteven Rostedt 			if (ops->flags & FTRACE_OPS_FL_SAVE_REGS)
173208f6fba5SSteven Rostedt 				rec->flags |= FTRACE_FL_REGS;
1733ed926f9bSSteven Rostedt 		} else {
17340376bde1SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(ftrace_rec_count(rec) == 0))
1735ed926f9bSSteven Rostedt 				return;
1736ed926f9bSSteven Rostedt 			rec->flags--;
173779922b80SSteven Rostedt (Red Hat) 
17384fbb48cbSSteven Rostedt (Red Hat) 			/*
17394fbb48cbSSteven Rostedt (Red Hat) 			 * If the rec had REGS enabled and the ops that is
17404fbb48cbSSteven Rostedt (Red Hat) 			 * being removed had REGS set, then see if there is
17414fbb48cbSSteven Rostedt (Red Hat) 			 * still any ops for this record that wants regs.
17424fbb48cbSSteven Rostedt (Red Hat) 			 * If not, we can stop recording them.
17434fbb48cbSSteven Rostedt (Red Hat) 			 */
17440376bde1SSteven Rostedt (Red Hat) 			if (ftrace_rec_count(rec) > 0 &&
17454fbb48cbSSteven Rostedt (Red Hat) 			    rec->flags & FTRACE_FL_REGS &&
17464fbb48cbSSteven Rostedt (Red Hat) 			    ops->flags & FTRACE_OPS_FL_SAVE_REGS) {
17474fbb48cbSSteven Rostedt (Red Hat) 				if (!test_rec_ops_needs_regs(rec))
17484fbb48cbSSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_REGS;
17494fbb48cbSSteven Rostedt (Red Hat) 			}
175079922b80SSteven Rostedt (Red Hat) 
175179922b80SSteven Rostedt (Red Hat) 			/*
1752fef5aeeeSSteven Rostedt (Red Hat) 			 * If the rec had TRAMP enabled, then it needs to
1753fef5aeeeSSteven Rostedt (Red Hat) 			 * be cleared. As TRAMP can only be enabled iff
1754fef5aeeeSSteven Rostedt (Red Hat) 			 * there is only a single ops attached to it.
1755fef5aeeeSSteven Rostedt (Red Hat) 			 * In otherwords, always disable it on decrementing.
1756fef5aeeeSSteven Rostedt (Red Hat) 			 * In the future, we may set it if rec count is
1757fef5aeeeSSteven Rostedt (Red Hat) 			 * decremented to one, and the ops that is left
1758fef5aeeeSSteven Rostedt (Red Hat) 			 * has a trampoline.
1759fef5aeeeSSteven Rostedt (Red Hat) 			 */
1760fef5aeeeSSteven Rostedt (Red Hat) 			rec->flags &= ~FTRACE_FL_TRAMP;
1761fef5aeeeSSteven Rostedt (Red Hat) 
1762fef5aeeeSSteven Rostedt (Red Hat) 			/*
176379922b80SSteven Rostedt (Red Hat) 			 * flags will be cleared in ftrace_check_record()
176479922b80SSteven Rostedt (Red Hat) 			 * if rec count is zero.
176579922b80SSteven Rostedt (Red Hat) 			 */
1766ed926f9bSSteven Rostedt 		}
1767ed926f9bSSteven Rostedt 		count++;
1768ed926f9bSSteven Rostedt 		/* Shortcut, if we handled all records, we are done. */
1769ed926f9bSSteven Rostedt 		if (!all && count == hash->count)
1770ed926f9bSSteven Rostedt 			return;
1771ed926f9bSSteven Rostedt 	} while_for_each_ftrace_rec();
1772ed926f9bSSteven Rostedt }
1773ed926f9bSSteven Rostedt 
1774ed926f9bSSteven Rostedt static void ftrace_hash_rec_disable(struct ftrace_ops *ops,
1775ed926f9bSSteven Rostedt 				    int filter_hash)
1776ed926f9bSSteven Rostedt {
1777ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 0);
1778ed926f9bSSteven Rostedt }
1779ed926f9bSSteven Rostedt 
1780ed926f9bSSteven Rostedt static void ftrace_hash_rec_enable(struct ftrace_ops *ops,
1781ed926f9bSSteven Rostedt 				   int filter_hash)
1782ed926f9bSSteven Rostedt {
1783ed926f9bSSteven Rostedt 	__ftrace_hash_rec_update(ops, filter_hash, 1);
1784ed926f9bSSteven Rostedt }
1785ed926f9bSSteven Rostedt 
178684261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_update_modify(struct ftrace_ops *ops,
178784261912SSteven Rostedt (Red Hat) 					  int filter_hash, int inc)
178884261912SSteven Rostedt (Red Hat) {
178984261912SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
179084261912SSteven Rostedt (Red Hat) 
179184261912SSteven Rostedt (Red Hat) 	__ftrace_hash_rec_update(ops, filter_hash, inc);
179284261912SSteven Rostedt (Red Hat) 
179384261912SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
179484261912SSteven Rostedt (Red Hat) 		return;
179584261912SSteven Rostedt (Red Hat) 
179684261912SSteven Rostedt (Red Hat) 	/*
179784261912SSteven Rostedt (Red Hat) 	 * If the ops shares the global_ops hash, then we need to update
179884261912SSteven Rostedt (Red Hat) 	 * all ops that are enabled and use this hash.
179984261912SSteven Rostedt (Red Hat) 	 */
180084261912SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
180184261912SSteven Rostedt (Red Hat) 		/* Already done */
180284261912SSteven Rostedt (Red Hat) 		if (op == ops)
180384261912SSteven Rostedt (Red Hat) 			continue;
180484261912SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash)
180584261912SSteven Rostedt (Red Hat) 			__ftrace_hash_rec_update(op, filter_hash, inc);
180684261912SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
180784261912SSteven Rostedt (Red Hat) }
180884261912SSteven Rostedt (Red Hat) 
180984261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_disable_modify(struct ftrace_ops *ops,
181084261912SSteven Rostedt (Red Hat) 					   int filter_hash)
181184261912SSteven Rostedt (Red Hat) {
181284261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 0);
181384261912SSteven Rostedt (Red Hat) }
181484261912SSteven Rostedt (Red Hat) 
181584261912SSteven Rostedt (Red Hat) static void ftrace_hash_rec_enable_modify(struct ftrace_ops *ops,
181684261912SSteven Rostedt (Red Hat) 					  int filter_hash)
181784261912SSteven Rostedt (Red Hat) {
181884261912SSteven Rostedt (Red Hat) 	ftrace_hash_rec_update_modify(ops, filter_hash, 1);
181984261912SSteven Rostedt (Red Hat) }
182084261912SSteven Rostedt (Red Hat) 
1821f8b8be8aSMasami Hiramatsu /*
1822f8b8be8aSMasami Hiramatsu  * Try to update IPMODIFY flag on each ftrace_rec. Return 0 if it is OK
1823f8b8be8aSMasami Hiramatsu  * or no-needed to update, -EBUSY if it detects a conflict of the flag
1824f8b8be8aSMasami Hiramatsu  * on a ftrace_rec, and -EINVAL if the new_hash tries to trace all recs.
1825f8b8be8aSMasami Hiramatsu  * Note that old_hash and new_hash has below meanings
1826f8b8be8aSMasami Hiramatsu  *  - If the hash is NULL, it hits all recs (if IPMODIFY is set, this is rejected)
1827f8b8be8aSMasami Hiramatsu  *  - If the hash is EMPTY_HASH, it hits nothing
1828f8b8be8aSMasami Hiramatsu  *  - Anything else hits the recs which match the hash entries.
1829f8b8be8aSMasami Hiramatsu  */
1830f8b8be8aSMasami Hiramatsu static int __ftrace_hash_update_ipmodify(struct ftrace_ops *ops,
1831f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *old_hash,
1832f8b8be8aSMasami Hiramatsu 					 struct ftrace_hash *new_hash)
1833f8b8be8aSMasami Hiramatsu {
1834f8b8be8aSMasami Hiramatsu 	struct ftrace_page *pg;
1835f8b8be8aSMasami Hiramatsu 	struct dyn_ftrace *rec, *end = NULL;
1836f8b8be8aSMasami Hiramatsu 	int in_old, in_new;
1837f8b8be8aSMasami Hiramatsu 
1838f8b8be8aSMasami Hiramatsu 	/* Only update if the ops has been registered */
1839f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
1840f8b8be8aSMasami Hiramatsu 		return 0;
1841f8b8be8aSMasami Hiramatsu 
1842f8b8be8aSMasami Hiramatsu 	if (!(ops->flags & FTRACE_OPS_FL_IPMODIFY))
1843f8b8be8aSMasami Hiramatsu 		return 0;
1844f8b8be8aSMasami Hiramatsu 
1845f8b8be8aSMasami Hiramatsu 	/*
1846f8b8be8aSMasami Hiramatsu 	 * Since the IPMODIFY is a very address sensitive action, we do not
1847f8b8be8aSMasami Hiramatsu 	 * allow ftrace_ops to set all functions to new hash.
1848f8b8be8aSMasami Hiramatsu 	 */
1849f8b8be8aSMasami Hiramatsu 	if (!new_hash || !old_hash)
1850f8b8be8aSMasami Hiramatsu 		return -EINVAL;
1851f8b8be8aSMasami Hiramatsu 
1852f8b8be8aSMasami Hiramatsu 	/* Update rec->flags */
1853f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1854f8b8be8aSMasami Hiramatsu 		/* We need to update only differences of filter_hash */
1855f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1856f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1857f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1858f8b8be8aSMasami Hiramatsu 			continue;
1859f8b8be8aSMasami Hiramatsu 
1860f8b8be8aSMasami Hiramatsu 		if (in_new) {
1861f8b8be8aSMasami Hiramatsu 			/* New entries must ensure no others are using it */
1862f8b8be8aSMasami Hiramatsu 			if (rec->flags & FTRACE_FL_IPMODIFY)
1863f8b8be8aSMasami Hiramatsu 				goto rollback;
1864f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1865f8b8be8aSMasami Hiramatsu 		} else /* Removed entry */
1866f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1867f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1868f8b8be8aSMasami Hiramatsu 
1869f8b8be8aSMasami Hiramatsu 	return 0;
1870f8b8be8aSMasami Hiramatsu 
1871f8b8be8aSMasami Hiramatsu rollback:
1872f8b8be8aSMasami Hiramatsu 	end = rec;
1873f8b8be8aSMasami Hiramatsu 
1874f8b8be8aSMasami Hiramatsu 	/* Roll back what we did above */
1875f8b8be8aSMasami Hiramatsu 	do_for_each_ftrace_rec(pg, rec) {
1876f8b8be8aSMasami Hiramatsu 		if (rec == end)
1877f8b8be8aSMasami Hiramatsu 			goto err_out;
1878f8b8be8aSMasami Hiramatsu 
1879f8b8be8aSMasami Hiramatsu 		in_old = !!ftrace_lookup_ip(old_hash, rec->ip);
1880f8b8be8aSMasami Hiramatsu 		in_new = !!ftrace_lookup_ip(new_hash, rec->ip);
1881f8b8be8aSMasami Hiramatsu 		if (in_old == in_new)
1882f8b8be8aSMasami Hiramatsu 			continue;
1883f8b8be8aSMasami Hiramatsu 
1884f8b8be8aSMasami Hiramatsu 		if (in_new)
1885f8b8be8aSMasami Hiramatsu 			rec->flags &= ~FTRACE_FL_IPMODIFY;
1886f8b8be8aSMasami Hiramatsu 		else
1887f8b8be8aSMasami Hiramatsu 			rec->flags |= FTRACE_FL_IPMODIFY;
1888f8b8be8aSMasami Hiramatsu 	} while_for_each_ftrace_rec();
1889f8b8be8aSMasami Hiramatsu 
1890f8b8be8aSMasami Hiramatsu err_out:
1891f8b8be8aSMasami Hiramatsu 	return -EBUSY;
1892f8b8be8aSMasami Hiramatsu }
1893f8b8be8aSMasami Hiramatsu 
1894f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_enable(struct ftrace_ops *ops)
1895f8b8be8aSMasami Hiramatsu {
1896f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1897f8b8be8aSMasami Hiramatsu 
1898f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1899f8b8be8aSMasami Hiramatsu 		hash = NULL;
1900f8b8be8aSMasami Hiramatsu 
1901f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, EMPTY_HASH, hash);
1902f8b8be8aSMasami Hiramatsu }
1903f8b8be8aSMasami Hiramatsu 
1904f8b8be8aSMasami Hiramatsu /* Disabling always succeeds */
1905f8b8be8aSMasami Hiramatsu static void ftrace_hash_ipmodify_disable(struct ftrace_ops *ops)
1906f8b8be8aSMasami Hiramatsu {
1907f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *hash = ops->func_hash->filter_hash;
1908f8b8be8aSMasami Hiramatsu 
1909f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(hash))
1910f8b8be8aSMasami Hiramatsu 		hash = NULL;
1911f8b8be8aSMasami Hiramatsu 
1912f8b8be8aSMasami Hiramatsu 	__ftrace_hash_update_ipmodify(ops, hash, EMPTY_HASH);
1913f8b8be8aSMasami Hiramatsu }
1914f8b8be8aSMasami Hiramatsu 
1915f8b8be8aSMasami Hiramatsu static int ftrace_hash_ipmodify_update(struct ftrace_ops *ops,
1916f8b8be8aSMasami Hiramatsu 				       struct ftrace_hash *new_hash)
1917f8b8be8aSMasami Hiramatsu {
1918f8b8be8aSMasami Hiramatsu 	struct ftrace_hash *old_hash = ops->func_hash->filter_hash;
1919f8b8be8aSMasami Hiramatsu 
1920f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(old_hash))
1921f8b8be8aSMasami Hiramatsu 		old_hash = NULL;
1922f8b8be8aSMasami Hiramatsu 
1923f8b8be8aSMasami Hiramatsu 	if (ftrace_hash_empty(new_hash))
1924f8b8be8aSMasami Hiramatsu 		new_hash = NULL;
1925f8b8be8aSMasami Hiramatsu 
1926f8b8be8aSMasami Hiramatsu 	return __ftrace_hash_update_ipmodify(ops, old_hash, new_hash);
1927f8b8be8aSMasami Hiramatsu }
1928f8b8be8aSMasami Hiramatsu 
1929b05086c7SSteven Rostedt (Red Hat) static void print_ip_ins(const char *fmt, const unsigned char *p)
193005736a42SSteven Rostedt {
193105736a42SSteven Rostedt 	int i;
193205736a42SSteven Rostedt 
193305736a42SSteven Rostedt 	printk(KERN_CONT "%s", fmt);
193405736a42SSteven Rostedt 
193505736a42SSteven Rostedt 	for (i = 0; i < MCOUNT_INSN_SIZE; i++)
193605736a42SSteven Rostedt 		printk(KERN_CONT "%s%02x", i ? ":" : "", p[i]);
193705736a42SSteven Rostedt }
193805736a42SSteven Rostedt 
19394fd3279bSSteven Rostedt (Red Hat) static struct ftrace_ops *
19404fd3279bSSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec);
194139daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
194239daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec, struct ftrace_ops *ops);
19434fd3279bSSteven Rostedt (Red Hat) 
194402a392a0SSteven Rostedt (Red Hat) enum ftrace_bug_type ftrace_bug_type;
1945b05086c7SSteven Rostedt (Red Hat) const void *ftrace_expected;
194602a392a0SSteven Rostedt (Red Hat) 
194702a392a0SSteven Rostedt (Red Hat) static void print_bug_type(void)
194802a392a0SSteven Rostedt (Red Hat) {
194902a392a0SSteven Rostedt (Red Hat) 	switch (ftrace_bug_type) {
195002a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UNKNOWN:
195102a392a0SSteven Rostedt (Red Hat) 		break;
195202a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_INIT:
195302a392a0SSteven Rostedt (Red Hat) 		pr_info("Initializing ftrace call sites\n");
195402a392a0SSteven Rostedt (Red Hat) 		break;
195502a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_NOP:
195602a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to NOP\n");
195702a392a0SSteven Rostedt (Red Hat) 		break;
195802a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_CALL:
195902a392a0SSteven Rostedt (Red Hat) 		pr_info("Setting ftrace call site to call ftrace function\n");
196002a392a0SSteven Rostedt (Red Hat) 		break;
196102a392a0SSteven Rostedt (Red Hat) 	case FTRACE_BUG_UPDATE:
196202a392a0SSteven Rostedt (Red Hat) 		pr_info("Updating ftrace call site to call a different ftrace function\n");
196302a392a0SSteven Rostedt (Red Hat) 		break;
196402a392a0SSteven Rostedt (Red Hat) 	}
196502a392a0SSteven Rostedt (Red Hat) }
196602a392a0SSteven Rostedt (Red Hat) 
1967c88fd863SSteven Rostedt /**
1968c88fd863SSteven Rostedt  * ftrace_bug - report and shutdown function tracer
1969c88fd863SSteven Rostedt  * @failed: The failed type (EFAULT, EINVAL, EPERM)
19704fd3279bSSteven Rostedt (Red Hat)  * @rec: The record that failed
1971c88fd863SSteven Rostedt  *
1972c88fd863SSteven Rostedt  * The arch code that enables or disables the function tracing
1973c88fd863SSteven Rostedt  * can call ftrace_bug() when it has detected a problem in
1974c88fd863SSteven Rostedt  * modifying the code. @failed should be one of either:
1975c88fd863SSteven Rostedt  * EFAULT - if the problem happens on reading the @ip address
1976c88fd863SSteven Rostedt  * EINVAL - if what is read at @ip is not what was expected
1977c88fd863SSteven Rostedt  * EPERM - if the problem happens on writting to the @ip address
1978c88fd863SSteven Rostedt  */
19794fd3279bSSteven Rostedt (Red Hat) void ftrace_bug(int failed, struct dyn_ftrace *rec)
19803c1720f0SSteven Rostedt {
19814fd3279bSSteven Rostedt (Red Hat) 	unsigned long ip = rec ? rec->ip : 0;
19824fd3279bSSteven Rostedt (Red Hat) 
1983b17e8a37SSteven Rostedt 	switch (failed) {
1984593eb8a2SSteven Rostedt 	case -EFAULT:
19856912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
198605736a42SSteven Rostedt 		pr_info("ftrace faulted on modifying ");
198705736a42SSteven Rostedt 		print_ip_sym(ip);
198805736a42SSteven Rostedt 		break;
1989593eb8a2SSteven Rostedt 	case -EINVAL:
19906912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
199105736a42SSteven Rostedt 		pr_info("ftrace failed to modify ");
199205736a42SSteven Rostedt 		print_ip_sym(ip);
199305736a42SSteven Rostedt 		print_ip_ins(" actual:   ", (unsigned char *)ip);
19944fd3279bSSteven Rostedt (Red Hat) 		pr_cont("\n");
1995b05086c7SSteven Rostedt (Red Hat) 		if (ftrace_expected) {
1996b05086c7SSteven Rostedt (Red Hat) 			print_ip_ins(" expected: ", ftrace_expected);
1997b05086c7SSteven Rostedt (Red Hat) 			pr_cont("\n");
1998b05086c7SSteven Rostedt (Red Hat) 		}
199905736a42SSteven Rostedt 		break;
2000593eb8a2SSteven Rostedt 	case -EPERM:
20016912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2002593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on writing ");
2003593eb8a2SSteven Rostedt 		print_ip_sym(ip);
2004593eb8a2SSteven Rostedt 		break;
2005593eb8a2SSteven Rostedt 	default:
20066912896eSSteven Rostedt 		FTRACE_WARN_ON_ONCE(1);
2007593eb8a2SSteven Rostedt 		pr_info("ftrace faulted on unknown error ");
2008593eb8a2SSteven Rostedt 		print_ip_sym(ip);
200905736a42SSteven Rostedt 	}
201002a392a0SSteven Rostedt (Red Hat) 	print_bug_type();
20114fd3279bSSteven Rostedt (Red Hat) 	if (rec) {
20124fd3279bSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops = NULL;
20134fd3279bSSteven Rostedt (Red Hat) 
20144fd3279bSSteven Rostedt (Red Hat) 		pr_info("ftrace record flags: %lx\n", rec->flags);
20154fd3279bSSteven Rostedt (Red Hat) 		pr_cont(" (%ld)%s", ftrace_rec_count(rec),
20164fd3279bSSteven Rostedt (Red Hat) 			rec->flags & FTRACE_FL_REGS ? " R" : "  ");
20174fd3279bSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
20184fd3279bSSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
201939daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
202039daa7b9SSteven Rostedt (Red Hat) 				do {
202139daa7b9SSteven Rostedt (Red Hat) 					pr_cont("\ttramp: %pS (%pS)",
202239daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->trampoline,
202339daa7b9SSteven Rostedt (Red Hat) 						(void *)ops->func);
202439daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
202539daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
202639daa7b9SSteven Rostedt (Red Hat) 			} else
20274fd3279bSSteven Rostedt (Red Hat) 				pr_cont("\ttramp: ERROR!");
20284fd3279bSSteven Rostedt (Red Hat) 
20294fd3279bSSteven Rostedt (Red Hat) 		}
20304fd3279bSSteven Rostedt (Red Hat) 		ip = ftrace_get_addr_curr(rec);
203139daa7b9SSteven Rostedt (Red Hat) 		pr_cont("\n expected tramp: %lx\n", ip);
20324fd3279bSSteven Rostedt (Red Hat) 	}
2033b17e8a37SSteven Rostedt }
203405736a42SSteven Rostedt 
2035c88fd863SSteven Rostedt static int ftrace_check_record(struct dyn_ftrace *rec, int enable, int update)
20363d083395SSteven Rostedt {
203764fbcd16SXiao Guangrong 	unsigned long flag = 0UL;
2038e7d3737eSFrederic Weisbecker 
203902a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
204002a392a0SSteven Rostedt (Red Hat) 
2041b7ffffbbSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_DISABLED)
2042b7ffffbbSSteven Rostedt (Red Hat) 		return FTRACE_UPDATE_IGNORE;
2043b7ffffbbSSteven Rostedt (Red Hat) 
20443d083395SSteven Rostedt 	/*
204530fb6aa7SJiri Olsa 	 * If we are updating calls:
20463d083395SSteven Rostedt 	 *
2047ed926f9bSSteven Rostedt 	 *   If the record has a ref count, then we need to enable it
2048ed926f9bSSteven Rostedt 	 *   because someone is using it.
20493d083395SSteven Rostedt 	 *
2050ed926f9bSSteven Rostedt 	 *   Otherwise we make sure its disabled.
2051ed926f9bSSteven Rostedt 	 *
205230fb6aa7SJiri Olsa 	 * If we are disabling calls, then disable all records that
2053ed926f9bSSteven Rostedt 	 * are enabled.
20543d083395SSteven Rostedt 	 */
20550376bde1SSteven Rostedt (Red Hat) 	if (enable && ftrace_rec_count(rec))
205664fbcd16SXiao Guangrong 		flag = FTRACE_FL_ENABLED;
20573d083395SSteven Rostedt 
205808f6fba5SSteven Rostedt 	/*
205979922b80SSteven Rostedt (Red Hat) 	 * If enabling and the REGS flag does not match the REGS_EN, or
206079922b80SSteven Rostedt (Red Hat) 	 * the TRAMP flag doesn't match the TRAMP_EN, then do not ignore
206179922b80SSteven Rostedt (Red Hat) 	 * this record. Set flags to fail the compare against ENABLED.
206208f6fba5SSteven Rostedt 	 */
206379922b80SSteven Rostedt (Red Hat) 	if (flag) {
206479922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_REGS) !=
206579922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_REGS_EN))
206608f6fba5SSteven Rostedt 			flag |= FTRACE_FL_REGS;
206708f6fba5SSteven Rostedt 
206879922b80SSteven Rostedt (Red Hat) 		if (!(rec->flags & FTRACE_FL_TRAMP) !=
206979922b80SSteven Rostedt (Red Hat) 		    !(rec->flags & FTRACE_FL_TRAMP_EN))
207079922b80SSteven Rostedt (Red Hat) 			flag |= FTRACE_FL_TRAMP;
207179922b80SSteven Rostedt (Red Hat) 	}
207279922b80SSteven Rostedt (Red Hat) 
207364fbcd16SXiao Guangrong 	/* If the state of this record hasn't changed, then do nothing */
207464fbcd16SXiao Guangrong 	if ((rec->flags & FTRACE_FL_ENABLED) == flag)
2075c88fd863SSteven Rostedt 		return FTRACE_UPDATE_IGNORE;
207664fbcd16SXiao Guangrong 
207764fbcd16SXiao Guangrong 	if (flag) {
207808f6fba5SSteven Rostedt 		/* Save off if rec is being enabled (for return value) */
207908f6fba5SSteven Rostedt 		flag ^= rec->flags & FTRACE_FL_ENABLED;
208008f6fba5SSteven Rostedt 
208108f6fba5SSteven Rostedt 		if (update) {
208264fbcd16SXiao Guangrong 			rec->flags |= FTRACE_FL_ENABLED;
208308f6fba5SSteven Rostedt 			if (flag & FTRACE_FL_REGS) {
208408f6fba5SSteven Rostedt 				if (rec->flags & FTRACE_FL_REGS)
208508f6fba5SSteven Rostedt 					rec->flags |= FTRACE_FL_REGS_EN;
208608f6fba5SSteven Rostedt 				else
208708f6fba5SSteven Rostedt 					rec->flags &= ~FTRACE_FL_REGS_EN;
208808f6fba5SSteven Rostedt 			}
208979922b80SSteven Rostedt (Red Hat) 			if (flag & FTRACE_FL_TRAMP) {
209079922b80SSteven Rostedt (Red Hat) 				if (rec->flags & FTRACE_FL_TRAMP)
209179922b80SSteven Rostedt (Red Hat) 					rec->flags |= FTRACE_FL_TRAMP_EN;
209279922b80SSteven Rostedt (Red Hat) 				else
209379922b80SSteven Rostedt (Red Hat) 					rec->flags &= ~FTRACE_FL_TRAMP_EN;
209479922b80SSteven Rostedt (Red Hat) 			}
209564fbcd16SXiao Guangrong 		}
209664fbcd16SXiao Guangrong 
209708f6fba5SSteven Rostedt 		/*
209808f6fba5SSteven Rostedt 		 * If this record is being updated from a nop, then
209908f6fba5SSteven Rostedt 		 *   return UPDATE_MAKE_CALL.
210008f6fba5SSteven Rostedt 		 * Otherwise,
210108f6fba5SSteven Rostedt 		 *   return UPDATE_MODIFY_CALL to tell the caller to convert
2102f1b2f2bdSSteven Rostedt (Red Hat) 		 *   from the save regs, to a non-save regs function or
210379922b80SSteven Rostedt (Red Hat) 		 *   vice versa, or from a trampoline call.
210408f6fba5SSteven Rostedt 		 */
210502a392a0SSteven Rostedt (Red Hat) 		if (flag & FTRACE_FL_ENABLED) {
210602a392a0SSteven Rostedt (Red Hat) 			ftrace_bug_type = FTRACE_BUG_CALL;
210708f6fba5SSteven Rostedt 			return FTRACE_UPDATE_MAKE_CALL;
210802a392a0SSteven Rostedt (Red Hat) 		}
2109f1b2f2bdSSteven Rostedt (Red Hat) 
211002a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
211108f6fba5SSteven Rostedt 		return FTRACE_UPDATE_MODIFY_CALL;
211208f6fba5SSteven Rostedt 	}
211308f6fba5SSteven Rostedt 
211408f6fba5SSteven Rostedt 	if (update) {
211508f6fba5SSteven Rostedt 		/* If there's no more users, clear all flags */
21160376bde1SSteven Rostedt (Red Hat) 		if (!ftrace_rec_count(rec))
211708f6fba5SSteven Rostedt 			rec->flags = 0;
211808f6fba5SSteven Rostedt 		else
2119b24d443bSSteven Rostedt (Red Hat) 			/*
2120b24d443bSSteven Rostedt (Red Hat) 			 * Just disable the record, but keep the ops TRAMP
2121b24d443bSSteven Rostedt (Red Hat) 			 * and REGS states. The _EN flags must be disabled though.
2122b24d443bSSteven Rostedt (Red Hat) 			 */
2123b24d443bSSteven Rostedt (Red Hat) 			rec->flags &= ~(FTRACE_FL_ENABLED | FTRACE_FL_TRAMP_EN |
2124b24d443bSSteven Rostedt (Red Hat) 					FTRACE_FL_REGS_EN);
212508f6fba5SSteven Rostedt 	}
2126c88fd863SSteven Rostedt 
212702a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_NOP;
2128c88fd863SSteven Rostedt 	return FTRACE_UPDATE_MAKE_NOP;
2129c88fd863SSteven Rostedt }
2130c88fd863SSteven Rostedt 
2131c88fd863SSteven Rostedt /**
2132c88fd863SSteven Rostedt  * ftrace_update_record, set a record that now is tracing or not
2133c88fd863SSteven Rostedt  * @rec: the record to update
2134c88fd863SSteven Rostedt  * @enable: set to 1 if the record is tracing, zero to force disable
2135c88fd863SSteven Rostedt  *
2136c88fd863SSteven Rostedt  * The records that represent all functions that can be traced need
2137c88fd863SSteven Rostedt  * to be updated when tracing has been enabled.
2138c88fd863SSteven Rostedt  */
2139c88fd863SSteven Rostedt int ftrace_update_record(struct dyn_ftrace *rec, int enable)
2140c88fd863SSteven Rostedt {
2141c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 1);
2142c88fd863SSteven Rostedt }
2143c88fd863SSteven Rostedt 
2144c88fd863SSteven Rostedt /**
2145c88fd863SSteven Rostedt  * ftrace_test_record, check if the record has been enabled or not
2146c88fd863SSteven Rostedt  * @rec: the record to test
2147c88fd863SSteven Rostedt  * @enable: set to 1 to check if enabled, 0 if it is disabled
2148c88fd863SSteven Rostedt  *
2149c88fd863SSteven Rostedt  * The arch code may need to test if a record is already set to
2150c88fd863SSteven Rostedt  * tracing to determine how to modify the function code that it
2151c88fd863SSteven Rostedt  * represents.
2152c88fd863SSteven Rostedt  */
2153c88fd863SSteven Rostedt int ftrace_test_record(struct dyn_ftrace *rec, int enable)
2154c88fd863SSteven Rostedt {
2155c88fd863SSteven Rostedt 	return ftrace_check_record(rec, enable, 0);
2156c88fd863SSteven Rostedt }
2157c88fd863SSteven Rostedt 
215879922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
21595fecaa04SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_any(struct dyn_ftrace *rec)
21605fecaa04SSteven Rostedt (Red Hat) {
21615fecaa04SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2162fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
21635fecaa04SSteven Rostedt (Red Hat) 
21645fecaa04SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
21655fecaa04SSteven Rostedt (Red Hat) 
21665fecaa04SSteven Rostedt (Red Hat) 		if (!op->trampoline)
21675fecaa04SSteven Rostedt (Red Hat) 			continue;
21685fecaa04SSteven Rostedt (Red Hat) 
2169fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
21705fecaa04SSteven Rostedt (Red Hat) 			return op;
21715fecaa04SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
21725fecaa04SSteven Rostedt (Red Hat) 
21735fecaa04SSteven Rostedt (Red Hat) 	return NULL;
21745fecaa04SSteven Rostedt (Red Hat) }
21755fecaa04SSteven Rostedt (Red Hat) 
21765fecaa04SSteven Rostedt (Red Hat) static struct ftrace_ops *
217739daa7b9SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_next(struct dyn_ftrace *rec,
217839daa7b9SSteven Rostedt (Red Hat) 			   struct ftrace_ops *op)
217939daa7b9SSteven Rostedt (Red Hat) {
218039daa7b9SSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
218139daa7b9SSteven Rostedt (Red Hat) 
218239daa7b9SSteven Rostedt (Red Hat) 	while_for_each_ftrace_op(op) {
218339daa7b9SSteven Rostedt (Red Hat) 
218439daa7b9SSteven Rostedt (Red Hat) 		if (!op->trampoline)
218539daa7b9SSteven Rostedt (Red Hat) 			continue;
218639daa7b9SSteven Rostedt (Red Hat) 
218739daa7b9SSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
218839daa7b9SSteven Rostedt (Red Hat) 			return op;
218939daa7b9SSteven Rostedt (Red Hat) 	}
219039daa7b9SSteven Rostedt (Red Hat) 
219139daa7b9SSteven Rostedt (Red Hat) 	return NULL;
219239daa7b9SSteven Rostedt (Red Hat) }
219339daa7b9SSteven Rostedt (Red Hat) 
219439daa7b9SSteven Rostedt (Red Hat) static struct ftrace_ops *
219579922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_curr(struct dyn_ftrace *rec)
219679922b80SSteven Rostedt (Red Hat) {
219779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2198fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
219979922b80SSteven Rostedt (Red Hat) 
2200fef5aeeeSSteven Rostedt (Red Hat) 	/*
2201fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to check removed ops first.
2202fef5aeeeSSteven Rostedt (Red Hat) 	 * If they are being removed, and this rec has a tramp,
2203fef5aeeeSSteven Rostedt (Red Hat) 	 * and this rec is in the ops list, then it would be the
2204fef5aeeeSSteven Rostedt (Red Hat) 	 * one with the tramp.
2205fef5aeeeSSteven Rostedt (Red Hat) 	 */
2206fef5aeeeSSteven Rostedt (Red Hat) 	if (removed_ops) {
2207fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, &removed_ops->old_hash))
220879922b80SSteven Rostedt (Red Hat) 			return removed_ops;
220979922b80SSteven Rostedt (Red Hat) 	}
221079922b80SSteven Rostedt (Red Hat) 
2211fef5aeeeSSteven Rostedt (Red Hat) 	/*
2212fef5aeeeSSteven Rostedt (Red Hat) 	 * Need to find the current trampoline for a rec.
2213fef5aeeeSSteven Rostedt (Red Hat) 	 * Now, a trampoline is only attached to a rec if there
2214fef5aeeeSSteven Rostedt (Red Hat) 	 * was a single 'ops' attached to it. But this can be called
2215fef5aeeeSSteven Rostedt (Red Hat) 	 * when we are adding another op to the rec or removing the
2216fef5aeeeSSteven Rostedt (Red Hat) 	 * current one. Thus, if the op is being added, we can
2217fef5aeeeSSteven Rostedt (Red Hat) 	 * ignore it because it hasn't attached itself to the rec
22184fc40904SSteven Rostedt (Red Hat) 	 * yet.
22194fc40904SSteven Rostedt (Red Hat) 	 *
22204fc40904SSteven Rostedt (Red Hat) 	 * If an ops is being modified (hooking to different functions)
22214fc40904SSteven Rostedt (Red Hat) 	 * then we don't care about the new functions that are being
22224fc40904SSteven Rostedt (Red Hat) 	 * added, just the old ones (that are probably being removed).
22234fc40904SSteven Rostedt (Red Hat) 	 *
22244fc40904SSteven Rostedt (Red Hat) 	 * If we are adding an ops to a function that already is using
22254fc40904SSteven Rostedt (Red Hat) 	 * a trampoline, it needs to be removed (trampolines are only
22264fc40904SSteven Rostedt (Red Hat) 	 * for single ops connected), then an ops that is not being
22274fc40904SSteven Rostedt (Red Hat) 	 * modified also needs to be checked.
2228fef5aeeeSSteven Rostedt (Red Hat) 	 */
222979922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
2230fef5aeeeSSteven Rostedt (Red Hat) 
2231fef5aeeeSSteven Rostedt (Red Hat) 		if (!op->trampoline)
223279922b80SSteven Rostedt (Red Hat) 			continue;
223379922b80SSteven Rostedt (Red Hat) 
2234fef5aeeeSSteven Rostedt (Red Hat) 		/*
2235fef5aeeeSSteven Rostedt (Red Hat) 		 * If the ops is being added, it hasn't gotten to
2236fef5aeeeSSteven Rostedt (Red Hat) 		 * the point to be removed from this tree yet.
2237fef5aeeeSSteven Rostedt (Red Hat) 		 */
2238fef5aeeeSSteven Rostedt (Red Hat) 		if (op->flags & FTRACE_OPS_FL_ADDING)
2239fef5aeeeSSteven Rostedt (Red Hat) 			continue;
2240fef5aeeeSSteven Rostedt (Red Hat) 
2241fef5aeeeSSteven Rostedt (Red Hat) 
22424fc40904SSteven Rostedt (Red Hat) 		/*
22434fc40904SSteven Rostedt (Red Hat) 		 * If the ops is being modified and is in the old
22444fc40904SSteven Rostedt (Red Hat) 		 * hash, then it is probably being removed from this
22454fc40904SSteven Rostedt (Red Hat) 		 * function.
22464fc40904SSteven Rostedt (Red Hat) 		 */
2247fef5aeeeSSteven Rostedt (Red Hat) 		if ((op->flags & FTRACE_OPS_FL_MODIFYING) &&
2248fef5aeeeSSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, &op->old_hash))
224979922b80SSteven Rostedt (Red Hat) 			return op;
22504fc40904SSteven Rostedt (Red Hat) 		/*
22514fc40904SSteven Rostedt (Red Hat) 		 * If the ops is not being added or modified, and it's
22524fc40904SSteven Rostedt (Red Hat) 		 * in its normal filter hash, then this must be the one
22534fc40904SSteven Rostedt (Red Hat) 		 * we want!
22544fc40904SSteven Rostedt (Red Hat) 		 */
22554fc40904SSteven Rostedt (Red Hat) 		if (!(op->flags & FTRACE_OPS_FL_MODIFYING) &&
22564fc40904SSteven Rostedt (Red Hat) 		    hash_contains_ip(ip, op->func_hash))
22574fc40904SSteven Rostedt (Red Hat) 			return op;
225879922b80SSteven Rostedt (Red Hat) 
225979922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
226079922b80SSteven Rostedt (Red Hat) 
226179922b80SSteven Rostedt (Red Hat) 	return NULL;
226279922b80SSteven Rostedt (Red Hat) }
226379922b80SSteven Rostedt (Red Hat) 
226479922b80SSteven Rostedt (Red Hat) static struct ftrace_ops *
226579922b80SSteven Rostedt (Red Hat) ftrace_find_tramp_ops_new(struct dyn_ftrace *rec)
226679922b80SSteven Rostedt (Red Hat) {
226779922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
2268fef5aeeeSSteven Rostedt (Red Hat) 	unsigned long ip = rec->ip;
226979922b80SSteven Rostedt (Red Hat) 
227079922b80SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
227179922b80SSteven Rostedt (Red Hat) 		/* pass rec in as regs to have non-NULL val */
2272fef5aeeeSSteven Rostedt (Red Hat) 		if (hash_contains_ip(ip, op->func_hash))
227379922b80SSteven Rostedt (Red Hat) 			return op;
227479922b80SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
227579922b80SSteven Rostedt (Red Hat) 
227679922b80SSteven Rostedt (Red Hat) 	return NULL;
227779922b80SSteven Rostedt (Red Hat) }
227879922b80SSteven Rostedt (Red Hat) 
22797413af1fSSteven Rostedt (Red Hat) /**
22807413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_new - Get the call address to set to
22817413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
22827413af1fSSteven Rostedt (Red Hat)  *
22837413af1fSSteven Rostedt (Red Hat)  * If the record has the FTRACE_FL_REGS set, that means that it
22847413af1fSSteven Rostedt (Red Hat)  * wants to convert to a callback that saves all regs. If FTRACE_FL_REGS
22857413af1fSSteven Rostedt (Red Hat)  * is not not set, then it wants to convert to the normal callback.
22867413af1fSSteven Rostedt (Red Hat)  *
22877413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline to set to
22887413af1fSSteven Rostedt (Red Hat)  */
22897413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_new(struct dyn_ftrace *rec)
22907413af1fSSteven Rostedt (Red Hat) {
229179922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
229279922b80SSteven Rostedt (Red Hat) 
229379922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
229479922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP) {
229579922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_new(rec);
229679922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops || !ops->trampoline)) {
2297bce0b6c5SSteven Rostedt (Red Hat) 			pr_warn("Bad trampoline accounting at: %p (%pS) (%lx)\n",
2298bce0b6c5SSteven Rostedt (Red Hat) 				(void *)rec->ip, (void *)rec->ip, rec->flags);
229979922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
230079922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
230179922b80SSteven Rostedt (Red Hat) 		}
230279922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
230379922b80SSteven Rostedt (Red Hat) 	}
230479922b80SSteven Rostedt (Red Hat) 
23057413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS)
23067413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23077413af1fSSteven Rostedt (Red Hat) 	else
23087413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23097413af1fSSteven Rostedt (Red Hat) }
23107413af1fSSteven Rostedt (Red Hat) 
23117413af1fSSteven Rostedt (Red Hat) /**
23127413af1fSSteven Rostedt (Red Hat)  * ftrace_get_addr_curr - Get the call address that is already there
23137413af1fSSteven Rostedt (Red Hat)  * @rec:  The ftrace record descriptor
23147413af1fSSteven Rostedt (Red Hat)  *
23157413af1fSSteven Rostedt (Red Hat)  * The FTRACE_FL_REGS_EN is set when the record already points to
23167413af1fSSteven Rostedt (Red Hat)  * a function that saves all the regs. Basically the '_EN' version
23177413af1fSSteven Rostedt (Red Hat)  * represents the current state of the function.
23187413af1fSSteven Rostedt (Red Hat)  *
23197413af1fSSteven Rostedt (Red Hat)  * Returns the address of the trampoline that is currently being called
23207413af1fSSteven Rostedt (Red Hat)  */
23217413af1fSSteven Rostedt (Red Hat) unsigned long ftrace_get_addr_curr(struct dyn_ftrace *rec)
23227413af1fSSteven Rostedt (Red Hat) {
232379922b80SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
232479922b80SSteven Rostedt (Red Hat) 
232579922b80SSteven Rostedt (Red Hat) 	/* Trampolines take precedence over regs */
232679922b80SSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_TRAMP_EN) {
232779922b80SSteven Rostedt (Red Hat) 		ops = ftrace_find_tramp_ops_curr(rec);
232879922b80SSteven Rostedt (Red Hat) 		if (FTRACE_WARN_ON(!ops)) {
232979922b80SSteven Rostedt (Red Hat) 			pr_warning("Bad trampoline accounting at: %p (%pS)\n",
233079922b80SSteven Rostedt (Red Hat) 				    (void *)rec->ip, (void *)rec->ip);
233179922b80SSteven Rostedt (Red Hat) 			/* Ftrace is shutting down, return anything */
233279922b80SSteven Rostedt (Red Hat) 			return (unsigned long)FTRACE_ADDR;
233379922b80SSteven Rostedt (Red Hat) 		}
233479922b80SSteven Rostedt (Red Hat) 		return ops->trampoline;
233579922b80SSteven Rostedt (Red Hat) 	}
233679922b80SSteven Rostedt (Red Hat) 
23377413af1fSSteven Rostedt (Red Hat) 	if (rec->flags & FTRACE_FL_REGS_EN)
23387413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_REGS_ADDR;
23397413af1fSSteven Rostedt (Red Hat) 	else
23407413af1fSSteven Rostedt (Red Hat) 		return (unsigned long)FTRACE_ADDR;
23417413af1fSSteven Rostedt (Red Hat) }
23427413af1fSSteven Rostedt (Red Hat) 
2343c88fd863SSteven Rostedt static int
2344c88fd863SSteven Rostedt __ftrace_replace_code(struct dyn_ftrace *rec, int enable)
2345c88fd863SSteven Rostedt {
234608f6fba5SSteven Rostedt 	unsigned long ftrace_old_addr;
2347c88fd863SSteven Rostedt 	unsigned long ftrace_addr;
2348c88fd863SSteven Rostedt 	int ret;
2349c88fd863SSteven Rostedt 
23507c0868e0SSteven Rostedt (Red Hat) 	ftrace_addr = ftrace_get_addr_new(rec);
2351c88fd863SSteven Rostedt 
23527c0868e0SSteven Rostedt (Red Hat) 	/* This needs to be done before we call ftrace_update_record */
23537c0868e0SSteven Rostedt (Red Hat) 	ftrace_old_addr = ftrace_get_addr_curr(rec);
23547c0868e0SSteven Rostedt (Red Hat) 
23557c0868e0SSteven Rostedt (Red Hat) 	ret = ftrace_update_record(rec, enable);
235608f6fba5SSteven Rostedt 
235702a392a0SSteven Rostedt (Red Hat) 	ftrace_bug_type = FTRACE_BUG_UNKNOWN;
235802a392a0SSteven Rostedt (Red Hat) 
2359c88fd863SSteven Rostedt 	switch (ret) {
2360c88fd863SSteven Rostedt 	case FTRACE_UPDATE_IGNORE:
2361c88fd863SSteven Rostedt 		return 0;
2362c88fd863SSteven Rostedt 
2363c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_CALL:
236402a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_CALL;
2365c88fd863SSteven Rostedt 		return ftrace_make_call(rec, ftrace_addr);
2366c88fd863SSteven Rostedt 
2367c88fd863SSteven Rostedt 	case FTRACE_UPDATE_MAKE_NOP:
236802a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_NOP;
236939b5552cSSteven Rostedt (Red Hat) 		return ftrace_make_nop(NULL, rec, ftrace_old_addr);
237008f6fba5SSteven Rostedt 
237108f6fba5SSteven Rostedt 	case FTRACE_UPDATE_MODIFY_CALL:
237202a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_UPDATE;
237308f6fba5SSteven Rostedt 		return ftrace_modify_call(rec, ftrace_old_addr, ftrace_addr);
23743d083395SSteven Rostedt 	}
23753d083395SSteven Rostedt 
2376c88fd863SSteven Rostedt 	return -1; /* unknow ftrace bug */
2377c88fd863SSteven Rostedt }
2378c88fd863SSteven Rostedt 
2379e4f5d544SSteven Rostedt void __weak ftrace_replace_code(int enable)
23803d083395SSteven Rostedt {
23813d083395SSteven Rostedt 	struct dyn_ftrace *rec;
23823d083395SSteven Rostedt 	struct ftrace_page *pg;
23836a24a244SSteven Rostedt 	int failed;
23843d083395SSteven Rostedt 
238545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
238645a4a237SSteven Rostedt 		return;
238745a4a237SSteven Rostedt 
2388265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
2389e4f5d544SSteven Rostedt 		failed = __ftrace_replace_code(rec, enable);
2390fa9d13cfSZhaolei 		if (failed) {
23914fd3279bSSteven Rostedt (Red Hat) 			ftrace_bug(failed, rec);
23924377245aSSteven Rostedt 			/* Stop processing */
23934377245aSSteven Rostedt 			return;
23944377245aSSteven Rostedt 		}
2395265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
23963d083395SSteven Rostedt }
23973c1720f0SSteven Rostedt 
2398c88fd863SSteven Rostedt struct ftrace_rec_iter {
2399c88fd863SSteven Rostedt 	struct ftrace_page	*pg;
2400c88fd863SSteven Rostedt 	int			index;
2401c88fd863SSteven Rostedt };
2402c88fd863SSteven Rostedt 
2403c88fd863SSteven Rostedt /**
2404c88fd863SSteven Rostedt  * ftrace_rec_iter_start, start up iterating over traced functions
2405c88fd863SSteven Rostedt  *
2406c88fd863SSteven Rostedt  * Returns an iterator handle that is used to iterate over all
2407c88fd863SSteven Rostedt  * the records that represent address locations where functions
2408c88fd863SSteven Rostedt  * are traced.
2409c88fd863SSteven Rostedt  *
2410c88fd863SSteven Rostedt  * May return NULL if no records are available.
2411c88fd863SSteven Rostedt  */
2412c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_start(void)
2413c88fd863SSteven Rostedt {
2414c88fd863SSteven Rostedt 	/*
2415c88fd863SSteven Rostedt 	 * We only use a single iterator.
2416c88fd863SSteven Rostedt 	 * Protected by the ftrace_lock mutex.
2417c88fd863SSteven Rostedt 	 */
2418c88fd863SSteven Rostedt 	static struct ftrace_rec_iter ftrace_rec_iter;
2419c88fd863SSteven Rostedt 	struct ftrace_rec_iter *iter = &ftrace_rec_iter;
2420c88fd863SSteven Rostedt 
2421c88fd863SSteven Rostedt 	iter->pg = ftrace_pages_start;
2422c88fd863SSteven Rostedt 	iter->index = 0;
2423c88fd863SSteven Rostedt 
2424c88fd863SSteven Rostedt 	/* Could have empty pages */
2425c88fd863SSteven Rostedt 	while (iter->pg && !iter->pg->index)
2426c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2427c88fd863SSteven Rostedt 
2428c88fd863SSteven Rostedt 	if (!iter->pg)
2429c88fd863SSteven Rostedt 		return NULL;
2430c88fd863SSteven Rostedt 
2431c88fd863SSteven Rostedt 	return iter;
2432c88fd863SSteven Rostedt }
2433c88fd863SSteven Rostedt 
2434c88fd863SSteven Rostedt /**
2435c88fd863SSteven Rostedt  * ftrace_rec_iter_next, get the next record to process.
2436c88fd863SSteven Rostedt  * @iter: The handle to the iterator.
2437c88fd863SSteven Rostedt  *
2438c88fd863SSteven Rostedt  * Returns the next iterator after the given iterator @iter.
2439c88fd863SSteven Rostedt  */
2440c88fd863SSteven Rostedt struct ftrace_rec_iter *ftrace_rec_iter_next(struct ftrace_rec_iter *iter)
2441c88fd863SSteven Rostedt {
2442c88fd863SSteven Rostedt 	iter->index++;
2443c88fd863SSteven Rostedt 
2444c88fd863SSteven Rostedt 	if (iter->index >= iter->pg->index) {
2445c88fd863SSteven Rostedt 		iter->pg = iter->pg->next;
2446c88fd863SSteven Rostedt 		iter->index = 0;
2447c88fd863SSteven Rostedt 
2448c88fd863SSteven Rostedt 		/* Could have empty pages */
2449c88fd863SSteven Rostedt 		while (iter->pg && !iter->pg->index)
2450c88fd863SSteven Rostedt 			iter->pg = iter->pg->next;
2451c88fd863SSteven Rostedt 	}
2452c88fd863SSteven Rostedt 
2453c88fd863SSteven Rostedt 	if (!iter->pg)
2454c88fd863SSteven Rostedt 		return NULL;
2455c88fd863SSteven Rostedt 
2456c88fd863SSteven Rostedt 	return iter;
2457c88fd863SSteven Rostedt }
2458c88fd863SSteven Rostedt 
2459c88fd863SSteven Rostedt /**
2460c88fd863SSteven Rostedt  * ftrace_rec_iter_record, get the record at the iterator location
2461c88fd863SSteven Rostedt  * @iter: The current iterator location
2462c88fd863SSteven Rostedt  *
2463c88fd863SSteven Rostedt  * Returns the record that the current @iter is at.
2464c88fd863SSteven Rostedt  */
2465c88fd863SSteven Rostedt struct dyn_ftrace *ftrace_rec_iter_record(struct ftrace_rec_iter *iter)
2466c88fd863SSteven Rostedt {
2467c88fd863SSteven Rostedt 	return &iter->pg->records[iter->index];
2468c88fd863SSteven Rostedt }
2469c88fd863SSteven Rostedt 
24703b47bfc1SSteven Rostedt static int
247131e88909SSteven Rostedt ftrace_code_disable(struct module *mod, struct dyn_ftrace *rec)
24723c1720f0SSteven Rostedt {
2473492a7ea5SAbhishek Sagar 	int ret;
247437ad5084SSteven Rostedt 
247545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
247645a4a237SSteven Rostedt 		return 0;
247745a4a237SSteven Rostedt 
247825aac9dcSShaohua Li 	ret = ftrace_make_nop(mod, rec, MCOUNT_ADDR);
24793d083395SSteven Rostedt 	if (ret) {
248002a392a0SSteven Rostedt (Red Hat) 		ftrace_bug_type = FTRACE_BUG_INIT;
24814fd3279bSSteven Rostedt (Red Hat) 		ftrace_bug(ret, rec);
24823d083395SSteven Rostedt 		return 0;
2483d61f82d0SSteven Rostedt 	}
2484d61f82d0SSteven Rostedt 	return 1;
24853d083395SSteven Rostedt }
24863d083395SSteven Rostedt 
2487000ab691SSteven Rostedt /*
2488000ab691SSteven Rostedt  * archs can override this function if they must do something
2489000ab691SSteven Rostedt  * before the modifying code is performed.
2490000ab691SSteven Rostedt  */
2491000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_prepare(void)
2492000ab691SSteven Rostedt {
2493000ab691SSteven Rostedt 	return 0;
2494000ab691SSteven Rostedt }
2495000ab691SSteven Rostedt 
2496000ab691SSteven Rostedt /*
2497000ab691SSteven Rostedt  * archs can override this function if they must do something
2498000ab691SSteven Rostedt  * after the modifying code is performed.
2499000ab691SSteven Rostedt  */
2500000ab691SSteven Rostedt int __weak ftrace_arch_code_modify_post_process(void)
2501000ab691SSteven Rostedt {
2502000ab691SSteven Rostedt 	return 0;
2503000ab691SSteven Rostedt }
2504000ab691SSteven Rostedt 
25058ed3e2cfSSteven Rostedt void ftrace_modify_all_code(int command)
25068ed3e2cfSSteven Rostedt {
250759338f75SSteven Rostedt (Red Hat) 	int update = command & FTRACE_UPDATE_TRACE_FUNC;
2508cd21067fSPetr Mladek 	int err = 0;
250959338f75SSteven Rostedt (Red Hat) 
251059338f75SSteven Rostedt (Red Hat) 	/*
251159338f75SSteven Rostedt (Red Hat) 	 * If the ftrace_caller calls a ftrace_ops func directly,
251259338f75SSteven Rostedt (Red Hat) 	 * we need to make sure that it only traces functions it
251359338f75SSteven Rostedt (Red Hat) 	 * expects to trace. When doing the switch of functions,
251459338f75SSteven Rostedt (Red Hat) 	 * we need to update to the ftrace_ops_list_func first
251559338f75SSteven Rostedt (Red Hat) 	 * before the transition between old and new calls are set,
251659338f75SSteven Rostedt (Red Hat) 	 * as the ftrace_ops_list_func will check the ops hashes
251759338f75SSteven Rostedt (Red Hat) 	 * to make sure the ops are having the right functions
251859338f75SSteven Rostedt (Red Hat) 	 * traced.
251959338f75SSteven Rostedt (Red Hat) 	 */
2520cd21067fSPetr Mladek 	if (update) {
2521cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_ops_list_func);
2522cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2523cd21067fSPetr Mladek 			return;
2524cd21067fSPetr Mladek 	}
252559338f75SSteven Rostedt (Red Hat) 
25268ed3e2cfSSteven Rostedt 	if (command & FTRACE_UPDATE_CALLS)
25278ed3e2cfSSteven Rostedt 		ftrace_replace_code(1);
25288ed3e2cfSSteven Rostedt 	else if (command & FTRACE_DISABLE_CALLS)
25298ed3e2cfSSteven Rostedt 		ftrace_replace_code(0);
25308ed3e2cfSSteven Rostedt 
2531405e1d83SSteven Rostedt (Red Hat) 	if (update && ftrace_trace_function != ftrace_ops_list_func) {
2532405e1d83SSteven Rostedt (Red Hat) 		function_trace_op = set_function_trace_op;
2533405e1d83SSteven Rostedt (Red Hat) 		smp_wmb();
2534405e1d83SSteven Rostedt (Red Hat) 		/* If irqs are disabled, we are in stop machine */
2535405e1d83SSteven Rostedt (Red Hat) 		if (!irqs_disabled())
2536405e1d83SSteven Rostedt (Red Hat) 			smp_call_function(ftrace_sync_ipi, NULL, 1);
2537cd21067fSPetr Mladek 		err = ftrace_update_ftrace_func(ftrace_trace_function);
2538cd21067fSPetr Mladek 		if (FTRACE_WARN_ON(err))
2539cd21067fSPetr Mladek 			return;
2540405e1d83SSteven Rostedt (Red Hat) 	}
25418ed3e2cfSSteven Rostedt 
25428ed3e2cfSSteven Rostedt 	if (command & FTRACE_START_FUNC_RET)
2543cd21067fSPetr Mladek 		err = ftrace_enable_ftrace_graph_caller();
25448ed3e2cfSSteven Rostedt 	else if (command & FTRACE_STOP_FUNC_RET)
2545cd21067fSPetr Mladek 		err = ftrace_disable_ftrace_graph_caller();
2546cd21067fSPetr Mladek 	FTRACE_WARN_ON(err);
25478ed3e2cfSSteven Rostedt }
25488ed3e2cfSSteven Rostedt 
25493d083395SSteven Rostedt static int __ftrace_modify_code(void *data)
25503d083395SSteven Rostedt {
25513d083395SSteven Rostedt 	int *command = data;
25523d083395SSteven Rostedt 
25538ed3e2cfSSteven Rostedt 	ftrace_modify_all_code(*command);
25545a45cfe1SSteven Rostedt 
2555c88fd863SSteven Rostedt 	return 0;
2556c88fd863SSteven Rostedt }
2557c88fd863SSteven Rostedt 
2558c88fd863SSteven Rostedt /**
2559c88fd863SSteven Rostedt  * ftrace_run_stop_machine, go back to the stop machine method
2560c88fd863SSteven Rostedt  * @command: The command to tell ftrace what to do
2561c88fd863SSteven Rostedt  *
2562c88fd863SSteven Rostedt  * If an arch needs to fall back to the stop machine method, the
2563c88fd863SSteven Rostedt  * it can call this function.
2564c88fd863SSteven Rostedt  */
2565c88fd863SSteven Rostedt void ftrace_run_stop_machine(int command)
2566c88fd863SSteven Rostedt {
2567c88fd863SSteven Rostedt 	stop_machine(__ftrace_modify_code, &command, NULL);
2568c88fd863SSteven Rostedt }
2569c88fd863SSteven Rostedt 
2570c88fd863SSteven Rostedt /**
2571c88fd863SSteven Rostedt  * arch_ftrace_update_code, modify the code to trace or not trace
2572c88fd863SSteven Rostedt  * @command: The command that needs to be done
2573c88fd863SSteven Rostedt  *
2574c88fd863SSteven Rostedt  * Archs can override this function if it does not need to
2575c88fd863SSteven Rostedt  * run stop_machine() to modify code.
2576c88fd863SSteven Rostedt  */
2577c88fd863SSteven Rostedt void __weak arch_ftrace_update_code(int command)
2578c88fd863SSteven Rostedt {
2579c88fd863SSteven Rostedt 	ftrace_run_stop_machine(command);
2580c88fd863SSteven Rostedt }
2581c88fd863SSteven Rostedt 
2582c88fd863SSteven Rostedt static void ftrace_run_update_code(int command)
2583c88fd863SSteven Rostedt {
2584c88fd863SSteven Rostedt 	int ret;
2585c88fd863SSteven Rostedt 
2586c88fd863SSteven Rostedt 	ret = ftrace_arch_code_modify_prepare();
2587c88fd863SSteven Rostedt 	FTRACE_WARN_ON(ret);
2588c88fd863SSteven Rostedt 	if (ret)
2589c88fd863SSteven Rostedt 		return;
2590c88fd863SSteven Rostedt 
2591c88fd863SSteven Rostedt 	/*
2592c88fd863SSteven Rostedt 	 * By default we use stop_machine() to modify the code.
2593c88fd863SSteven Rostedt 	 * But archs can do what ever they want as long as it
2594c88fd863SSteven Rostedt 	 * is safe. The stop_machine() is the safest, but also
2595c88fd863SSteven Rostedt 	 * produces the most overhead.
2596c88fd863SSteven Rostedt 	 */
2597c88fd863SSteven Rostedt 	arch_ftrace_update_code(command);
2598c88fd863SSteven Rostedt 
2599000ab691SSteven Rostedt 	ret = ftrace_arch_code_modify_post_process();
2600000ab691SSteven Rostedt 	FTRACE_WARN_ON(ret);
26013d083395SSteven Rostedt }
26023d083395SSteven Rostedt 
26038252ecf3SSteven Rostedt (Red Hat) static void ftrace_run_modify_code(struct ftrace_ops *ops, int command,
26047485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
2605e1effa01SSteven Rostedt (Red Hat) {
2606e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_MODIFYING;
26077485058eSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = old_hash->filter_hash;
26087485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = old_hash->notrace_hash;
2609e1effa01SSteven Rostedt (Red Hat) 	ftrace_run_update_code(command);
26108252ecf3SSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
26117485058eSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2612e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_MODIFYING;
2613e1effa01SSteven Rostedt (Red Hat) }
2614e1effa01SSteven Rostedt (Red Hat) 
26153d083395SSteven Rostedt static ftrace_func_t saved_ftrace_func;
261660a7ecf4SSteven Rostedt static int ftrace_start_up;
2617df4fc315SSteven Rostedt 
261812cce594SSteven Rostedt (Red Hat) void __weak arch_ftrace_trampoline_free(struct ftrace_ops *ops)
261912cce594SSteven Rostedt (Red Hat) {
262012cce594SSteven Rostedt (Red Hat) }
262112cce594SSteven Rostedt (Red Hat) 
2622ba27f2bcSSteven Rostedt (Red Hat) static void per_cpu_ops_free(struct ftrace_ops *ops)
2623db0fbadcSJiri Slaby {
2624db0fbadcSJiri Slaby 	free_percpu(ops->disabled);
2625db0fbadcSJiri Slaby }
2626db0fbadcSJiri Slaby 
2627df4fc315SSteven Rostedt static void ftrace_startup_enable(int command)
2628df4fc315SSteven Rostedt {
2629df4fc315SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2630df4fc315SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2631df4fc315SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2632df4fc315SSteven Rostedt 	}
2633df4fc315SSteven Rostedt 
2634df4fc315SSteven Rostedt 	if (!command || !ftrace_enabled)
2635df4fc315SSteven Rostedt 		return;
2636df4fc315SSteven Rostedt 
2637df4fc315SSteven Rostedt 	ftrace_run_update_code(command);
2638df4fc315SSteven Rostedt }
26393d083395SSteven Rostedt 
2640e1effa01SSteven Rostedt (Red Hat) static void ftrace_startup_all(int command)
2641e1effa01SSteven Rostedt (Red Hat) {
2642e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = true;
2643e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_enable(command);
2644e1effa01SSteven Rostedt (Red Hat) 	update_all_ops = false;
2645e1effa01SSteven Rostedt (Red Hat) }
2646e1effa01SSteven Rostedt (Red Hat) 
2647a1cd6173SSteven Rostedt static int ftrace_startup(struct ftrace_ops *ops, int command)
26483d083395SSteven Rostedt {
26498a56d776SSteven Rostedt (Red Hat) 	int ret;
2650b848914cSSteven Rostedt 
26514eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
2652a1cd6173SSteven Rostedt 		return -ENODEV;
26534eebcc81SSteven Rostedt 
26548a56d776SSteven Rostedt (Red Hat) 	ret = __register_ftrace_function(ops);
26558a56d776SSteven Rostedt (Red Hat) 	if (ret)
26568a56d776SSteven Rostedt (Red Hat) 		return ret;
26578a56d776SSteven Rostedt (Red Hat) 
265860a7ecf4SSteven Rostedt 	ftrace_start_up++;
265930fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
26603d083395SSteven Rostedt 
2661e1effa01SSteven Rostedt (Red Hat) 	/*
2662e1effa01SSteven Rostedt (Red Hat) 	 * Note that ftrace probes uses this to start up
2663e1effa01SSteven Rostedt (Red Hat) 	 * and modify functions it will probe. But we still
2664e1effa01SSteven Rostedt (Red Hat) 	 * set the ADDING flag for modification, as probes
2665e1effa01SSteven Rostedt (Red Hat) 	 * do not have trampolines. If they add them in the
2666e1effa01SSteven Rostedt (Red Hat) 	 * future, then the probes will need to distinguish
2667e1effa01SSteven Rostedt (Red Hat) 	 * between adding and updating probes.
2668e1effa01SSteven Rostedt (Red Hat) 	 */
2669e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_ENABLED | FTRACE_OPS_FL_ADDING;
267066209a5bSSteven Rostedt (Red Hat) 
2671f8b8be8aSMasami Hiramatsu 	ret = ftrace_hash_ipmodify_enable(ops);
2672f8b8be8aSMasami Hiramatsu 	if (ret < 0) {
2673f8b8be8aSMasami Hiramatsu 		/* Rollback registration process */
2674f8b8be8aSMasami Hiramatsu 		__unregister_ftrace_function(ops);
2675f8b8be8aSMasami Hiramatsu 		ftrace_start_up--;
2676f8b8be8aSMasami Hiramatsu 		ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2677f8b8be8aSMasami Hiramatsu 		return ret;
2678f8b8be8aSMasami Hiramatsu 	}
2679f8b8be8aSMasami Hiramatsu 
2680ed926f9bSSteven Rostedt 	ftrace_hash_rec_enable(ops, 1);
2681ed926f9bSSteven Rostedt 
2682df4fc315SSteven Rostedt 	ftrace_startup_enable(command);
2683a1cd6173SSteven Rostedt 
2684e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_ADDING;
2685e1effa01SSteven Rostedt (Red Hat) 
2686a1cd6173SSteven Rostedt 	return 0;
26873d083395SSteven Rostedt }
26883d083395SSteven Rostedt 
26898a56d776SSteven Rostedt (Red Hat) static int ftrace_shutdown(struct ftrace_ops *ops, int command)
26903d083395SSteven Rostedt {
26918a56d776SSteven Rostedt (Red Hat) 	int ret;
2692b848914cSSteven Rostedt 
26934eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
26948a56d776SSteven Rostedt (Red Hat) 		return -ENODEV;
26958a56d776SSteven Rostedt (Red Hat) 
26968a56d776SSteven Rostedt (Red Hat) 	ret = __unregister_ftrace_function(ops);
26978a56d776SSteven Rostedt (Red Hat) 	if (ret)
26988a56d776SSteven Rostedt (Red Hat) 		return ret;
26994eebcc81SSteven Rostedt 
270060a7ecf4SSteven Rostedt 	ftrace_start_up--;
27019ea1a153SFrederic Weisbecker 	/*
27029ea1a153SFrederic Weisbecker 	 * Just warn in case of unbalance, no need to kill ftrace, it's not
27039ea1a153SFrederic Weisbecker 	 * critical but the ftrace_call callers may be never nopped again after
27049ea1a153SFrederic Weisbecker 	 * further ftrace uses.
27059ea1a153SFrederic Weisbecker 	 */
27069ea1a153SFrederic Weisbecker 	WARN_ON_ONCE(ftrace_start_up < 0);
27079ea1a153SFrederic Weisbecker 
2708f8b8be8aSMasami Hiramatsu 	/* Disabling ipmodify never fails */
2709f8b8be8aSMasami Hiramatsu 	ftrace_hash_ipmodify_disable(ops);
2710ed926f9bSSteven Rostedt 	ftrace_hash_rec_disable(ops, 1);
2711ed926f9bSSteven Rostedt 
2712ed926f9bSSteven Rostedt 	ops->flags &= ~FTRACE_OPS_FL_ENABLED;
2713b848914cSSteven Rostedt 
271430fb6aa7SJiri Olsa 	command |= FTRACE_UPDATE_CALLS;
2715d61f82d0SSteven Rostedt 
2716d61f82d0SSteven Rostedt 	if (saved_ftrace_func != ftrace_trace_function) {
2717d61f82d0SSteven Rostedt 		saved_ftrace_func = ftrace_trace_function;
2718d61f82d0SSteven Rostedt 		command |= FTRACE_UPDATE_TRACE_FUNC;
2719d61f82d0SSteven Rostedt 	}
2720d61f82d0SSteven Rostedt 
2721a4c35ed2SSteven Rostedt (Red Hat) 	if (!command || !ftrace_enabled) {
2722a4c35ed2SSteven Rostedt (Red Hat) 		/*
2723ba27f2bcSSteven Rostedt (Red Hat) 		 * If these are per_cpu ops, they still need their
2724a4c35ed2SSteven Rostedt (Red Hat) 		 * per_cpu field freed. Since, function tracing is
2725a4c35ed2SSteven Rostedt (Red Hat) 		 * not currently active, we can just free them
2726a4c35ed2SSteven Rostedt (Red Hat) 		 * without synchronizing all CPUs.
2727a4c35ed2SSteven Rostedt (Red Hat) 		 */
2728ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2729ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
27308a56d776SSteven Rostedt (Red Hat) 		return 0;
2731a4c35ed2SSteven Rostedt (Red Hat) 	}
27323d083395SSteven Rostedt 
273379922b80SSteven Rostedt (Red Hat) 	/*
273479922b80SSteven Rostedt (Red Hat) 	 * If the ops uses a trampoline, then it needs to be
273579922b80SSteven Rostedt (Red Hat) 	 * tested first on update.
273679922b80SSteven Rostedt (Red Hat) 	 */
2737e1effa01SSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_REMOVING;
273879922b80SSteven Rostedt (Red Hat) 	removed_ops = ops;
273979922b80SSteven Rostedt (Red Hat) 
2740fef5aeeeSSteven Rostedt (Red Hat) 	/* The trampoline logic checks the old hashes */
2741fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = ops->func_hash->filter_hash;
2742fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = ops->func_hash->notrace_hash;
2743fef5aeeeSSteven Rostedt (Red Hat) 
2744d61f82d0SSteven Rostedt 	ftrace_run_update_code(command);
2745a4c35ed2SSteven Rostedt (Red Hat) 
274684bde62cSSteven Rostedt (Red Hat) 	/*
274784bde62cSSteven Rostedt (Red Hat) 	 * If there's no more ops registered with ftrace, run a
274884bde62cSSteven Rostedt (Red Hat) 	 * sanity check to make sure all rec flags are cleared.
274984bde62cSSteven Rostedt (Red Hat) 	 */
275084bde62cSSteven Rostedt (Red Hat) 	if (ftrace_ops_list == &ftrace_list_end) {
275184bde62cSSteven Rostedt (Red Hat) 		struct ftrace_page *pg;
275284bde62cSSteven Rostedt (Red Hat) 		struct dyn_ftrace *rec;
275384bde62cSSteven Rostedt (Red Hat) 
275484bde62cSSteven Rostedt (Red Hat) 		do_for_each_ftrace_rec(pg, rec) {
275584bde62cSSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON_ONCE(rec->flags))
275684bde62cSSteven Rostedt (Red Hat) 				pr_warn("  %pS flags:%lx\n",
275784bde62cSSteven Rostedt (Red Hat) 					(void *)rec->ip, rec->flags);
275884bde62cSSteven Rostedt (Red Hat) 		} while_for_each_ftrace_rec();
275984bde62cSSteven Rostedt (Red Hat) 	}
276084bde62cSSteven Rostedt (Red Hat) 
2761fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.filter_hash = NULL;
2762fef5aeeeSSteven Rostedt (Red Hat) 	ops->old_hash.notrace_hash = NULL;
2763fef5aeeeSSteven Rostedt (Red Hat) 
2764fef5aeeeSSteven Rostedt (Red Hat) 	removed_ops = NULL;
2765e1effa01SSteven Rostedt (Red Hat) 	ops->flags &= ~FTRACE_OPS_FL_REMOVING;
276679922b80SSteven Rostedt (Red Hat) 
2767a4c35ed2SSteven Rostedt (Red Hat) 	/*
2768a4c35ed2SSteven Rostedt (Red Hat) 	 * Dynamic ops may be freed, we must make sure that all
2769a4c35ed2SSteven Rostedt (Red Hat) 	 * callers are done before leaving this function.
2770ba27f2bcSSteven Rostedt (Red Hat) 	 * The same goes for freeing the per_cpu data of the per_cpu
2771a4c35ed2SSteven Rostedt (Red Hat) 	 * ops.
2772a4c35ed2SSteven Rostedt (Red Hat) 	 *
2773a4c35ed2SSteven Rostedt (Red Hat) 	 * Again, normal synchronize_sched() is not good enough.
2774a4c35ed2SSteven Rostedt (Red Hat) 	 * We need to do a hard force of sched synchronization.
2775a4c35ed2SSteven Rostedt (Red Hat) 	 * This is because we use preempt_disable() to do RCU, but
2776a4c35ed2SSteven Rostedt (Red Hat) 	 * the function tracers can be called where RCU is not watching
2777a4c35ed2SSteven Rostedt (Red Hat) 	 * (like before user_exit()). We can not rely on the RCU
2778a4c35ed2SSteven Rostedt (Red Hat) 	 * infrastructure to do the synchronization, thus we must do it
2779a4c35ed2SSteven Rostedt (Red Hat) 	 * ourselves.
2780a4c35ed2SSteven Rostedt (Red Hat) 	 */
2781ba27f2bcSSteven Rostedt (Red Hat) 	if (ops->flags & (FTRACE_OPS_FL_DYNAMIC | FTRACE_OPS_FL_PER_CPU)) {
2782a4c35ed2SSteven Rostedt (Red Hat) 		schedule_on_each_cpu(ftrace_sync);
2783a4c35ed2SSteven Rostedt (Red Hat) 
278412cce594SSteven Rostedt (Red Hat) 		arch_ftrace_trampoline_free(ops);
278512cce594SSteven Rostedt (Red Hat) 
2786ba27f2bcSSteven Rostedt (Red Hat) 		if (ops->flags & FTRACE_OPS_FL_PER_CPU)
2787ba27f2bcSSteven Rostedt (Red Hat) 			per_cpu_ops_free(ops);
2788a4c35ed2SSteven Rostedt (Red Hat) 	}
2789a4c35ed2SSteven Rostedt (Red Hat) 
27908a56d776SSteven Rostedt (Red Hat) 	return 0;
27913d083395SSteven Rostedt }
27923d083395SSteven Rostedt 
2793e309b41dSIngo Molnar static void ftrace_startup_sysctl(void)
2794b0fc494fSSteven Rostedt {
27951619dc3fSPratyush Anand 	int command;
27961619dc3fSPratyush Anand 
27974eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
27984eebcc81SSteven Rostedt 		return;
27994eebcc81SSteven Rostedt 
2800d61f82d0SSteven Rostedt 	/* Force update next time */
2801d61f82d0SSteven Rostedt 	saved_ftrace_func = NULL;
280260a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if we want ftrace running */
28031619dc3fSPratyush Anand 	if (ftrace_start_up) {
28041619dc3fSPratyush Anand 		command = FTRACE_UPDATE_CALLS;
28051619dc3fSPratyush Anand 		if (ftrace_graph_active)
28061619dc3fSPratyush Anand 			command |= FTRACE_START_FUNC_RET;
2807524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_enable(command);
28081619dc3fSPratyush Anand 	}
2809b0fc494fSSteven Rostedt }
2810b0fc494fSSteven Rostedt 
2811e309b41dSIngo Molnar static void ftrace_shutdown_sysctl(void)
2812b0fc494fSSteven Rostedt {
28131619dc3fSPratyush Anand 	int command;
28141619dc3fSPratyush Anand 
28154eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
28164eebcc81SSteven Rostedt 		return;
28174eebcc81SSteven Rostedt 
281860a7ecf4SSteven Rostedt 	/* ftrace_start_up is true if ftrace is running */
28191619dc3fSPratyush Anand 	if (ftrace_start_up) {
28201619dc3fSPratyush Anand 		command = FTRACE_DISABLE_CALLS;
28211619dc3fSPratyush Anand 		if (ftrace_graph_active)
28221619dc3fSPratyush Anand 			command |= FTRACE_STOP_FUNC_RET;
28231619dc3fSPratyush Anand 		ftrace_run_update_code(command);
28241619dc3fSPratyush Anand 	}
2825b0fc494fSSteven Rostedt }
2826b0fc494fSSteven Rostedt 
28273d083395SSteven Rostedt static cycle_t		ftrace_update_time;
28283d083395SSteven Rostedt unsigned long		ftrace_update_tot_cnt;
28293d083395SSteven Rostedt 
28308c4f3c3fSSteven Rostedt (Red Hat) static inline int ops_traces_mod(struct ftrace_ops *ops)
2831f7bc8b61SSteven Rostedt {
28328c4f3c3fSSteven Rostedt (Red Hat) 	/*
28338c4f3c3fSSteven Rostedt (Red Hat) 	 * Filter_hash being empty will default to trace module.
28348c4f3c3fSSteven Rostedt (Red Hat) 	 * But notrace hash requires a test of individual module functions.
28358c4f3c3fSSteven Rostedt (Red Hat) 	 */
283633b7f99cSSteven Rostedt (Red Hat) 	return ftrace_hash_empty(ops->func_hash->filter_hash) &&
283733b7f99cSSteven Rostedt (Red Hat) 		ftrace_hash_empty(ops->func_hash->notrace_hash);
28388c4f3c3fSSteven Rostedt (Red Hat) }
2839f7bc8b61SSteven Rostedt 
28408c4f3c3fSSteven Rostedt (Red Hat) /*
28418c4f3c3fSSteven Rostedt (Red Hat)  * Check if the current ops references the record.
28428c4f3c3fSSteven Rostedt (Red Hat)  *
28438c4f3c3fSSteven Rostedt (Red Hat)  * If the ops traces all functions, then it was already accounted for.
28448c4f3c3fSSteven Rostedt (Red Hat)  * If the ops does not trace the current record function, skip it.
28458c4f3c3fSSteven Rostedt (Red Hat)  * If the ops ignores the function via notrace filter, skip it.
28468c4f3c3fSSteven Rostedt (Red Hat)  */
28478c4f3c3fSSteven Rostedt (Red Hat) static inline bool
28488c4f3c3fSSteven Rostedt (Red Hat) ops_references_rec(struct ftrace_ops *ops, struct dyn_ftrace *rec)
28498c4f3c3fSSteven Rostedt (Red Hat) {
28508c4f3c3fSSteven Rostedt (Red Hat) 	/* If ops isn't enabled, ignore it */
28518c4f3c3fSSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_ENABLED))
28528c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28538c4f3c3fSSteven Rostedt (Red Hat) 
2854b7ffffbbSSteven Rostedt (Red Hat) 	/* If ops traces all then it includes this function */
28558c4f3c3fSSteven Rostedt (Red Hat) 	if (ops_traces_mod(ops))
2856b7ffffbbSSteven Rostedt (Red Hat) 		return 1;
28578c4f3c3fSSteven Rostedt (Red Hat) 
28588c4f3c3fSSteven Rostedt (Red Hat) 	/* The function must be in the filter */
285933b7f99cSSteven Rostedt (Red Hat) 	if (!ftrace_hash_empty(ops->func_hash->filter_hash) &&
286033b7f99cSSteven Rostedt (Red Hat) 	    !ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))
28618c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28628c4f3c3fSSteven Rostedt (Red Hat) 
28638c4f3c3fSSteven Rostedt (Red Hat) 	/* If in notrace hash, we ignore it too */
286433b7f99cSSteven Rostedt (Red Hat) 	if (ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip))
28658c4f3c3fSSteven Rostedt (Red Hat) 		return 0;
28668c4f3c3fSSteven Rostedt (Red Hat) 
28678c4f3c3fSSteven Rostedt (Red Hat) 	return 1;
28688c4f3c3fSSteven Rostedt (Red Hat) }
28698c4f3c3fSSteven Rostedt (Red Hat) 
28701dc43cf0SJiri Slaby static int ftrace_update_code(struct module *mod, struct ftrace_page *new_pgs)
28713d083395SSteven Rostedt {
287285ae32aeSSteven Rostedt 	struct ftrace_page *pg;
2873e94142a6SLai Jiangshan 	struct dyn_ftrace *p;
2874f22f9a89SAbhishek Sagar 	cycle_t start, stop;
28751dc43cf0SJiri Slaby 	unsigned long update_cnt = 0;
2876b7ffffbbSSteven Rostedt (Red Hat) 	unsigned long rec_flags = 0;
287785ae32aeSSteven Rostedt 	int i;
2878f7bc8b61SSteven Rostedt 
2879750ed1a4SIngo Molnar 	start = ftrace_now(raw_smp_processor_id());
28803d083395SSteven Rostedt 
2881b7ffffbbSSteven Rostedt (Red Hat) 	/*
2882b7ffffbbSSteven Rostedt (Red Hat) 	 * When a module is loaded, this function is called to convert
2883b7ffffbbSSteven Rostedt (Red Hat) 	 * the calls to mcount in its text to nops, and also to create
2884b7ffffbbSSteven Rostedt (Red Hat) 	 * an entry in the ftrace data. Now, if ftrace is activated
2885b7ffffbbSSteven Rostedt (Red Hat) 	 * after this call, but before the module sets its text to
2886b7ffffbbSSteven Rostedt (Red Hat) 	 * read-only, the modification of enabling ftrace can fail if
2887b7ffffbbSSteven Rostedt (Red Hat) 	 * the read-only is done while ftrace is converting the calls.
2888b7ffffbbSSteven Rostedt (Red Hat) 	 * To prevent this, the module's records are set as disabled
2889b7ffffbbSSteven Rostedt (Red Hat) 	 * and will be enabled after the call to set the module's text
2890b7ffffbbSSteven Rostedt (Red Hat) 	 * to read-only.
2891b7ffffbbSSteven Rostedt (Red Hat) 	 */
2892b7ffffbbSSteven Rostedt (Red Hat) 	if (mod)
2893b7ffffbbSSteven Rostedt (Red Hat) 		rec_flags |= FTRACE_FL_DISABLED;
2894b7ffffbbSSteven Rostedt (Red Hat) 
28951dc43cf0SJiri Slaby 	for (pg = new_pgs; pg; pg = pg->next) {
2896f22f9a89SAbhishek Sagar 
289785ae32aeSSteven Rostedt 		for (i = 0; i < pg->index; i++) {
28988c4f3c3fSSteven Rostedt (Red Hat) 
289908f5ac90SSteven Rostedt 			/* If something went wrong, bail without enabling anything */
290008f5ac90SSteven Rostedt 			if (unlikely(ftrace_disabled))
290108f5ac90SSteven Rostedt 				return -1;
29023d083395SSteven Rostedt 
290385ae32aeSSteven Rostedt 			p = &pg->records[i];
2904b7ffffbbSSteven Rostedt (Red Hat) 			p->flags = rec_flags;
2905f22f9a89SAbhishek Sagar 
29065cb084bbSJiri Olsa 			/*
290725985edcSLucas De Marchi 			 * Do the initial record conversion from mcount jump
29085cb084bbSJiri Olsa 			 * to the NOP instructions.
29095cb084bbSJiri Olsa 			 */
291032082309SSteven Rostedt 			if (!ftrace_code_disable(mod, p))
2911d2c8c3eaSSteven Rostedt 				break;
29125cb084bbSJiri Olsa 
29131dc43cf0SJiri Slaby 			update_cnt++;
29145cb084bbSJiri Olsa 		}
291585ae32aeSSteven Rostedt 	}
291685ae32aeSSteven Rostedt 
2917750ed1a4SIngo Molnar 	stop = ftrace_now(raw_smp_processor_id());
29183d083395SSteven Rostedt 	ftrace_update_time = stop - start;
29191dc43cf0SJiri Slaby 	ftrace_update_tot_cnt += update_cnt;
29203d083395SSteven Rostedt 
292116444a8aSArnaldo Carvalho de Melo 	return 0;
292216444a8aSArnaldo Carvalho de Melo }
292316444a8aSArnaldo Carvalho de Melo 
2924a7900875SSteven Rostedt static int ftrace_allocate_records(struct ftrace_page *pg, int count)
29253c1720f0SSteven Rostedt {
2926a7900875SSteven Rostedt 	int order;
29273c1720f0SSteven Rostedt 	int cnt;
29283c1720f0SSteven Rostedt 
2929a7900875SSteven Rostedt 	if (WARN_ON(!count))
2930a7900875SSteven Rostedt 		return -EINVAL;
2931a7900875SSteven Rostedt 
2932a7900875SSteven Rostedt 	order = get_count_order(DIV_ROUND_UP(count, ENTRIES_PER_PAGE));
29333c1720f0SSteven Rostedt 
29343c1720f0SSteven Rostedt 	/*
2935a7900875SSteven Rostedt 	 * We want to fill as much as possible. No more than a page
2936a7900875SSteven Rostedt 	 * may be empty.
29373c1720f0SSteven Rostedt 	 */
2938a7900875SSteven Rostedt 	while ((PAGE_SIZE << order) / ENTRY_SIZE >= count + ENTRIES_PER_PAGE)
2939a7900875SSteven Rostedt 		order--;
29403c1720f0SSteven Rostedt 
2941a7900875SSteven Rostedt  again:
2942a7900875SSteven Rostedt 	pg->records = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, order);
2943a7900875SSteven Rostedt 
2944a7900875SSteven Rostedt 	if (!pg->records) {
2945a7900875SSteven Rostedt 		/* if we can't allocate this size, try something smaller */
2946a7900875SSteven Rostedt 		if (!order)
2947a7900875SSteven Rostedt 			return -ENOMEM;
2948a7900875SSteven Rostedt 		order >>= 1;
2949a7900875SSteven Rostedt 		goto again;
2950a7900875SSteven Rostedt 	}
2951a7900875SSteven Rostedt 
2952a7900875SSteven Rostedt 	cnt = (PAGE_SIZE << order) / ENTRY_SIZE;
2953a7900875SSteven Rostedt 	pg->size = cnt;
2954a7900875SSteven Rostedt 
2955a7900875SSteven Rostedt 	if (cnt > count)
2956a7900875SSteven Rostedt 		cnt = count;
2957a7900875SSteven Rostedt 
2958a7900875SSteven Rostedt 	return cnt;
2959a7900875SSteven Rostedt }
2960a7900875SSteven Rostedt 
2961a7900875SSteven Rostedt static struct ftrace_page *
2962a7900875SSteven Rostedt ftrace_allocate_pages(unsigned long num_to_init)
2963a7900875SSteven Rostedt {
2964a7900875SSteven Rostedt 	struct ftrace_page *start_pg;
2965a7900875SSteven Rostedt 	struct ftrace_page *pg;
2966a7900875SSteven Rostedt 	int order;
2967a7900875SSteven Rostedt 	int cnt;
2968a7900875SSteven Rostedt 
2969a7900875SSteven Rostedt 	if (!num_to_init)
2970a7900875SSteven Rostedt 		return 0;
2971a7900875SSteven Rostedt 
2972a7900875SSteven Rostedt 	start_pg = pg = kzalloc(sizeof(*pg), GFP_KERNEL);
2973a7900875SSteven Rostedt 	if (!pg)
2974a7900875SSteven Rostedt 		return NULL;
2975a7900875SSteven Rostedt 
2976a7900875SSteven Rostedt 	/*
2977a7900875SSteven Rostedt 	 * Try to allocate as much as possible in one continues
2978a7900875SSteven Rostedt 	 * location that fills in all of the space. We want to
2979a7900875SSteven Rostedt 	 * waste as little space as possible.
2980a7900875SSteven Rostedt 	 */
2981a7900875SSteven Rostedt 	for (;;) {
2982a7900875SSteven Rostedt 		cnt = ftrace_allocate_records(pg, num_to_init);
2983a7900875SSteven Rostedt 		if (cnt < 0)
2984a7900875SSteven Rostedt 			goto free_pages;
2985a7900875SSteven Rostedt 
2986a7900875SSteven Rostedt 		num_to_init -= cnt;
2987a7900875SSteven Rostedt 		if (!num_to_init)
2988a7900875SSteven Rostedt 			break;
2989a7900875SSteven Rostedt 
2990a7900875SSteven Rostedt 		pg->next = kzalloc(sizeof(*pg), GFP_KERNEL);
2991a7900875SSteven Rostedt 		if (!pg->next)
2992a7900875SSteven Rostedt 			goto free_pages;
2993a7900875SSteven Rostedt 
2994a7900875SSteven Rostedt 		pg = pg->next;
2995a7900875SSteven Rostedt 	}
2996a7900875SSteven Rostedt 
2997a7900875SSteven Rostedt 	return start_pg;
2998a7900875SSteven Rostedt 
2999a7900875SSteven Rostedt  free_pages:
30001f61be00SNamhyung Kim 	pg = start_pg;
30011f61be00SNamhyung Kim 	while (pg) {
3002a7900875SSteven Rostedt 		order = get_count_order(pg->size / ENTRIES_PER_PAGE);
3003a7900875SSteven Rostedt 		free_pages((unsigned long)pg->records, order);
3004a7900875SSteven Rostedt 		start_pg = pg->next;
3005a7900875SSteven Rostedt 		kfree(pg);
3006a7900875SSteven Rostedt 		pg = start_pg;
3007a7900875SSteven Rostedt 	}
3008a7900875SSteven Rostedt 	pr_info("ftrace: FAILED to allocate memory for functions\n");
3009a7900875SSteven Rostedt 	return NULL;
3010a7900875SSteven Rostedt }
3011a7900875SSteven Rostedt 
30125072c59fSSteven Rostedt #define FTRACE_BUFF_MAX (KSYM_SYMBOL_LEN+4) /* room for wildcards */
30135072c59fSSteven Rostedt 
30145072c59fSSteven Rostedt struct ftrace_iterator {
301598c4fd04SSteven Rostedt 	loff_t				pos;
30162bccfffdSSteven Rostedt 	loff_t				func_pos;
30175072c59fSSteven Rostedt 	struct ftrace_page		*pg;
30184aeb6967SSteven Rostedt 	struct dyn_ftrace		*func;
30194aeb6967SSteven Rostedt 	struct ftrace_func_probe	*probe;
30204aeb6967SSteven Rostedt 	struct trace_parser		parser;
30211cf41dd7SSteven Rostedt 	struct ftrace_hash		*hash;
302233dc9b12SSteven Rostedt 	struct ftrace_ops		*ops;
30238fc0c701SSteven Rostedt 	int				hidx;
3024431aa3fbSSteven Rostedt 	int				idx;
30255072c59fSSteven Rostedt 	unsigned			flags;
30265072c59fSSteven Rostedt };
30275072c59fSSteven Rostedt 
3028e309b41dSIngo Molnar static void *
30294aeb6967SSteven Rostedt t_hash_next(struct seq_file *m, loff_t *pos)
30308fc0c701SSteven Rostedt {
30318fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
30324aeb6967SSteven Rostedt 	struct hlist_node *hnd = NULL;
30338fc0c701SSteven Rostedt 	struct hlist_head *hhd;
30348fc0c701SSteven Rostedt 
30358fc0c701SSteven Rostedt 	(*pos)++;
303698c4fd04SSteven Rostedt 	iter->pos = *pos;
30378fc0c701SSteven Rostedt 
30384aeb6967SSteven Rostedt 	if (iter->probe)
30394aeb6967SSteven Rostedt 		hnd = &iter->probe->node;
30408fc0c701SSteven Rostedt  retry:
30418fc0c701SSteven Rostedt 	if (iter->hidx >= FTRACE_FUNC_HASHSIZE)
30428fc0c701SSteven Rostedt 		return NULL;
30438fc0c701SSteven Rostedt 
30448fc0c701SSteven Rostedt 	hhd = &ftrace_func_hash[iter->hidx];
30458fc0c701SSteven Rostedt 
30468fc0c701SSteven Rostedt 	if (hlist_empty(hhd)) {
30478fc0c701SSteven Rostedt 		iter->hidx++;
30488fc0c701SSteven Rostedt 		hnd = NULL;
30498fc0c701SSteven Rostedt 		goto retry;
30508fc0c701SSteven Rostedt 	}
30518fc0c701SSteven Rostedt 
30528fc0c701SSteven Rostedt 	if (!hnd)
30538fc0c701SSteven Rostedt 		hnd = hhd->first;
30548fc0c701SSteven Rostedt 	else {
30558fc0c701SSteven Rostedt 		hnd = hnd->next;
30568fc0c701SSteven Rostedt 		if (!hnd) {
30578fc0c701SSteven Rostedt 			iter->hidx++;
30588fc0c701SSteven Rostedt 			goto retry;
30598fc0c701SSteven Rostedt 		}
30608fc0c701SSteven Rostedt 	}
30618fc0c701SSteven Rostedt 
30624aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!hnd))
30634aeb6967SSteven Rostedt 		return NULL;
30644aeb6967SSteven Rostedt 
30654aeb6967SSteven Rostedt 	iter->probe = hlist_entry(hnd, struct ftrace_func_probe, node);
30664aeb6967SSteven Rostedt 
30674aeb6967SSteven Rostedt 	return iter;
30688fc0c701SSteven Rostedt }
30698fc0c701SSteven Rostedt 
30708fc0c701SSteven Rostedt static void *t_hash_start(struct seq_file *m, loff_t *pos)
30718fc0c701SSteven Rostedt {
30728fc0c701SSteven Rostedt 	struct ftrace_iterator *iter = m->private;
30738fc0c701SSteven Rostedt 	void *p = NULL;
3074d82d6244SLi Zefan 	loff_t l;
3075d82d6244SLi Zefan 
307669a3083cSSteven Rostedt 	if (!(iter->flags & FTRACE_ITER_DO_HASH))
307769a3083cSSteven Rostedt 		return NULL;
307869a3083cSSteven Rostedt 
30792bccfffdSSteven Rostedt 	if (iter->func_pos > *pos)
30802bccfffdSSteven Rostedt 		return NULL;
30818fc0c701SSteven Rostedt 
3082d82d6244SLi Zefan 	iter->hidx = 0;
30832bccfffdSSteven Rostedt 	for (l = 0; l <= (*pos - iter->func_pos); ) {
30844aeb6967SSteven Rostedt 		p = t_hash_next(m, &l);
3085d82d6244SLi Zefan 		if (!p)
3086d82d6244SLi Zefan 			break;
3087d82d6244SLi Zefan 	}
30884aeb6967SSteven Rostedt 	if (!p)
30894aeb6967SSteven Rostedt 		return NULL;
30904aeb6967SSteven Rostedt 
309198c4fd04SSteven Rostedt 	/* Only set this if we have an item */
309298c4fd04SSteven Rostedt 	iter->flags |= FTRACE_ITER_HASH;
309398c4fd04SSteven Rostedt 
30944aeb6967SSteven Rostedt 	return iter;
30958fc0c701SSteven Rostedt }
30968fc0c701SSteven Rostedt 
30974aeb6967SSteven Rostedt static int
30984aeb6967SSteven Rostedt t_hash_show(struct seq_file *m, struct ftrace_iterator *iter)
30998fc0c701SSteven Rostedt {
3100b6887d79SSteven Rostedt 	struct ftrace_func_probe *rec;
31018fc0c701SSteven Rostedt 
31024aeb6967SSteven Rostedt 	rec = iter->probe;
31034aeb6967SSteven Rostedt 	if (WARN_ON_ONCE(!rec))
31044aeb6967SSteven Rostedt 		return -EIO;
31058fc0c701SSteven Rostedt 
3106809dcf29SSteven Rostedt 	if (rec->ops->print)
3107809dcf29SSteven Rostedt 		return rec->ops->print(m, rec->ip, rec->ops, rec->data);
3108809dcf29SSteven Rostedt 
3109b375a11aSSteven Rostedt 	seq_printf(m, "%ps:%ps", (void *)rec->ip, (void *)rec->ops->func);
31108fc0c701SSteven Rostedt 
31118fc0c701SSteven Rostedt 	if (rec->data)
31128fc0c701SSteven Rostedt 		seq_printf(m, ":%p", rec->data);
31138fc0c701SSteven Rostedt 	seq_putc(m, '\n');
31148fc0c701SSteven Rostedt 
31158fc0c701SSteven Rostedt 	return 0;
31168fc0c701SSteven Rostedt }
31178fc0c701SSteven Rostedt 
31188fc0c701SSteven Rostedt static void *
31195072c59fSSteven Rostedt t_next(struct seq_file *m, void *v, loff_t *pos)
31205072c59fSSteven Rostedt {
31215072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3122fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
31235072c59fSSteven Rostedt 	struct dyn_ftrace *rec = NULL;
31245072c59fSSteven Rostedt 
312545a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
312645a4a237SSteven Rostedt 		return NULL;
312745a4a237SSteven Rostedt 
31288fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
31294aeb6967SSteven Rostedt 		return t_hash_next(m, pos);
31308fc0c701SSteven Rostedt 
31315072c59fSSteven Rostedt 	(*pos)++;
31321106b699SJiri Olsa 	iter->pos = iter->func_pos = *pos;
31335072c59fSSteven Rostedt 
31340c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL)
313557c072c7SSteven Rostedt 		return t_hash_start(m, pos);
31360c75a3edSSteven Rostedt 
31375072c59fSSteven Rostedt  retry:
31385072c59fSSteven Rostedt 	if (iter->idx >= iter->pg->index) {
31395072c59fSSteven Rostedt 		if (iter->pg->next) {
31405072c59fSSteven Rostedt 			iter->pg = iter->pg->next;
31415072c59fSSteven Rostedt 			iter->idx = 0;
31425072c59fSSteven Rostedt 			goto retry;
31435072c59fSSteven Rostedt 		}
31445072c59fSSteven Rostedt 	} else {
31455072c59fSSteven Rostedt 		rec = &iter->pg->records[iter->idx++];
314632082309SSteven Rostedt 		if (((iter->flags & FTRACE_ITER_FILTER) &&
314733b7f99cSSteven Rostedt (Red Hat) 		     !(ftrace_lookup_ip(ops->func_hash->filter_hash, rec->ip))) ||
31480183fb1cSSteven Rostedt 
314941c52c0dSSteven Rostedt 		    ((iter->flags & FTRACE_ITER_NOTRACE) &&
315033b7f99cSSteven Rostedt (Red Hat) 		     !ftrace_lookup_ip(ops->func_hash->notrace_hash, rec->ip)) ||
3151647bcd03SSteven Rostedt 
3152647bcd03SSteven Rostedt 		    ((iter->flags & FTRACE_ITER_ENABLED) &&
315323ea9c4dSSteven Rostedt (Red Hat) 		     !(rec->flags & FTRACE_FL_ENABLED))) {
3154647bcd03SSteven Rostedt 
31555072c59fSSteven Rostedt 			rec = NULL;
31565072c59fSSteven Rostedt 			goto retry;
31575072c59fSSteven Rostedt 		}
31585072c59fSSteven Rostedt 	}
31595072c59fSSteven Rostedt 
31604aeb6967SSteven Rostedt 	if (!rec)
316157c072c7SSteven Rostedt 		return t_hash_start(m, pos);
31624aeb6967SSteven Rostedt 
31634aeb6967SSteven Rostedt 	iter->func = rec;
31644aeb6967SSteven Rostedt 
31654aeb6967SSteven Rostedt 	return iter;
31665072c59fSSteven Rostedt }
31675072c59fSSteven Rostedt 
316898c4fd04SSteven Rostedt static void reset_iter_read(struct ftrace_iterator *iter)
316998c4fd04SSteven Rostedt {
317098c4fd04SSteven Rostedt 	iter->pos = 0;
317198c4fd04SSteven Rostedt 	iter->func_pos = 0;
317270f77b3fSDan Carpenter 	iter->flags &= ~(FTRACE_ITER_PRINTALL | FTRACE_ITER_HASH);
31735072c59fSSteven Rostedt }
31745072c59fSSteven Rostedt 
31755072c59fSSteven Rostedt static void *t_start(struct seq_file *m, loff_t *pos)
31765072c59fSSteven Rostedt {
31775072c59fSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
3178fc13cb0cSSteven Rostedt 	struct ftrace_ops *ops = iter->ops;
31795072c59fSSteven Rostedt 	void *p = NULL;
3180694ce0a5SLi Zefan 	loff_t l;
31815072c59fSSteven Rostedt 
31828fc0c701SSteven Rostedt 	mutex_lock(&ftrace_lock);
318345a4a237SSteven Rostedt 
318445a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
318545a4a237SSteven Rostedt 		return NULL;
318645a4a237SSteven Rostedt 
31870c75a3edSSteven Rostedt 	/*
318898c4fd04SSteven Rostedt 	 * If an lseek was done, then reset and start from beginning.
318998c4fd04SSteven Rostedt 	 */
319098c4fd04SSteven Rostedt 	if (*pos < iter->pos)
319198c4fd04SSteven Rostedt 		reset_iter_read(iter);
319298c4fd04SSteven Rostedt 
319398c4fd04SSteven Rostedt 	/*
31940c75a3edSSteven Rostedt 	 * For set_ftrace_filter reading, if we have the filter
31950c75a3edSSteven Rostedt 	 * off, we can short cut and just print out that all
31960c75a3edSSteven Rostedt 	 * functions are enabled.
31970c75a3edSSteven Rostedt 	 */
31988c006cf7SNamhyung Kim 	if ((iter->flags & FTRACE_ITER_FILTER &&
319933b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->filter_hash)) ||
32008c006cf7SNamhyung Kim 	    (iter->flags & FTRACE_ITER_NOTRACE &&
320133b7f99cSSteven Rostedt (Red Hat) 	     ftrace_hash_empty(ops->func_hash->notrace_hash))) {
32020c75a3edSSteven Rostedt 		if (*pos > 0)
32038fc0c701SSteven Rostedt 			return t_hash_start(m, pos);
32040c75a3edSSteven Rostedt 		iter->flags |= FTRACE_ITER_PRINTALL;
3205df091625SChris Wright 		/* reset in case of seek/pread */
3206df091625SChris Wright 		iter->flags &= ~FTRACE_ITER_HASH;
32070c75a3edSSteven Rostedt 		return iter;
32080c75a3edSSteven Rostedt 	}
32090c75a3edSSteven Rostedt 
32108fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
32118fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
32128fc0c701SSteven Rostedt 
321398c4fd04SSteven Rostedt 	/*
321498c4fd04SSteven Rostedt 	 * Unfortunately, we need to restart at ftrace_pages_start
321598c4fd04SSteven Rostedt 	 * every time we let go of the ftrace_mutex. This is because
321698c4fd04SSteven Rostedt 	 * those pointers can change without the lock.
321798c4fd04SSteven Rostedt 	 */
3218694ce0a5SLi Zefan 	iter->pg = ftrace_pages_start;
3219694ce0a5SLi Zefan 	iter->idx = 0;
3220694ce0a5SLi Zefan 	for (l = 0; l <= *pos; ) {
3221694ce0a5SLi Zefan 		p = t_next(m, p, &l);
3222694ce0a5SLi Zefan 		if (!p)
3223694ce0a5SLi Zefan 			break;
322450cdaf08SLiming Wang 	}
32255821e1b7Swalimis 
322669a3083cSSteven Rostedt 	if (!p)
32278fc0c701SSteven Rostedt 		return t_hash_start(m, pos);
32288fc0c701SSteven Rostedt 
32294aeb6967SSteven Rostedt 	return iter;
32305072c59fSSteven Rostedt }
32315072c59fSSteven Rostedt 
32325072c59fSSteven Rostedt static void t_stop(struct seq_file *m, void *p)
32335072c59fSSteven Rostedt {
32348fc0c701SSteven Rostedt 	mutex_unlock(&ftrace_lock);
32355072c59fSSteven Rostedt }
32365072c59fSSteven Rostedt 
323715d5b02cSSteven Rostedt (Red Hat) void * __weak
323815d5b02cSSteven Rostedt (Red Hat) arch_ftrace_trampoline_func(struct ftrace_ops *ops, struct dyn_ftrace *rec)
323915d5b02cSSteven Rostedt (Red Hat) {
324015d5b02cSSteven Rostedt (Red Hat) 	return NULL;
324115d5b02cSSteven Rostedt (Red Hat) }
324215d5b02cSSteven Rostedt (Red Hat) 
324315d5b02cSSteven Rostedt (Red Hat) static void add_trampoline_func(struct seq_file *m, struct ftrace_ops *ops,
324415d5b02cSSteven Rostedt (Red Hat) 				struct dyn_ftrace *rec)
324515d5b02cSSteven Rostedt (Red Hat) {
324615d5b02cSSteven Rostedt (Red Hat) 	void *ptr;
324715d5b02cSSteven Rostedt (Red Hat) 
324815d5b02cSSteven Rostedt (Red Hat) 	ptr = arch_ftrace_trampoline_func(ops, rec);
324915d5b02cSSteven Rostedt (Red Hat) 	if (ptr)
325015d5b02cSSteven Rostedt (Red Hat) 		seq_printf(m, " ->%pS", ptr);
325115d5b02cSSteven Rostedt (Red Hat) }
325215d5b02cSSteven Rostedt (Red Hat) 
32535072c59fSSteven Rostedt static int t_show(struct seq_file *m, void *v)
32545072c59fSSteven Rostedt {
32550c75a3edSSteven Rostedt 	struct ftrace_iterator *iter = m->private;
32564aeb6967SSteven Rostedt 	struct dyn_ftrace *rec;
32575072c59fSSteven Rostedt 
32588fc0c701SSteven Rostedt 	if (iter->flags & FTRACE_ITER_HASH)
32594aeb6967SSteven Rostedt 		return t_hash_show(m, iter);
32608fc0c701SSteven Rostedt 
32610c75a3edSSteven Rostedt 	if (iter->flags & FTRACE_ITER_PRINTALL) {
32628c006cf7SNamhyung Kim 		if (iter->flags & FTRACE_ITER_NOTRACE)
3263fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
32648c006cf7SNamhyung Kim 		else
3265fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
32660c75a3edSSteven Rostedt 		return 0;
32670c75a3edSSteven Rostedt 	}
32680c75a3edSSteven Rostedt 
32694aeb6967SSteven Rostedt 	rec = iter->func;
32704aeb6967SSteven Rostedt 
32715072c59fSSteven Rostedt 	if (!rec)
32725072c59fSSteven Rostedt 		return 0;
32735072c59fSSteven Rostedt 
3274647bcd03SSteven Rostedt 	seq_printf(m, "%ps", (void *)rec->ip);
32759674b2faSSteven Rostedt (Red Hat) 	if (iter->flags & FTRACE_ITER_ENABLED) {
3276030f4e1cSSteven Rostedt (Red Hat) 		struct ftrace_ops *ops;
327715d5b02cSSteven Rostedt (Red Hat) 
3278f8b8be8aSMasami Hiramatsu 		seq_printf(m, " (%ld)%s%s",
32790376bde1SSteven Rostedt (Red Hat) 			   ftrace_rec_count(rec),
3280f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_REGS ? " R" : "  ",
3281f8b8be8aSMasami Hiramatsu 			   rec->flags & FTRACE_FL_IPMODIFY ? " I" : "  ");
32829674b2faSSteven Rostedt (Red Hat) 		if (rec->flags & FTRACE_FL_TRAMP_EN) {
32835fecaa04SSteven Rostedt (Red Hat) 			ops = ftrace_find_tramp_ops_any(rec);
328439daa7b9SSteven Rostedt (Red Hat) 			if (ops) {
328539daa7b9SSteven Rostedt (Red Hat) 				do {
328639daa7b9SSteven Rostedt (Red Hat) 					seq_printf(m, "\ttramp: %pS (%pS)",
328739daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->trampoline,
328839daa7b9SSteven Rostedt (Red Hat) 						   (void *)ops->func);
3289030f4e1cSSteven Rostedt (Red Hat) 					add_trampoline_func(m, ops, rec);
329039daa7b9SSteven Rostedt (Red Hat) 					ops = ftrace_find_tramp_ops_next(rec, ops);
329139daa7b9SSteven Rostedt (Red Hat) 				} while (ops);
329239daa7b9SSteven Rostedt (Red Hat) 			} else
3293fa6f0cc7SRasmus Villemoes 				seq_puts(m, "\ttramp: ERROR!");
3294030f4e1cSSteven Rostedt (Red Hat) 		} else {
3295030f4e1cSSteven Rostedt (Red Hat) 			add_trampoline_func(m, NULL, rec);
32969674b2faSSteven Rostedt (Red Hat) 		}
32979674b2faSSteven Rostedt (Red Hat) 	}
32989674b2faSSteven Rostedt (Red Hat) 
3299fa6f0cc7SRasmus Villemoes 	seq_putc(m, '\n');
33005072c59fSSteven Rostedt 
33015072c59fSSteven Rostedt 	return 0;
33025072c59fSSteven Rostedt }
33035072c59fSSteven Rostedt 
330488e9d34cSJames Morris static const struct seq_operations show_ftrace_seq_ops = {
33055072c59fSSteven Rostedt 	.start = t_start,
33065072c59fSSteven Rostedt 	.next = t_next,
33075072c59fSSteven Rostedt 	.stop = t_stop,
33085072c59fSSteven Rostedt 	.show = t_show,
33095072c59fSSteven Rostedt };
33105072c59fSSteven Rostedt 
3311e309b41dSIngo Molnar static int
33125072c59fSSteven Rostedt ftrace_avail_open(struct inode *inode, struct file *file)
33135072c59fSSteven Rostedt {
33145072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
33155072c59fSSteven Rostedt 
33164eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
33174eebcc81SSteven Rostedt 		return -ENODEV;
33184eebcc81SSteven Rostedt 
331950e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
332050e18b94SJiri Olsa 	if (iter) {
33215072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
3322fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
33234bf39a94SIngo Molnar 	}
33245072c59fSSteven Rostedt 
332550e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
33265072c59fSSteven Rostedt }
33275072c59fSSteven Rostedt 
3328647bcd03SSteven Rostedt static int
3329647bcd03SSteven Rostedt ftrace_enabled_open(struct inode *inode, struct file *file)
3330647bcd03SSteven Rostedt {
3331647bcd03SSteven Rostedt 	struct ftrace_iterator *iter;
3332647bcd03SSteven Rostedt 
333350e18b94SJiri Olsa 	iter = __seq_open_private(file, &show_ftrace_seq_ops, sizeof(*iter));
333450e18b94SJiri Olsa 	if (iter) {
3335647bcd03SSteven Rostedt 		iter->pg = ftrace_pages_start;
3336647bcd03SSteven Rostedt 		iter->flags = FTRACE_ITER_ENABLED;
3337fc13cb0cSSteven Rostedt 		iter->ops = &global_ops;
3338647bcd03SSteven Rostedt 	}
3339647bcd03SSteven Rostedt 
334050e18b94SJiri Olsa 	return iter ? 0 : -ENOMEM;
3341647bcd03SSteven Rostedt }
3342647bcd03SSteven Rostedt 
3343fc13cb0cSSteven Rostedt /**
3344fc13cb0cSSteven Rostedt  * ftrace_regex_open - initialize function tracer filter files
3345fc13cb0cSSteven Rostedt  * @ops: The ftrace_ops that hold the hash filters
3346fc13cb0cSSteven Rostedt  * @flag: The type of filter to process
3347fc13cb0cSSteven Rostedt  * @inode: The inode, usually passed in to your open routine
3348fc13cb0cSSteven Rostedt  * @file: The file, usually passed in to your open routine
3349fc13cb0cSSteven Rostedt  *
3350fc13cb0cSSteven Rostedt  * ftrace_regex_open() initializes the filter files for the
3351fc13cb0cSSteven Rostedt  * @ops. Depending on @flag it may process the filter hash or
3352fc13cb0cSSteven Rostedt  * the notrace hash of @ops. With this called from the open
3353fc13cb0cSSteven Rostedt  * routine, you can use ftrace_filter_write() for the write
3354fc13cb0cSSteven Rostedt  * routine if @flag has FTRACE_ITER_FILTER set, or
3355fc13cb0cSSteven Rostedt  * ftrace_notrace_write() if @flag has FTRACE_ITER_NOTRACE set.
3356098c879eSSteven Rostedt (Red Hat)  * tracing_lseek() should be used as the lseek routine, and
3357fc13cb0cSSteven Rostedt  * release must call ftrace_regex_release().
3358fc13cb0cSSteven Rostedt  */
3359fc13cb0cSSteven Rostedt int
3360f45948e8SSteven Rostedt ftrace_regex_open(struct ftrace_ops *ops, int flag,
33611cf41dd7SSteven Rostedt 		  struct inode *inode, struct file *file)
33625072c59fSSteven Rostedt {
33635072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
3364f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
33655072c59fSSteven Rostedt 	int ret = 0;
33665072c59fSSteven Rostedt 
3367f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
3368f04f24fbSMasami Hiramatsu 
33694eebcc81SSteven Rostedt 	if (unlikely(ftrace_disabled))
33704eebcc81SSteven Rostedt 		return -ENODEV;
33714eebcc81SSteven Rostedt 
33725072c59fSSteven Rostedt 	iter = kzalloc(sizeof(*iter), GFP_KERNEL);
33735072c59fSSteven Rostedt 	if (!iter)
33745072c59fSSteven Rostedt 		return -ENOMEM;
33755072c59fSSteven Rostedt 
3376689fd8b6S[email protected] 	if (trace_parser_get_init(&iter->parser, FTRACE_BUFF_MAX)) {
3377689fd8b6S[email protected] 		kfree(iter);
3378689fd8b6S[email protected] 		return -ENOMEM;
3379689fd8b6S[email protected] 	}
3380689fd8b6S[email protected] 
33813f2367baSMasami Hiramatsu 	iter->ops = ops;
33823f2367baSMasami Hiramatsu 	iter->flags = flag;
33833f2367baSMasami Hiramatsu 
338433b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
33853f2367baSMasami Hiramatsu 
3386f45948e8SSteven Rostedt 	if (flag & FTRACE_ITER_NOTRACE)
338733b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->notrace_hash;
3388f45948e8SSteven Rostedt 	else
338933b7f99cSSteven Rostedt (Red Hat) 		hash = ops->func_hash->filter_hash;
3390f45948e8SSteven Rostedt 
339133dc9b12SSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
3392ef2fbe16SNamhyung Kim 		const int size_bits = FTRACE_HASH_DEFAULT_BITS;
3393ef2fbe16SNamhyung Kim 
3394ef2fbe16SNamhyung Kim 		if (file->f_flags & O_TRUNC)
3395ef2fbe16SNamhyung Kim 			iter->hash = alloc_ftrace_hash(size_bits);
3396ef2fbe16SNamhyung Kim 		else
3397ef2fbe16SNamhyung Kim 			iter->hash = alloc_and_copy_ftrace_hash(size_bits, hash);
3398ef2fbe16SNamhyung Kim 
339933dc9b12SSteven Rostedt 		if (!iter->hash) {
340033dc9b12SSteven Rostedt 			trace_parser_put(&iter->parser);
340133dc9b12SSteven Rostedt 			kfree(iter);
34023f2367baSMasami Hiramatsu 			ret = -ENOMEM;
34033f2367baSMasami Hiramatsu 			goto out_unlock;
340433dc9b12SSteven Rostedt 		}
340533dc9b12SSteven Rostedt 	}
34061cf41dd7SSteven Rostedt 
34075072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
34085072c59fSSteven Rostedt 		iter->pg = ftrace_pages_start;
34095072c59fSSteven Rostedt 
34105072c59fSSteven Rostedt 		ret = seq_open(file, &show_ftrace_seq_ops);
34115072c59fSSteven Rostedt 		if (!ret) {
34125072c59fSSteven Rostedt 			struct seq_file *m = file->private_data;
34135072c59fSSteven Rostedt 			m->private = iter;
341479fe249cSLi Zefan 		} else {
341533dc9b12SSteven Rostedt 			/* Failed */
341633dc9b12SSteven Rostedt 			free_ftrace_hash(iter->hash);
341779fe249cSLi Zefan 			trace_parser_put(&iter->parser);
34185072c59fSSteven Rostedt 			kfree(iter);
341979fe249cSLi Zefan 		}
34205072c59fSSteven Rostedt 	} else
34215072c59fSSteven Rostedt 		file->private_data = iter;
34223f2367baSMasami Hiramatsu 
34233f2367baSMasami Hiramatsu  out_unlock:
342433b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
34255072c59fSSteven Rostedt 
34265072c59fSSteven Rostedt 	return ret;
34275072c59fSSteven Rostedt }
34285072c59fSSteven Rostedt 
342941c52c0dSSteven Rostedt static int
343041c52c0dSSteven Rostedt ftrace_filter_open(struct inode *inode, struct file *file)
343141c52c0dSSteven Rostedt {
3432e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3433e3b3e2e8SSteven Rostedt (Red Hat) 
3434e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops,
343569a3083cSSteven Rostedt 			FTRACE_ITER_FILTER | FTRACE_ITER_DO_HASH,
34361cf41dd7SSteven Rostedt 			inode, file);
343741c52c0dSSteven Rostedt }
343841c52c0dSSteven Rostedt 
343941c52c0dSSteven Rostedt static int
344041c52c0dSSteven Rostedt ftrace_notrace_open(struct inode *inode, struct file *file)
344141c52c0dSSteven Rostedt {
3442e3b3e2e8SSteven Rostedt (Red Hat) 	struct ftrace_ops *ops = inode->i_private;
3443e3b3e2e8SSteven Rostedt (Red Hat) 
3444e3b3e2e8SSteven Rostedt (Red Hat) 	return ftrace_regex_open(ops, FTRACE_ITER_NOTRACE,
34451cf41dd7SSteven Rostedt 				 inode, file);
344641c52c0dSSteven Rostedt }
344741c52c0dSSteven Rostedt 
34483ba00929SDmitry Safonov /* Type for quick search ftrace basic regexes (globs) from filter_parse_regex */
34493ba00929SDmitry Safonov struct ftrace_glob {
34503ba00929SDmitry Safonov 	char *search;
34513ba00929SDmitry Safonov 	unsigned len;
34523ba00929SDmitry Safonov 	int type;
34533ba00929SDmitry Safonov };
34543ba00929SDmitry Safonov 
34553ba00929SDmitry Safonov static int ftrace_match(char *str, struct ftrace_glob *g)
34569f4801e3SSteven Rostedt {
34579f4801e3SSteven Rostedt 	int matched = 0;
3458751e9983SLi Zefan 	int slen;
34599f4801e3SSteven Rostedt 
34603ba00929SDmitry Safonov 	switch (g->type) {
34619f4801e3SSteven Rostedt 	case MATCH_FULL:
34623ba00929SDmitry Safonov 		if (strcmp(str, g->search) == 0)
34639f4801e3SSteven Rostedt 			matched = 1;
34649f4801e3SSteven Rostedt 		break;
34659f4801e3SSteven Rostedt 	case MATCH_FRONT_ONLY:
34663ba00929SDmitry Safonov 		if (strncmp(str, g->search, g->len) == 0)
34679f4801e3SSteven Rostedt 			matched = 1;
34689f4801e3SSteven Rostedt 		break;
34699f4801e3SSteven Rostedt 	case MATCH_MIDDLE_ONLY:
34703ba00929SDmitry Safonov 		if (strstr(str, g->search))
34719f4801e3SSteven Rostedt 			matched = 1;
34729f4801e3SSteven Rostedt 		break;
34739f4801e3SSteven Rostedt 	case MATCH_END_ONLY:
3474751e9983SLi Zefan 		slen = strlen(str);
34753ba00929SDmitry Safonov 		if (slen >= g->len &&
34763ba00929SDmitry Safonov 		    memcmp(str + slen - g->len, g->search, g->len) == 0)
34779f4801e3SSteven Rostedt 			matched = 1;
34789f4801e3SSteven Rostedt 		break;
34799f4801e3SSteven Rostedt 	}
34809f4801e3SSteven Rostedt 
34819f4801e3SSteven Rostedt 	return matched;
34829f4801e3SSteven Rostedt }
34839f4801e3SSteven Rostedt 
3484b448c4e3SSteven Rostedt static int
3485f0a3b154SDmitry Safonov enter_record(struct ftrace_hash *hash, struct dyn_ftrace *rec, int clear_filter)
348664e7c440SSteven Rostedt {
3487b448c4e3SSteven Rostedt 	struct ftrace_func_entry *entry;
3488b448c4e3SSteven Rostedt 	int ret = 0;
3489b448c4e3SSteven Rostedt 
34901cf41dd7SSteven Rostedt 	entry = ftrace_lookup_ip(hash, rec->ip);
3491f0a3b154SDmitry Safonov 	if (clear_filter) {
3492b448c4e3SSteven Rostedt 		/* Do nothing if it doesn't exist */
3493b448c4e3SSteven Rostedt 		if (!entry)
3494b448c4e3SSteven Rostedt 			return 0;
3495b448c4e3SSteven Rostedt 
349633dc9b12SSteven Rostedt 		free_hash_entry(hash, entry);
3497b448c4e3SSteven Rostedt 	} else {
3498b448c4e3SSteven Rostedt 		/* Do nothing if it exists */
3499b448c4e3SSteven Rostedt 		if (entry)
3500b448c4e3SSteven Rostedt 			return 0;
3501b448c4e3SSteven Rostedt 
3502b448c4e3SSteven Rostedt 		ret = add_hash_entry(hash, rec->ip);
3503b448c4e3SSteven Rostedt 	}
3504b448c4e3SSteven Rostedt 	return ret;
3505996e87beSSteven Rostedt }
3506996e87beSSteven Rostedt 
350764e7c440SSteven Rostedt static int
35080b507e1eSDmitry Safonov ftrace_match_record(struct dyn_ftrace *rec, struct ftrace_glob *func_g,
35090b507e1eSDmitry Safonov 		struct ftrace_glob *mod_g, int exclude_mod)
351064e7c440SSteven Rostedt {
351164e7c440SSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
3512b9df92d2SSteven Rostedt 	char *modname;
351364e7c440SSteven Rostedt 
3514b9df92d2SSteven Rostedt 	kallsyms_lookup(rec->ip, NULL, NULL, &modname, str);
3515b9df92d2SSteven Rostedt 
35160b507e1eSDmitry Safonov 	if (mod_g) {
35170b507e1eSDmitry Safonov 		int mod_matches = (modname) ? ftrace_match(modname, mod_g) : 0;
35180b507e1eSDmitry Safonov 
35190b507e1eSDmitry Safonov 		/* blank module name to match all modules */
35200b507e1eSDmitry Safonov 		if (!mod_g->len) {
35210b507e1eSDmitry Safonov 			/* blank module globbing: modname xor exclude_mod */
35220b507e1eSDmitry Safonov 			if ((!exclude_mod) != (!modname))
35230b507e1eSDmitry Safonov 				goto func_match;
35240b507e1eSDmitry Safonov 			return 0;
35250b507e1eSDmitry Safonov 		}
35260b507e1eSDmitry Safonov 
35270b507e1eSDmitry Safonov 		/* not matching the module */
35280b507e1eSDmitry Safonov 		if (!modname || !mod_matches) {
35290b507e1eSDmitry Safonov 			if (exclude_mod)
35300b507e1eSDmitry Safonov 				goto func_match;
35310b507e1eSDmitry Safonov 			else
35320b507e1eSDmitry Safonov 				return 0;
35330b507e1eSDmitry Safonov 		}
35340b507e1eSDmitry Safonov 
35350b507e1eSDmitry Safonov 		if (mod_matches && exclude_mod)
3536b9df92d2SSteven Rostedt 			return 0;
3537b9df92d2SSteven Rostedt 
35380b507e1eSDmitry Safonov func_match:
3539b9df92d2SSteven Rostedt 		/* blank search means to match all funcs in the mod */
35403ba00929SDmitry Safonov 		if (!func_g->len)
3541b9df92d2SSteven Rostedt 			return 1;
3542b9df92d2SSteven Rostedt 	}
3543b9df92d2SSteven Rostedt 
35443ba00929SDmitry Safonov 	return ftrace_match(str, func_g);
354564e7c440SSteven Rostedt }
354664e7c440SSteven Rostedt 
35471cf41dd7SSteven Rostedt static int
35483ba00929SDmitry Safonov match_records(struct ftrace_hash *hash, char *func, int len, char *mod)
35499f4801e3SSteven Rostedt {
35509f4801e3SSteven Rostedt 	struct ftrace_page *pg;
35519f4801e3SSteven Rostedt 	struct dyn_ftrace *rec;
35523ba00929SDmitry Safonov 	struct ftrace_glob func_g = { .type = MATCH_FULL };
35530b507e1eSDmitry Safonov 	struct ftrace_glob mod_g = { .type = MATCH_FULL };
35540b507e1eSDmitry Safonov 	struct ftrace_glob *mod_match = (mod) ? &mod_g : NULL;
35550b507e1eSDmitry Safonov 	int exclude_mod = 0;
3556311d16daSLi Zefan 	int found = 0;
3557b448c4e3SSteven Rostedt 	int ret;
3558f0a3b154SDmitry Safonov 	int clear_filter;
35599f4801e3SSteven Rostedt 
35600b507e1eSDmitry Safonov 	if (func) {
35613ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(func, len, &func_g.search,
35623ba00929SDmitry Safonov 						 &clear_filter);
35633ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
3564b9df92d2SSteven Rostedt 	}
3565b9df92d2SSteven Rostedt 
35660b507e1eSDmitry Safonov 	if (mod) {
35670b507e1eSDmitry Safonov 		mod_g.type = filter_parse_regex(mod, strlen(mod),
35680b507e1eSDmitry Safonov 				&mod_g.search, &exclude_mod);
35690b507e1eSDmitry Safonov 		mod_g.len = strlen(mod_g.search);
3570b9df92d2SSteven Rostedt 	}
3571b9df92d2SSteven Rostedt 
357252baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
3573b9df92d2SSteven Rostedt 
3574b9df92d2SSteven Rostedt 	if (unlikely(ftrace_disabled))
3575b9df92d2SSteven Rostedt 		goto out_unlock;
3576b9df92d2SSteven Rostedt 
3577265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
35780b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, mod_match, exclude_mod)) {
3579f0a3b154SDmitry Safonov 			ret = enter_record(hash, rec, clear_filter);
3580b448c4e3SSteven Rostedt 			if (ret < 0) {
3581b448c4e3SSteven Rostedt 				found = ret;
3582b448c4e3SSteven Rostedt 				goto out_unlock;
3583b448c4e3SSteven Rostedt 			}
3584311d16daSLi Zefan 			found = 1;
35855072c59fSSteven Rostedt 		}
3586265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
3587b9df92d2SSteven Rostedt  out_unlock:
358852baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
3589311d16daSLi Zefan 
3590311d16daSLi Zefan 	return found;
35915072c59fSSteven Rostedt }
35925072c59fSSteven Rostedt 
359364e7c440SSteven Rostedt static int
35941cf41dd7SSteven Rostedt ftrace_match_records(struct ftrace_hash *hash, char *buff, int len)
359564e7c440SSteven Rostedt {
3596f0a3b154SDmitry Safonov 	return match_records(hash, buff, len, NULL);
359764e7c440SSteven Rostedt }
359864e7c440SSteven Rostedt 
359964e7c440SSteven Rostedt 
3600f6180773SSteven Rostedt /*
3601f6180773SSteven Rostedt  * We register the module command as a template to show others how
3602f6180773SSteven Rostedt  * to register the a command as well.
3603f6180773SSteven Rostedt  */
3604f6180773SSteven Rostedt 
3605f6180773SSteven Rostedt static int
360643dd61c9SSteven Rostedt ftrace_mod_callback(struct ftrace_hash *hash,
3607f0a3b154SDmitry Safonov 		    char *func, char *cmd, char *module, int enable)
3608f6180773SSteven Rostedt {
36095e3949f0SDmitry Safonov 	int ret;
3610f6180773SSteven Rostedt 
3611f6180773SSteven Rostedt 	/*
3612f6180773SSteven Rostedt 	 * cmd == 'mod' because we only registered this func
3613f6180773SSteven Rostedt 	 * for the 'mod' ftrace_func_command.
3614f6180773SSteven Rostedt 	 * But if you register one func with multiple commands,
3615f6180773SSteven Rostedt 	 * you can tell which command was used by the cmd
3616f6180773SSteven Rostedt 	 * parameter.
3617f6180773SSteven Rostedt 	 */
3618f0a3b154SDmitry Safonov 	ret = match_records(hash, func, strlen(func), module);
3619b448c4e3SSteven Rostedt 	if (!ret)
36205e3949f0SDmitry Safonov 		return -EINVAL;
3621b448c4e3SSteven Rostedt 	if (ret < 0)
3622b448c4e3SSteven Rostedt 		return ret;
3623f6180773SSteven Rostedt 	return 0;
3624f6180773SSteven Rostedt }
3625f6180773SSteven Rostedt 
3626f6180773SSteven Rostedt static struct ftrace_func_command ftrace_mod_cmd = {
3627f6180773SSteven Rostedt 	.name			= "mod",
3628f6180773SSteven Rostedt 	.func			= ftrace_mod_callback,
3629f6180773SSteven Rostedt };
3630f6180773SSteven Rostedt 
3631f6180773SSteven Rostedt static int __init ftrace_mod_cmd_init(void)
3632f6180773SSteven Rostedt {
3633f6180773SSteven Rostedt 	return register_ftrace_command(&ftrace_mod_cmd);
3634f6180773SSteven Rostedt }
36356f415672SSteven Rostedt core_initcall(ftrace_mod_cmd_init);
3636f6180773SSteven Rostedt 
36372f5f6ad9SSteven Rostedt static void function_trace_probe_call(unsigned long ip, unsigned long parent_ip,
3638a1e2e31dSSteven Rostedt 				      struct ftrace_ops *op, struct pt_regs *pt_regs)
363959df055fSSteven Rostedt {
3640b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
364159df055fSSteven Rostedt 	struct hlist_head *hhd;
364259df055fSSteven Rostedt 	unsigned long key;
364359df055fSSteven Rostedt 
364459df055fSSteven Rostedt 	key = hash_long(ip, FTRACE_HASH_BITS);
364559df055fSSteven Rostedt 
364659df055fSSteven Rostedt 	hhd = &ftrace_func_hash[key];
364759df055fSSteven Rostedt 
364859df055fSSteven Rostedt 	if (hlist_empty(hhd))
364959df055fSSteven Rostedt 		return;
365059df055fSSteven Rostedt 
365159df055fSSteven Rostedt 	/*
365259df055fSSteven Rostedt 	 * Disable preemption for these calls to prevent a RCU grace
365359df055fSSteven Rostedt 	 * period. This syncs the hash iteration and freeing of items
365459df055fSSteven Rostedt 	 * on the hash. rcu_read_lock is too dangerous here.
365559df055fSSteven Rostedt 	 */
36565168ae50SSteven Rostedt 	preempt_disable_notrace();
36571bb539caSSteven Rostedt 	hlist_for_each_entry_rcu_notrace(entry, hhd, node) {
365859df055fSSteven Rostedt 		if (entry->ip == ip)
365959df055fSSteven Rostedt 			entry->ops->func(ip, parent_ip, &entry->data);
366059df055fSSteven Rostedt 	}
36615168ae50SSteven Rostedt 	preempt_enable_notrace();
366259df055fSSteven Rostedt }
366359df055fSSteven Rostedt 
3664b6887d79SSteven Rostedt static struct ftrace_ops trace_probe_ops __read_mostly =
366559df055fSSteven Rostedt {
3666b6887d79SSteven Rostedt 	.func		= function_trace_probe_call,
3667f04f24fbSMasami Hiramatsu 	.flags		= FTRACE_OPS_FL_INITIALIZED,
366833b7f99cSSteven Rostedt (Red Hat) 	INIT_OPS_HASH(trace_probe_ops)
366959df055fSSteven Rostedt };
367059df055fSSteven Rostedt 
3671b6887d79SSteven Rostedt static int ftrace_probe_registered;
367259df055fSSteven Rostedt 
36737485058eSSteven Rostedt (Red Hat) static void __enable_ftrace_function_probe(struct ftrace_ops_hash *old_hash)
367459df055fSSteven Rostedt {
3675b848914cSSteven Rostedt 	int ret;
367659df055fSSteven Rostedt 	int i;
367759df055fSSteven Rostedt 
367819dd603eSSteven Rostedt (Red Hat) 	if (ftrace_probe_registered) {
367919dd603eSSteven Rostedt (Red Hat) 		/* still need to update the function call sites */
368019dd603eSSteven Rostedt (Red Hat) 		if (ftrace_enabled)
36818252ecf3SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(&trace_probe_ops, FTRACE_UPDATE_CALLS,
36828252ecf3SSteven Rostedt (Red Hat) 					       old_hash);
368359df055fSSteven Rostedt 		return;
368419dd603eSSteven Rostedt (Red Hat) 	}
368559df055fSSteven Rostedt 
368659df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
368759df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
368859df055fSSteven Rostedt 		if (hhd->first)
368959df055fSSteven Rostedt 			break;
369059df055fSSteven Rostedt 	}
369159df055fSSteven Rostedt 	/* Nothing registered? */
369259df055fSSteven Rostedt 	if (i == FTRACE_FUNC_HASHSIZE)
369359df055fSSteven Rostedt 		return;
369459df055fSSteven Rostedt 
3695a1cd6173SSteven Rostedt 	ret = ftrace_startup(&trace_probe_ops, 0);
3696b848914cSSteven Rostedt 
3697b6887d79SSteven Rostedt 	ftrace_probe_registered = 1;
369859df055fSSteven Rostedt }
369959df055fSSteven Rostedt 
3700b6887d79SSteven Rostedt static void __disable_ftrace_function_probe(void)
370159df055fSSteven Rostedt {
370259df055fSSteven Rostedt 	int i;
370359df055fSSteven Rostedt 
3704b6887d79SSteven Rostedt 	if (!ftrace_probe_registered)
370559df055fSSteven Rostedt 		return;
370659df055fSSteven Rostedt 
370759df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
370859df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
370959df055fSSteven Rostedt 		if (hhd->first)
371059df055fSSteven Rostedt 			return;
371159df055fSSteven Rostedt 	}
371259df055fSSteven Rostedt 
371359df055fSSteven Rostedt 	/* no more funcs left */
3714b848914cSSteven Rostedt 	ftrace_shutdown(&trace_probe_ops, 0);
3715b848914cSSteven Rostedt 
3716b6887d79SSteven Rostedt 	ftrace_probe_registered = 0;
371759df055fSSteven Rostedt }
371859df055fSSteven Rostedt 
371959df055fSSteven Rostedt 
37207818b388SSteven Rostedt (Red Hat) static void ftrace_free_entry(struct ftrace_func_probe *entry)
372159df055fSSteven Rostedt {
372259df055fSSteven Rostedt 	if (entry->ops->free)
3723e67efb93SSteven Rostedt (Red Hat) 		entry->ops->free(entry->ops, entry->ip, &entry->data);
372459df055fSSteven Rostedt 	kfree(entry);
372559df055fSSteven Rostedt }
372659df055fSSteven Rostedt 
372759df055fSSteven Rostedt int
3728b6887d79SSteven Rostedt register_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
372959df055fSSteven Rostedt 			      void *data)
373059df055fSSteven Rostedt {
37317485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
3732b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
37333ba00929SDmitry Safonov 	struct ftrace_glob func_g;
373433b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
37353296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
3736e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
373759df055fSSteven Rostedt 	struct ftrace_page *pg;
373859df055fSSteven Rostedt 	struct dyn_ftrace *rec;
37393ba00929SDmitry Safonov 	int not;
37406a24a244SSteven Rostedt 	unsigned long key;
374159df055fSSteven Rostedt 	int count = 0;
3742e1df4cb6SSteven Rostedt (Red Hat) 	int ret;
374359df055fSSteven Rostedt 
37443ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(glob, strlen(glob),
37453ba00929SDmitry Safonov 			&func_g.search, &not);
37463ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
374759df055fSSteven Rostedt 
3748b6887d79SSteven Rostedt 	/* we do not support '!' for function probes */
374959df055fSSteven Rostedt 	if (WARN_ON(not))
375059df055fSSteven Rostedt 		return -EINVAL;
375159df055fSSteven Rostedt 
375233b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
375359df055fSSteven Rostedt 
37547485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = old_hash;
37557485058eSSteven Rostedt (Red Hat) 	/* Probes only have filters */
37567485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = NULL;
37577485058eSSteven Rostedt (Red Hat) 
37583296fc4eSSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, old_hash);
3759e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash) {
3760e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENOMEM;
37615ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3762e1df4cb6SSteven Rostedt (Red Hat) 	}
3763e1df4cb6SSteven Rostedt (Red Hat) 
3764e1df4cb6SSteven Rostedt (Red Hat) 	if (unlikely(ftrace_disabled)) {
3765e1df4cb6SSteven Rostedt (Red Hat) 		count = -ENODEV;
37665ae0bf59SSteven Rostedt (Red Hat) 		goto out;
3767e1df4cb6SSteven Rostedt (Red Hat) 	}
376845a4a237SSteven Rostedt 
37695ae0bf59SSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
37705ae0bf59SSteven Rostedt (Red Hat) 
377159df055fSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
377259df055fSSteven Rostedt 
37730b507e1eSDmitry Safonov 		if (!ftrace_match_record(rec, &func_g, NULL, 0))
377459df055fSSteven Rostedt 			continue;
377559df055fSSteven Rostedt 
377659df055fSSteven Rostedt 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
377759df055fSSteven Rostedt 		if (!entry) {
3778b6887d79SSteven Rostedt 			/* If we did not process any, then return error */
377959df055fSSteven Rostedt 			if (!count)
378059df055fSSteven Rostedt 				count = -ENOMEM;
378159df055fSSteven Rostedt 			goto out_unlock;
378259df055fSSteven Rostedt 		}
378359df055fSSteven Rostedt 
378459df055fSSteven Rostedt 		count++;
378559df055fSSteven Rostedt 
378659df055fSSteven Rostedt 		entry->data = data;
378759df055fSSteven Rostedt 
378859df055fSSteven Rostedt 		/*
378959df055fSSteven Rostedt 		 * The caller might want to do something special
379059df055fSSteven Rostedt 		 * for each function we find. We call the callback
379159df055fSSteven Rostedt 		 * to give the caller an opportunity to do so.
379259df055fSSteven Rostedt 		 */
3793e67efb93SSteven Rostedt (Red Hat) 		if (ops->init) {
3794e67efb93SSteven Rostedt (Red Hat) 			if (ops->init(ops, rec->ip, &entry->data) < 0) {
379559df055fSSteven Rostedt 				/* caller does not like this func */
379659df055fSSteven Rostedt 				kfree(entry);
379759df055fSSteven Rostedt 				continue;
379859df055fSSteven Rostedt 			}
379959df055fSSteven Rostedt 		}
380059df055fSSteven Rostedt 
3801e1df4cb6SSteven Rostedt (Red Hat) 		ret = enter_record(hash, rec, 0);
3802e1df4cb6SSteven Rostedt (Red Hat) 		if (ret < 0) {
3803e1df4cb6SSteven Rostedt (Red Hat) 			kfree(entry);
3804e1df4cb6SSteven Rostedt (Red Hat) 			count = ret;
3805e1df4cb6SSteven Rostedt (Red Hat) 			goto out_unlock;
3806e1df4cb6SSteven Rostedt (Red Hat) 		}
3807e1df4cb6SSteven Rostedt (Red Hat) 
380859df055fSSteven Rostedt 		entry->ops = ops;
380959df055fSSteven Rostedt 		entry->ip = rec->ip;
381059df055fSSteven Rostedt 
381159df055fSSteven Rostedt 		key = hash_long(entry->ip, FTRACE_HASH_BITS);
381259df055fSSteven Rostedt 		hlist_add_head_rcu(&entry->node, &ftrace_func_hash[key]);
381359df055fSSteven Rostedt 
381459df055fSSteven Rostedt 	} while_for_each_ftrace_rec();
3815e1df4cb6SSteven Rostedt (Red Hat) 
3816e1df4cb6SSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
38178252ecf3SSteven Rostedt (Red Hat) 
38187485058eSSteven Rostedt (Red Hat) 	__enable_ftrace_function_probe(&old_hash_ops);
38198252ecf3SSteven Rostedt (Red Hat) 
38203296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
38213296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
38223296fc4eSSteven Rostedt (Red Hat) 	else
3823e1df4cb6SSteven Rostedt (Red Hat) 		count = ret;
3824e1df4cb6SSteven Rostedt (Red Hat) 
382559df055fSSteven Rostedt  out_unlock:
38265ae0bf59SSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
38275ae0bf59SSteven Rostedt (Red Hat)  out:
382833b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3829e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
383059df055fSSteven Rostedt 
383159df055fSSteven Rostedt 	return count;
383259df055fSSteven Rostedt }
383359df055fSSteven Rostedt 
383459df055fSSteven Rostedt enum {
3835b6887d79SSteven Rostedt 	PROBE_TEST_FUNC		= 1,
3836b6887d79SSteven Rostedt 	PROBE_TEST_DATA		= 2
383759df055fSSteven Rostedt };
383859df055fSSteven Rostedt 
383959df055fSSteven Rostedt static void
3840b6887d79SSteven Rostedt __unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
384159df055fSSteven Rostedt 				  void *data, int flags)
384259df055fSSteven Rostedt {
3843e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_func_entry *rec_entry;
3844b6887d79SSteven Rostedt 	struct ftrace_func_probe *entry;
38457818b388SSteven Rostedt (Red Hat) 	struct ftrace_func_probe *p;
38463ba00929SDmitry Safonov 	struct ftrace_glob func_g;
384733b7f99cSSteven Rostedt (Red Hat) 	struct ftrace_hash **orig_hash = &trace_probe_ops.func_hash->filter_hash;
38483296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash = *orig_hash;
38497818b388SSteven Rostedt (Red Hat) 	struct list_head free_list;
3850e1df4cb6SSteven Rostedt (Red Hat) 	struct ftrace_hash *hash;
3851b67bfe0dSSasha Levin 	struct hlist_node *tmp;
385259df055fSSteven Rostedt 	char str[KSYM_SYMBOL_LEN];
38533ba00929SDmitry Safonov 	int i, ret;
385459df055fSSteven Rostedt 
3855b36461daSAtsushi Tsuji 	if (glob && (strcmp(glob, "*") == 0 || !strlen(glob)))
38563ba00929SDmitry Safonov 		func_g.search = NULL;
3857b36461daSAtsushi Tsuji 	else if (glob) {
385859df055fSSteven Rostedt 		int not;
385959df055fSSteven Rostedt 
38603ba00929SDmitry Safonov 		func_g.type = filter_parse_regex(glob, strlen(glob),
38613ba00929SDmitry Safonov 						 &func_g.search, &not);
38623ba00929SDmitry Safonov 		func_g.len = strlen(func_g.search);
38633ba00929SDmitry Safonov 		func_g.search = glob;
386459df055fSSteven Rostedt 
3865b6887d79SSteven Rostedt 		/* we do not support '!' for function probes */
386659df055fSSteven Rostedt 		if (WARN_ON(not))
386759df055fSSteven Rostedt 			return;
386859df055fSSteven Rostedt 	}
386959df055fSSteven Rostedt 
387033b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&trace_probe_ops.func_hash->regex_lock);
3871e1df4cb6SSteven Rostedt (Red Hat) 
3872e1df4cb6SSteven Rostedt (Red Hat) 	hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
3873e1df4cb6SSteven Rostedt (Red Hat) 	if (!hash)
3874e1df4cb6SSteven Rostedt (Red Hat) 		/* Hmm, should report this somehow */
3875e1df4cb6SSteven Rostedt (Red Hat) 		goto out_unlock;
3876e1df4cb6SSteven Rostedt (Red Hat) 
38777818b388SSteven Rostedt (Red Hat) 	INIT_LIST_HEAD(&free_list);
38787818b388SSteven Rostedt (Red Hat) 
387959df055fSSteven Rostedt 	for (i = 0; i < FTRACE_FUNC_HASHSIZE; i++) {
388059df055fSSteven Rostedt 		struct hlist_head *hhd = &ftrace_func_hash[i];
388159df055fSSteven Rostedt 
3882b67bfe0dSSasha Levin 		hlist_for_each_entry_safe(entry, tmp, hhd, node) {
388359df055fSSteven Rostedt 
388459df055fSSteven Rostedt 			/* break up if statements for readability */
3885b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_FUNC) && entry->ops != ops)
388659df055fSSteven Rostedt 				continue;
388759df055fSSteven Rostedt 
3888b6887d79SSteven Rostedt 			if ((flags & PROBE_TEST_DATA) && entry->data != data)
388959df055fSSteven Rostedt 				continue;
389059df055fSSteven Rostedt 
389159df055fSSteven Rostedt 			/* do this last, since it is the most expensive */
38923ba00929SDmitry Safonov 			if (func_g.search) {
389359df055fSSteven Rostedt 				kallsyms_lookup(entry->ip, NULL, NULL,
389459df055fSSteven Rostedt 						NULL, str);
38953ba00929SDmitry Safonov 				if (!ftrace_match(str, &func_g))
389659df055fSSteven Rostedt 					continue;
389759df055fSSteven Rostedt 			}
389859df055fSSteven Rostedt 
3899e1df4cb6SSteven Rostedt (Red Hat) 			rec_entry = ftrace_lookup_ip(hash, entry->ip);
3900e1df4cb6SSteven Rostedt (Red Hat) 			/* It is possible more than one entry had this ip */
3901e1df4cb6SSteven Rostedt (Red Hat) 			if (rec_entry)
3902e1df4cb6SSteven Rostedt (Red Hat) 				free_hash_entry(hash, rec_entry);
3903e1df4cb6SSteven Rostedt (Red Hat) 
3904740466bcSSteven Rostedt (Red Hat) 			hlist_del_rcu(&entry->node);
39057818b388SSteven Rostedt (Red Hat) 			list_add(&entry->free_list, &free_list);
390659df055fSSteven Rostedt 		}
390759df055fSSteven Rostedt 	}
39083f2367baSMasami Hiramatsu 	mutex_lock(&ftrace_lock);
3909b6887d79SSteven Rostedt 	__disable_ftrace_function_probe();
3910e1df4cb6SSteven Rostedt (Red Hat) 	/*
3911e1df4cb6SSteven Rostedt (Red Hat) 	 * Remove after the disable is called. Otherwise, if the last
3912e1df4cb6SSteven Rostedt (Red Hat) 	 * probe is removed, a null hash means *all enabled*.
3913e1df4cb6SSteven Rostedt (Red Hat) 	 */
39143296fc4eSSteven Rostedt (Red Hat) 	ret = ftrace_hash_move(&trace_probe_ops, 1, orig_hash, hash);
39157818b388SSteven Rostedt (Red Hat) 	synchronize_sched();
39163296fc4eSSteven Rostedt (Red Hat) 	if (!ret)
39173296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
39183296fc4eSSteven Rostedt (Red Hat) 
39197818b388SSteven Rostedt (Red Hat) 	list_for_each_entry_safe(entry, p, &free_list, free_list) {
39207818b388SSteven Rostedt (Red Hat) 		list_del(&entry->free_list);
39217818b388SSteven Rostedt (Red Hat) 		ftrace_free_entry(entry);
39227818b388SSteven Rostedt (Red Hat) 	}
39233f2367baSMasami Hiramatsu 	mutex_unlock(&ftrace_lock);
39247818b388SSteven Rostedt (Red Hat) 
3925e1df4cb6SSteven Rostedt (Red Hat)  out_unlock:
392633b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&trace_probe_ops.func_hash->regex_lock);
3927e1df4cb6SSteven Rostedt (Red Hat) 	free_ftrace_hash(hash);
392859df055fSSteven Rostedt }
392959df055fSSteven Rostedt 
393059df055fSSteven Rostedt void
3931b6887d79SSteven Rostedt unregister_ftrace_function_probe(char *glob, struct ftrace_probe_ops *ops,
393259df055fSSteven Rostedt 				void *data)
393359df055fSSteven Rostedt {
3934b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, data,
3935b6887d79SSteven Rostedt 					  PROBE_TEST_FUNC | PROBE_TEST_DATA);
393659df055fSSteven Rostedt }
393759df055fSSteven Rostedt 
393859df055fSSteven Rostedt void
3939b6887d79SSteven Rostedt unregister_ftrace_function_probe_func(char *glob, struct ftrace_probe_ops *ops)
394059df055fSSteven Rostedt {
3941b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, ops, NULL, PROBE_TEST_FUNC);
394259df055fSSteven Rostedt }
394359df055fSSteven Rostedt 
3944b6887d79SSteven Rostedt void unregister_ftrace_function_probe_all(char *glob)
394559df055fSSteven Rostedt {
3946b6887d79SSteven Rostedt 	__unregister_ftrace_function_probe(glob, NULL, NULL, 0);
394759df055fSSteven Rostedt }
394859df055fSSteven Rostedt 
3949f6180773SSteven Rostedt static LIST_HEAD(ftrace_commands);
3950f6180773SSteven Rostedt static DEFINE_MUTEX(ftrace_cmd_mutex);
3951f6180773SSteven Rostedt 
395238de93abSTom Zanussi /*
395338de93abSTom Zanussi  * Currently we only register ftrace commands from __init, so mark this
395438de93abSTom Zanussi  * __init too.
395538de93abSTom Zanussi  */
395638de93abSTom Zanussi __init int register_ftrace_command(struct ftrace_func_command *cmd)
3957f6180773SSteven Rostedt {
3958f6180773SSteven Rostedt 	struct ftrace_func_command *p;
3959f6180773SSteven Rostedt 	int ret = 0;
3960f6180773SSteven Rostedt 
3961f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3962f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
3963f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3964f6180773SSteven Rostedt 			ret = -EBUSY;
3965f6180773SSteven Rostedt 			goto out_unlock;
3966f6180773SSteven Rostedt 		}
3967f6180773SSteven Rostedt 	}
3968f6180773SSteven Rostedt 	list_add(&cmd->list, &ftrace_commands);
3969f6180773SSteven Rostedt  out_unlock:
3970f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3971f6180773SSteven Rostedt 
3972f6180773SSteven Rostedt 	return ret;
3973f6180773SSteven Rostedt }
3974f6180773SSteven Rostedt 
397538de93abSTom Zanussi /*
397638de93abSTom Zanussi  * Currently we only unregister ftrace commands from __init, so mark
397738de93abSTom Zanussi  * this __init too.
397838de93abSTom Zanussi  */
397938de93abSTom Zanussi __init int unregister_ftrace_command(struct ftrace_func_command *cmd)
3980f6180773SSteven Rostedt {
3981f6180773SSteven Rostedt 	struct ftrace_func_command *p, *n;
3982f6180773SSteven Rostedt 	int ret = -ENODEV;
3983f6180773SSteven Rostedt 
3984f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
3985f6180773SSteven Rostedt 	list_for_each_entry_safe(p, n, &ftrace_commands, list) {
3986f6180773SSteven Rostedt 		if (strcmp(cmd->name, p->name) == 0) {
3987f6180773SSteven Rostedt 			ret = 0;
3988f6180773SSteven Rostedt 			list_del_init(&p->list);
3989f6180773SSteven Rostedt 			goto out_unlock;
3990f6180773SSteven Rostedt 		}
3991f6180773SSteven Rostedt 	}
3992f6180773SSteven Rostedt  out_unlock:
3993f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
3994f6180773SSteven Rostedt 
3995f6180773SSteven Rostedt 	return ret;
3996f6180773SSteven Rostedt }
3997f6180773SSteven Rostedt 
399833dc9b12SSteven Rostedt static int ftrace_process_regex(struct ftrace_hash *hash,
399933dc9b12SSteven Rostedt 				char *buff, int len, int enable)
400064e7c440SSteven Rostedt {
4001f6180773SSteven Rostedt 	char *func, *command, *next = buff;
40026a24a244SSteven Rostedt 	struct ftrace_func_command *p;
40030aff1c0cSGuoWen Li 	int ret = -EINVAL;
400464e7c440SSteven Rostedt 
400564e7c440SSteven Rostedt 	func = strsep(&next, ":");
400664e7c440SSteven Rostedt 
400764e7c440SSteven Rostedt 	if (!next) {
40081cf41dd7SSteven Rostedt 		ret = ftrace_match_records(hash, func, len);
4009b448c4e3SSteven Rostedt 		if (!ret)
4010b448c4e3SSteven Rostedt 			ret = -EINVAL;
4011b448c4e3SSteven Rostedt 		if (ret < 0)
4012311d16daSLi Zefan 			return ret;
4013b448c4e3SSteven Rostedt 		return 0;
401464e7c440SSteven Rostedt 	}
401564e7c440SSteven Rostedt 
4016f6180773SSteven Rostedt 	/* command found */
401764e7c440SSteven Rostedt 
401864e7c440SSteven Rostedt 	command = strsep(&next, ":");
401964e7c440SSteven Rostedt 
4020f6180773SSteven Rostedt 	mutex_lock(&ftrace_cmd_mutex);
4021f6180773SSteven Rostedt 	list_for_each_entry(p, &ftrace_commands, list) {
4022f6180773SSteven Rostedt 		if (strcmp(p->name, command) == 0) {
402343dd61c9SSteven Rostedt 			ret = p->func(hash, func, command, next, enable);
4024f6180773SSteven Rostedt 			goto out_unlock;
402564e7c440SSteven Rostedt 		}
4026f6180773SSteven Rostedt 	}
4027f6180773SSteven Rostedt  out_unlock:
4028f6180773SSteven Rostedt 	mutex_unlock(&ftrace_cmd_mutex);
402964e7c440SSteven Rostedt 
4030f6180773SSteven Rostedt 	return ret;
403164e7c440SSteven Rostedt }
403264e7c440SSteven Rostedt 
4033e309b41dSIngo Molnar static ssize_t
403441c52c0dSSteven Rostedt ftrace_regex_write(struct file *file, const char __user *ubuf,
403541c52c0dSSteven Rostedt 		   size_t cnt, loff_t *ppos, int enable)
40365072c59fSSteven Rostedt {
40375072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
4038689fd8b6S[email protected] 	struct trace_parser *parser;
4039689fd8b6S[email protected] 	ssize_t ret, read;
40405072c59fSSteven Rostedt 
40414ba7978eSLi Zefan 	if (!cnt)
40425072c59fSSteven Rostedt 		return 0;
40435072c59fSSteven Rostedt 
40445072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
40455072c59fSSteven Rostedt 		struct seq_file *m = file->private_data;
40465072c59fSSteven Rostedt 		iter = m->private;
40475072c59fSSteven Rostedt 	} else
40485072c59fSSteven Rostedt 		iter = file->private_data;
40495072c59fSSteven Rostedt 
4050f04f24fbSMasami Hiramatsu 	if (unlikely(ftrace_disabled))
40513f2367baSMasami Hiramatsu 		return -ENODEV;
40523f2367baSMasami Hiramatsu 
40533f2367baSMasami Hiramatsu 	/* iter->hash is a local copy, so we don't need regex_lock */
4054f04f24fbSMasami Hiramatsu 
4055689fd8b6S[email protected] 	parser = &iter->parser;
4056689fd8b6S[email protected] 	read = trace_get_user(parser, ubuf, cnt, ppos);
40575072c59fSSteven Rostedt 
40584ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded(parser) &&
4059689fd8b6S[email protected] 	    !trace_parser_cont(parser)) {
406033dc9b12SSteven Rostedt 		ret = ftrace_process_regex(iter->hash, parser->buffer,
4061689fd8b6S[email protected] 					   parser->idx, enable);
4062313254a9SLi Zefan 		trace_parser_clear(parser);
40637c088b51SSteven Rostedt (Red Hat) 		if (ret < 0)
40643f2367baSMasami Hiramatsu 			goto out;
40655072c59fSSteven Rostedt 	}
40665072c59fSSteven Rostedt 
40675072c59fSSteven Rostedt 	ret = read;
40683f2367baSMasami Hiramatsu  out:
40695072c59fSSteven Rostedt 	return ret;
40705072c59fSSteven Rostedt }
40715072c59fSSteven Rostedt 
4072fc13cb0cSSteven Rostedt ssize_t
407341c52c0dSSteven Rostedt ftrace_filter_write(struct file *file, const char __user *ubuf,
407441c52c0dSSteven Rostedt 		    size_t cnt, loff_t *ppos)
407541c52c0dSSteven Rostedt {
407641c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 1);
407741c52c0dSSteven Rostedt }
407841c52c0dSSteven Rostedt 
4079fc13cb0cSSteven Rostedt ssize_t
408041c52c0dSSteven Rostedt ftrace_notrace_write(struct file *file, const char __user *ubuf,
408141c52c0dSSteven Rostedt 		     size_t cnt, loff_t *ppos)
408241c52c0dSSteven Rostedt {
408341c52c0dSSteven Rostedt 	return ftrace_regex_write(file, ubuf, cnt, ppos, 0);
408441c52c0dSSteven Rostedt }
408541c52c0dSSteven Rostedt 
408633dc9b12SSteven Rostedt static int
4087647664eaSMasami Hiramatsu ftrace_match_addr(struct ftrace_hash *hash, unsigned long ip, int remove)
4088647664eaSMasami Hiramatsu {
4089647664eaSMasami Hiramatsu 	struct ftrace_func_entry *entry;
4090647664eaSMasami Hiramatsu 
4091647664eaSMasami Hiramatsu 	if (!ftrace_location(ip))
4092647664eaSMasami Hiramatsu 		return -EINVAL;
4093647664eaSMasami Hiramatsu 
4094647664eaSMasami Hiramatsu 	if (remove) {
4095647664eaSMasami Hiramatsu 		entry = ftrace_lookup_ip(hash, ip);
4096647664eaSMasami Hiramatsu 		if (!entry)
4097647664eaSMasami Hiramatsu 			return -ENOENT;
4098647664eaSMasami Hiramatsu 		free_hash_entry(hash, entry);
4099647664eaSMasami Hiramatsu 		return 0;
4100647664eaSMasami Hiramatsu 	}
4101647664eaSMasami Hiramatsu 
4102647664eaSMasami Hiramatsu 	return add_hash_entry(hash, ip);
4103647664eaSMasami Hiramatsu }
4104647664eaSMasami Hiramatsu 
41058252ecf3SSteven Rostedt (Red Hat) static void ftrace_ops_update_code(struct ftrace_ops *ops,
41067485058eSSteven Rostedt (Red Hat) 				   struct ftrace_ops_hash *old_hash)
41071c80c432SSteven Rostedt (Red Hat) {
41088f86f837SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
41098f86f837SSteven Rostedt (Red Hat) 
41108f86f837SSteven Rostedt (Red Hat) 	if (!ftrace_enabled)
41118f86f837SSteven Rostedt (Red Hat) 		return;
41128f86f837SSteven Rostedt (Red Hat) 
41138f86f837SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED) {
41148252ecf3SSteven Rostedt (Red Hat) 		ftrace_run_modify_code(ops, FTRACE_UPDATE_CALLS, old_hash);
41158f86f837SSteven Rostedt (Red Hat) 		return;
41168f86f837SSteven Rostedt (Red Hat) 	}
41178f86f837SSteven Rostedt (Red Hat) 
41188f86f837SSteven Rostedt (Red Hat) 	/*
41198f86f837SSteven Rostedt (Red Hat) 	 * If this is the shared global_ops filter, then we need to
41208f86f837SSteven Rostedt (Red Hat) 	 * check if there is another ops that shares it, is enabled.
41218f86f837SSteven Rostedt (Red Hat) 	 * If so, we still need to run the modify code.
41228f86f837SSteven Rostedt (Red Hat) 	 */
41238f86f837SSteven Rostedt (Red Hat) 	if (ops->func_hash != &global_ops.local_hash)
41248f86f837SSteven Rostedt (Red Hat) 		return;
41258f86f837SSteven Rostedt (Red Hat) 
41268f86f837SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
41278f86f837SSteven Rostedt (Red Hat) 		if (op->func_hash == &global_ops.local_hash &&
41288f86f837SSteven Rostedt (Red Hat) 		    op->flags & FTRACE_OPS_FL_ENABLED) {
41298f86f837SSteven Rostedt (Red Hat) 			ftrace_run_modify_code(op, FTRACE_UPDATE_CALLS, old_hash);
41308f86f837SSteven Rostedt (Red Hat) 			/* Only need to do this once */
41318f86f837SSteven Rostedt (Red Hat) 			return;
41328f86f837SSteven Rostedt (Red Hat) 		}
41338f86f837SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
41341c80c432SSteven Rostedt (Red Hat) }
41351c80c432SSteven Rostedt (Red Hat) 
4136647664eaSMasami Hiramatsu static int
4137647664eaSMasami Hiramatsu ftrace_set_hash(struct ftrace_ops *ops, unsigned char *buf, int len,
4138647664eaSMasami Hiramatsu 		unsigned long ip, int remove, int reset, int enable)
413941c52c0dSSteven Rostedt {
414033dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
41417485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
41423296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4143f45948e8SSteven Rostedt 	struct ftrace_hash *hash;
414433dc9b12SSteven Rostedt 	int ret;
4145f45948e8SSteven Rostedt 
414641c52c0dSSteven Rostedt 	if (unlikely(ftrace_disabled))
414733dc9b12SSteven Rostedt 		return -ENODEV;
414841c52c0dSSteven Rostedt 
414933b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&ops->func_hash->regex_lock);
41503f2367baSMasami Hiramatsu 
4151f45948e8SSteven Rostedt 	if (enable)
415233b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->filter_hash;
4153f45948e8SSteven Rostedt 	else
415433b7f99cSSteven Rostedt (Red Hat) 		orig_hash = &ops->func_hash->notrace_hash;
415533dc9b12SSteven Rostedt 
4156b972cc58SWang Nan 	if (reset)
4157b972cc58SWang Nan 		hash = alloc_ftrace_hash(FTRACE_HASH_DEFAULT_BITS);
4158b972cc58SWang Nan 	else
415933dc9b12SSteven Rostedt 		hash = alloc_and_copy_ftrace_hash(FTRACE_HASH_DEFAULT_BITS, *orig_hash);
4160b972cc58SWang Nan 
41613f2367baSMasami Hiramatsu 	if (!hash) {
41623f2367baSMasami Hiramatsu 		ret = -ENOMEM;
41633f2367baSMasami Hiramatsu 		goto out_regex_unlock;
41643f2367baSMasami Hiramatsu 	}
4165f45948e8SSteven Rostedt 
4166ac483c44SJiri Olsa 	if (buf && !ftrace_match_records(hash, buf, len)) {
4167ac483c44SJiri Olsa 		ret = -EINVAL;
4168ac483c44SJiri Olsa 		goto out_regex_unlock;
4169ac483c44SJiri Olsa 	}
4170647664eaSMasami Hiramatsu 	if (ip) {
4171647664eaSMasami Hiramatsu 		ret = ftrace_match_addr(hash, ip, remove);
4172647664eaSMasami Hiramatsu 		if (ret < 0)
4173647664eaSMasami Hiramatsu 			goto out_regex_unlock;
4174647664eaSMasami Hiramatsu 	}
417533dc9b12SSteven Rostedt 
417633dc9b12SSteven Rostedt 	mutex_lock(&ftrace_lock);
41773296fc4eSSteven Rostedt (Red Hat) 	old_hash = *orig_hash;
41787485058eSSteven Rostedt (Red Hat) 	old_hash_ops.filter_hash = ops->func_hash->filter_hash;
41797485058eSSteven Rostedt (Red Hat) 	old_hash_ops.notrace_hash = ops->func_hash->notrace_hash;
418041fb61c2SSteven Rostedt 	ret = ftrace_hash_move(ops, enable, orig_hash, hash);
41813296fc4eSSteven Rostedt (Red Hat) 	if (!ret) {
41827485058eSSteven Rostedt (Red Hat) 		ftrace_ops_update_code(ops, &old_hash_ops);
41833296fc4eSSteven Rostedt (Red Hat) 		free_ftrace_hash_rcu(old_hash);
41843296fc4eSSteven Rostedt (Red Hat) 	}
418533dc9b12SSteven Rostedt 	mutex_unlock(&ftrace_lock);
418633dc9b12SSteven Rostedt 
4187ac483c44SJiri Olsa  out_regex_unlock:
418833b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&ops->func_hash->regex_lock);
418933dc9b12SSteven Rostedt 
419033dc9b12SSteven Rostedt 	free_ftrace_hash(hash);
419133dc9b12SSteven Rostedt 	return ret;
419241c52c0dSSteven Rostedt }
419341c52c0dSSteven Rostedt 
4194647664eaSMasami Hiramatsu static int
4195647664eaSMasami Hiramatsu ftrace_set_addr(struct ftrace_ops *ops, unsigned long ip, int remove,
4196647664eaSMasami Hiramatsu 		int reset, int enable)
4197647664eaSMasami Hiramatsu {
4198647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, 0, 0, ip, remove, reset, enable);
4199647664eaSMasami Hiramatsu }
4200647664eaSMasami Hiramatsu 
4201647664eaSMasami Hiramatsu /**
4202647664eaSMasami Hiramatsu  * ftrace_set_filter_ip - set a function to filter on in ftrace by address
4203647664eaSMasami Hiramatsu  * @ops - the ops to set the filter with
4204647664eaSMasami Hiramatsu  * @ip - the address to add to or remove from the filter.
4205647664eaSMasami Hiramatsu  * @remove - non zero to remove the ip from the filter
4206647664eaSMasami Hiramatsu  * @reset - non zero to reset all filters before applying this filter.
4207647664eaSMasami Hiramatsu  *
4208647664eaSMasami Hiramatsu  * Filters denote which functions should be enabled when tracing is enabled
4209647664eaSMasami Hiramatsu  * If @ip is NULL, it failes to update filter.
4210647664eaSMasami Hiramatsu  */
4211647664eaSMasami Hiramatsu int ftrace_set_filter_ip(struct ftrace_ops *ops, unsigned long ip,
4212647664eaSMasami Hiramatsu 			 int remove, int reset)
4213647664eaSMasami Hiramatsu {
4214f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4215647664eaSMasami Hiramatsu 	return ftrace_set_addr(ops, ip, remove, reset, 1);
4216647664eaSMasami Hiramatsu }
4217647664eaSMasami Hiramatsu EXPORT_SYMBOL_GPL(ftrace_set_filter_ip);
4218647664eaSMasami Hiramatsu 
4219647664eaSMasami Hiramatsu static int
4220647664eaSMasami Hiramatsu ftrace_set_regex(struct ftrace_ops *ops, unsigned char *buf, int len,
4221647664eaSMasami Hiramatsu 		 int reset, int enable)
4222647664eaSMasami Hiramatsu {
4223647664eaSMasami Hiramatsu 	return ftrace_set_hash(ops, buf, len, 0, 0, reset, enable);
4224647664eaSMasami Hiramatsu }
4225647664eaSMasami Hiramatsu 
422677a2b37dSSteven Rostedt /**
422777a2b37dSSteven Rostedt  * ftrace_set_filter - set a function to filter on in ftrace
4228936e074bSSteven Rostedt  * @ops - the ops to set the filter with
422977a2b37dSSteven Rostedt  * @buf - the string that holds the function filter text.
423077a2b37dSSteven Rostedt  * @len - the length of the string.
423177a2b37dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
423277a2b37dSSteven Rostedt  *
423377a2b37dSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
423477a2b37dSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
423577a2b37dSSteven Rostedt  */
4236ac483c44SJiri Olsa int ftrace_set_filter(struct ftrace_ops *ops, unsigned char *buf,
4237936e074bSSteven Rostedt 		       int len, int reset)
423877a2b37dSSteven Rostedt {
4239f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4240ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 1);
424141c52c0dSSteven Rostedt }
4242936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_filter);
42434eebcc81SSteven Rostedt 
424441c52c0dSSteven Rostedt /**
424541c52c0dSSteven Rostedt  * ftrace_set_notrace - set a function to not trace in ftrace
4246936e074bSSteven Rostedt  * @ops - the ops to set the notrace filter with
424741c52c0dSSteven Rostedt  * @buf - the string that holds the function notrace text.
424841c52c0dSSteven Rostedt  * @len - the length of the string.
424941c52c0dSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
425041c52c0dSSteven Rostedt  *
425141c52c0dSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
425241c52c0dSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
425341c52c0dSSteven Rostedt  * for tracing.
425441c52c0dSSteven Rostedt  */
4255ac483c44SJiri Olsa int ftrace_set_notrace(struct ftrace_ops *ops, unsigned char *buf,
4256936e074bSSteven Rostedt 			int len, int reset)
4257936e074bSSteven Rostedt {
4258f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4259ac483c44SJiri Olsa 	return ftrace_set_regex(ops, buf, len, reset, 0);
4260936e074bSSteven Rostedt }
4261936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_notrace);
4262936e074bSSteven Rostedt /**
42638d1b065dSJiaxing Wang  * ftrace_set_global_filter - set a function to filter on with global tracers
4264936e074bSSteven Rostedt  * @buf - the string that holds the function filter text.
4265936e074bSSteven Rostedt  * @len - the length of the string.
4266936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4267936e074bSSteven Rostedt  *
4268936e074bSSteven Rostedt  * Filters denote which functions should be enabled when tracing is enabled.
4269936e074bSSteven Rostedt  * If @buf is NULL and reset is set, all functions will be enabled for tracing.
4270936e074bSSteven Rostedt  */
4271936e074bSSteven Rostedt void ftrace_set_global_filter(unsigned char *buf, int len, int reset)
4272936e074bSSteven Rostedt {
4273936e074bSSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 1);
4274936e074bSSteven Rostedt }
4275936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_filter);
4276936e074bSSteven Rostedt 
4277936e074bSSteven Rostedt /**
42788d1b065dSJiaxing Wang  * ftrace_set_global_notrace - set a function to not trace with global tracers
4279936e074bSSteven Rostedt  * @buf - the string that holds the function notrace text.
4280936e074bSSteven Rostedt  * @len - the length of the string.
4281936e074bSSteven Rostedt  * @reset - non zero to reset all filters before applying this filter.
4282936e074bSSteven Rostedt  *
4283936e074bSSteven Rostedt  * Notrace Filters denote which functions should not be enabled when tracing
4284936e074bSSteven Rostedt  * is enabled. If @buf is NULL and reset is set, all functions will be enabled
4285936e074bSSteven Rostedt  * for tracing.
4286936e074bSSteven Rostedt  */
4287936e074bSSteven Rostedt void ftrace_set_global_notrace(unsigned char *buf, int len, int reset)
428841c52c0dSSteven Rostedt {
4289f45948e8SSteven Rostedt 	ftrace_set_regex(&global_ops, buf, len, reset, 0);
429077a2b37dSSteven Rostedt }
4291936e074bSSteven Rostedt EXPORT_SYMBOL_GPL(ftrace_set_global_notrace);
429277a2b37dSSteven Rostedt 
42932af15d6aSSteven Rostedt /*
42942af15d6aSSteven Rostedt  * command line interface to allow users to set filters on boot up.
42952af15d6aSSteven Rostedt  */
42962af15d6aSSteven Rostedt #define FTRACE_FILTER_SIZE		COMMAND_LINE_SIZE
42972af15d6aSSteven Rostedt static char ftrace_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
42982af15d6aSSteven Rostedt static char ftrace_filter_buf[FTRACE_FILTER_SIZE] __initdata;
42992af15d6aSSteven Rostedt 
4300f1ed7c74SSteven Rostedt (Red Hat) /* Used by function selftest to not test if filter is set */
4301f1ed7c74SSteven Rostedt (Red Hat) bool ftrace_filter_param __initdata;
4302f1ed7c74SSteven Rostedt (Red Hat) 
43032af15d6aSSteven Rostedt static int __init set_ftrace_notrace(char *str)
43042af15d6aSSteven Rostedt {
4305f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
430675761cc1SChen Gang 	strlcpy(ftrace_notrace_buf, str, FTRACE_FILTER_SIZE);
43072af15d6aSSteven Rostedt 	return 1;
43082af15d6aSSteven Rostedt }
43092af15d6aSSteven Rostedt __setup("ftrace_notrace=", set_ftrace_notrace);
43102af15d6aSSteven Rostedt 
43112af15d6aSSteven Rostedt static int __init set_ftrace_filter(char *str)
43122af15d6aSSteven Rostedt {
4313f1ed7c74SSteven Rostedt (Red Hat) 	ftrace_filter_param = true;
431475761cc1SChen Gang 	strlcpy(ftrace_filter_buf, str, FTRACE_FILTER_SIZE);
43152af15d6aSSteven Rostedt 	return 1;
43162af15d6aSSteven Rostedt }
43172af15d6aSSteven Rostedt __setup("ftrace_filter=", set_ftrace_filter);
43182af15d6aSSteven Rostedt 
4319369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4320f6060f46SLai Jiangshan static char ftrace_graph_buf[FTRACE_FILTER_SIZE] __initdata;
43210d7d9a16SNamhyung Kim static char ftrace_graph_notrace_buf[FTRACE_FILTER_SIZE] __initdata;
4322faf982a6SNamhyung Kim static int ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer);
4323801c29fdSSteven Rostedt 
4324f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_trampoline;
4325f3bea491SSteven Rostedt (Red Hat) static unsigned long save_global_flags;
4326f3bea491SSteven Rostedt (Red Hat) 
4327369bc18fSStefan Assmann static int __init set_graph_function(char *str)
4328369bc18fSStefan Assmann {
432906f43d66SFrederic Weisbecker 	strlcpy(ftrace_graph_buf, str, FTRACE_FILTER_SIZE);
4330369bc18fSStefan Assmann 	return 1;
4331369bc18fSStefan Assmann }
4332369bc18fSStefan Assmann __setup("ftrace_graph_filter=", set_graph_function);
4333369bc18fSStefan Assmann 
43340d7d9a16SNamhyung Kim static int __init set_graph_notrace_function(char *str)
43350d7d9a16SNamhyung Kim {
43360d7d9a16SNamhyung Kim 	strlcpy(ftrace_graph_notrace_buf, str, FTRACE_FILTER_SIZE);
43370d7d9a16SNamhyung Kim 	return 1;
43380d7d9a16SNamhyung Kim }
43390d7d9a16SNamhyung Kim __setup("ftrace_graph_notrace=", set_graph_notrace_function);
43400d7d9a16SNamhyung Kim 
43410d7d9a16SNamhyung Kim static void __init set_ftrace_early_graph(char *buf, int enable)
4342369bc18fSStefan Assmann {
4343369bc18fSStefan Assmann 	int ret;
4344369bc18fSStefan Assmann 	char *func;
43450d7d9a16SNamhyung Kim 	unsigned long *table = ftrace_graph_funcs;
43460d7d9a16SNamhyung Kim 	int *count = &ftrace_graph_count;
43470d7d9a16SNamhyung Kim 
43480d7d9a16SNamhyung Kim 	if (!enable) {
43490d7d9a16SNamhyung Kim 		table = ftrace_graph_notrace_funcs;
43500d7d9a16SNamhyung Kim 		count = &ftrace_graph_notrace_count;
43510d7d9a16SNamhyung Kim 	}
4352369bc18fSStefan Assmann 
4353369bc18fSStefan Assmann 	while (buf) {
4354369bc18fSStefan Assmann 		func = strsep(&buf, ",");
4355369bc18fSStefan Assmann 		/* we allow only one expression at a time */
43560d7d9a16SNamhyung Kim 		ret = ftrace_set_func(table, count, FTRACE_GRAPH_MAX_FUNCS, func);
4357369bc18fSStefan Assmann 		if (ret)
4358369bc18fSStefan Assmann 			printk(KERN_DEBUG "ftrace: function %s not "
4359369bc18fSStefan Assmann 					  "traceable\n", func);
4360369bc18fSStefan Assmann 	}
4361369bc18fSStefan Assmann }
4362369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4363369bc18fSStefan Assmann 
43642a85a37fSSteven Rostedt void __init
43652a85a37fSSteven Rostedt ftrace_set_early_filter(struct ftrace_ops *ops, char *buf, int enable)
43662af15d6aSSteven Rostedt {
43672af15d6aSSteven Rostedt 	char *func;
43682af15d6aSSteven Rostedt 
4369f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
4370f04f24fbSMasami Hiramatsu 
43712af15d6aSSteven Rostedt 	while (buf) {
43722af15d6aSSteven Rostedt 		func = strsep(&buf, ",");
4373f45948e8SSteven Rostedt 		ftrace_set_regex(ops, func, strlen(func), 0, enable);
43742af15d6aSSteven Rostedt 	}
43752af15d6aSSteven Rostedt }
43762af15d6aSSteven Rostedt 
43772af15d6aSSteven Rostedt static void __init set_ftrace_early_filters(void)
43782af15d6aSSteven Rostedt {
43792af15d6aSSteven Rostedt 	if (ftrace_filter_buf[0])
43802a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_filter_buf, 1);
43812af15d6aSSteven Rostedt 	if (ftrace_notrace_buf[0])
43822a85a37fSSteven Rostedt 		ftrace_set_early_filter(&global_ops, ftrace_notrace_buf, 0);
4383369bc18fSStefan Assmann #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4384369bc18fSStefan Assmann 	if (ftrace_graph_buf[0])
43850d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_buf, 1);
43860d7d9a16SNamhyung Kim 	if (ftrace_graph_notrace_buf[0])
43870d7d9a16SNamhyung Kim 		set_ftrace_early_graph(ftrace_graph_notrace_buf, 0);
4388369bc18fSStefan Assmann #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
43892af15d6aSSteven Rostedt }
43902af15d6aSSteven Rostedt 
4391fc13cb0cSSteven Rostedt int ftrace_regex_release(struct inode *inode, struct file *file)
43925072c59fSSteven Rostedt {
43935072c59fSSteven Rostedt 	struct seq_file *m = (struct seq_file *)file->private_data;
43947485058eSSteven Rostedt (Red Hat) 	struct ftrace_ops_hash old_hash_ops;
43955072c59fSSteven Rostedt 	struct ftrace_iterator *iter;
439633dc9b12SSteven Rostedt 	struct ftrace_hash **orig_hash;
43973296fc4eSSteven Rostedt (Red Hat) 	struct ftrace_hash *old_hash;
4398689fd8b6S[email protected] 	struct trace_parser *parser;
4399ed926f9bSSteven Rostedt 	int filter_hash;
440033dc9b12SSteven Rostedt 	int ret;
44015072c59fSSteven Rostedt 
44025072c59fSSteven Rostedt 	if (file->f_mode & FMODE_READ) {
44035072c59fSSteven Rostedt 		iter = m->private;
44045072c59fSSteven Rostedt 		seq_release(inode, file);
44055072c59fSSteven Rostedt 	} else
44065072c59fSSteven Rostedt 		iter = file->private_data;
44075072c59fSSteven Rostedt 
4408689fd8b6S[email protected] 	parser = &iter->parser;
4409689fd8b6S[email protected] 	if (trace_parser_loaded(parser)) {
4410689fd8b6S[email protected] 		parser->buffer[parser->idx] = 0;
44111cf41dd7SSteven Rostedt 		ftrace_match_records(iter->hash, parser->buffer, parser->idx);
44125072c59fSSteven Rostedt 	}
44135072c59fSSteven Rostedt 
4414058e297dSSteven Rostedt 	trace_parser_put(parser);
4415058e297dSSteven Rostedt 
441633b7f99cSSteven Rostedt (Red Hat) 	mutex_lock(&iter->ops->func_hash->regex_lock);
44173f2367baSMasami Hiramatsu 
4418058e297dSSteven Rostedt 	if (file->f_mode & FMODE_WRITE) {
4419ed926f9bSSteven Rostedt 		filter_hash = !!(iter->flags & FTRACE_ITER_FILTER);
4420ed926f9bSSteven Rostedt 
4421ed926f9bSSteven Rostedt 		if (filter_hash)
442233b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->filter_hash;
4423ed926f9bSSteven Rostedt 		else
442433b7f99cSSteven Rostedt (Red Hat) 			orig_hash = &iter->ops->func_hash->notrace_hash;
442533dc9b12SSteven Rostedt 
4426e6ea44e9SSteven Rostedt 		mutex_lock(&ftrace_lock);
44273296fc4eSSteven Rostedt (Red Hat) 		old_hash = *orig_hash;
44287485058eSSteven Rostedt (Red Hat) 		old_hash_ops.filter_hash = iter->ops->func_hash->filter_hash;
44297485058eSSteven Rostedt (Red Hat) 		old_hash_ops.notrace_hash = iter->ops->func_hash->notrace_hash;
443041fb61c2SSteven Rostedt 		ret = ftrace_hash_move(iter->ops, filter_hash,
443141fb61c2SSteven Rostedt 				       orig_hash, iter->hash);
44323296fc4eSSteven Rostedt (Red Hat) 		if (!ret) {
44337485058eSSteven Rostedt (Red Hat) 			ftrace_ops_update_code(iter->ops, &old_hash_ops);
44343296fc4eSSteven Rostedt (Red Hat) 			free_ftrace_hash_rcu(old_hash);
44353296fc4eSSteven Rostedt (Red Hat) 		}
4436e6ea44e9SSteven Rostedt 		mutex_unlock(&ftrace_lock);
4437058e297dSSteven Rostedt 	}
44383f2367baSMasami Hiramatsu 
443933b7f99cSSteven Rostedt (Red Hat) 	mutex_unlock(&iter->ops->func_hash->regex_lock);
444033dc9b12SSteven Rostedt 	free_ftrace_hash(iter->hash);
444133dc9b12SSteven Rostedt 	kfree(iter);
4442689fd8b6S[email protected] 
44435072c59fSSteven Rostedt 	return 0;
44445072c59fSSteven Rostedt }
44455072c59fSSteven Rostedt 
44465e2336a0SSteven Rostedt static const struct file_operations ftrace_avail_fops = {
44475072c59fSSteven Rostedt 	.open = ftrace_avail_open,
44485072c59fSSteven Rostedt 	.read = seq_read,
44495072c59fSSteven Rostedt 	.llseek = seq_lseek,
44503be04b47SLi Zefan 	.release = seq_release_private,
44515072c59fSSteven Rostedt };
44525072c59fSSteven Rostedt 
4453647bcd03SSteven Rostedt static const struct file_operations ftrace_enabled_fops = {
4454647bcd03SSteven Rostedt 	.open = ftrace_enabled_open,
4455647bcd03SSteven Rostedt 	.read = seq_read,
4456647bcd03SSteven Rostedt 	.llseek = seq_lseek,
4457647bcd03SSteven Rostedt 	.release = seq_release_private,
4458647bcd03SSteven Rostedt };
4459647bcd03SSteven Rostedt 
44605e2336a0SSteven Rostedt static const struct file_operations ftrace_filter_fops = {
44615072c59fSSteven Rostedt 	.open = ftrace_filter_open,
4462850a80cfSLai Jiangshan 	.read = seq_read,
44635072c59fSSteven Rostedt 	.write = ftrace_filter_write,
4464098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
44651cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
44665072c59fSSteven Rostedt };
44675072c59fSSteven Rostedt 
44685e2336a0SSteven Rostedt static const struct file_operations ftrace_notrace_fops = {
446941c52c0dSSteven Rostedt 	.open = ftrace_notrace_open,
4470850a80cfSLai Jiangshan 	.read = seq_read,
447141c52c0dSSteven Rostedt 	.write = ftrace_notrace_write,
4472098c879eSSteven Rostedt (Red Hat) 	.llseek = tracing_lseek,
44731cf41dd7SSteven Rostedt 	.release = ftrace_regex_release,
447441c52c0dSSteven Rostedt };
447541c52c0dSSteven Rostedt 
4476ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
4477ea4e2bc4SSteven Rostedt 
4478ea4e2bc4SSteven Rostedt static DEFINE_MUTEX(graph_lock);
4479ea4e2bc4SSteven Rostedt 
4480ea4e2bc4SSteven Rostedt int ftrace_graph_count;
448129ad23b0SNamhyung Kim int ftrace_graph_notrace_count;
4482ea4e2bc4SSteven Rostedt unsigned long ftrace_graph_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
448329ad23b0SNamhyung Kim unsigned long ftrace_graph_notrace_funcs[FTRACE_GRAPH_MAX_FUNCS] __read_mostly;
4484ea4e2bc4SSteven Rostedt 
4485faf982a6SNamhyung Kim struct ftrace_graph_data {
4486faf982a6SNamhyung Kim 	unsigned long *table;
4487faf982a6SNamhyung Kim 	size_t size;
4488faf982a6SNamhyung Kim 	int *count;
4489faf982a6SNamhyung Kim 	const struct seq_operations *seq_ops;
4490faf982a6SNamhyung Kim };
4491faf982a6SNamhyung Kim 
4492ea4e2bc4SSteven Rostedt static void *
449385951842SLi Zefan __g_next(struct seq_file *m, loff_t *pos)
4494ea4e2bc4SSteven Rostedt {
4495faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4496faf982a6SNamhyung Kim 
4497faf982a6SNamhyung Kim 	if (*pos >= *fgd->count)
4498ea4e2bc4SSteven Rostedt 		return NULL;
4499faf982a6SNamhyung Kim 	return &fgd->table[*pos];
450085951842SLi Zefan }
4501ea4e2bc4SSteven Rostedt 
450285951842SLi Zefan static void *
450385951842SLi Zefan g_next(struct seq_file *m, void *v, loff_t *pos)
450485951842SLi Zefan {
450585951842SLi Zefan 	(*pos)++;
450685951842SLi Zefan 	return __g_next(m, pos);
4507ea4e2bc4SSteven Rostedt }
4508ea4e2bc4SSteven Rostedt 
4509ea4e2bc4SSteven Rostedt static void *g_start(struct seq_file *m, loff_t *pos)
4510ea4e2bc4SSteven Rostedt {
4511faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = m->private;
4512faf982a6SNamhyung Kim 
4513ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4514ea4e2bc4SSteven Rostedt 
4515f9349a8fSFrederic Weisbecker 	/* Nothing, tell g_show to print all functions are enabled */
4516faf982a6SNamhyung Kim 	if (!*fgd->count && !*pos)
4517f9349a8fSFrederic Weisbecker 		return (void *)1;
4518f9349a8fSFrederic Weisbecker 
451985951842SLi Zefan 	return __g_next(m, pos);
4520ea4e2bc4SSteven Rostedt }
4521ea4e2bc4SSteven Rostedt 
4522ea4e2bc4SSteven Rostedt static void g_stop(struct seq_file *m, void *p)
4523ea4e2bc4SSteven Rostedt {
4524ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4525ea4e2bc4SSteven Rostedt }
4526ea4e2bc4SSteven Rostedt 
4527ea4e2bc4SSteven Rostedt static int g_show(struct seq_file *m, void *v)
4528ea4e2bc4SSteven Rostedt {
4529ea4e2bc4SSteven Rostedt 	unsigned long *ptr = v;
4530ea4e2bc4SSteven Rostedt 
4531ea4e2bc4SSteven Rostedt 	if (!ptr)
4532ea4e2bc4SSteven Rostedt 		return 0;
4533ea4e2bc4SSteven Rostedt 
4534f9349a8fSFrederic Weisbecker 	if (ptr == (unsigned long *)1) {
4535280d1429SNamhyung Kim 		struct ftrace_graph_data *fgd = m->private;
4536280d1429SNamhyung Kim 
4537280d1429SNamhyung Kim 		if (fgd->table == ftrace_graph_funcs)
4538fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### all functions enabled ####\n");
4539280d1429SNamhyung Kim 		else
4540fa6f0cc7SRasmus Villemoes 			seq_puts(m, "#### no functions disabled ####\n");
4541f9349a8fSFrederic Weisbecker 		return 0;
4542f9349a8fSFrederic Weisbecker 	}
4543f9349a8fSFrederic Weisbecker 
4544b375a11aSSteven Rostedt 	seq_printf(m, "%ps\n", (void *)*ptr);
4545ea4e2bc4SSteven Rostedt 
4546ea4e2bc4SSteven Rostedt 	return 0;
4547ea4e2bc4SSteven Rostedt }
4548ea4e2bc4SSteven Rostedt 
454988e9d34cSJames Morris static const struct seq_operations ftrace_graph_seq_ops = {
4550ea4e2bc4SSteven Rostedt 	.start = g_start,
4551ea4e2bc4SSteven Rostedt 	.next = g_next,
4552ea4e2bc4SSteven Rostedt 	.stop = g_stop,
4553ea4e2bc4SSteven Rostedt 	.show = g_show,
4554ea4e2bc4SSteven Rostedt };
4555ea4e2bc4SSteven Rostedt 
4556ea4e2bc4SSteven Rostedt static int
4557faf982a6SNamhyung Kim __ftrace_graph_open(struct inode *inode, struct file *file,
4558faf982a6SNamhyung Kim 		    struct ftrace_graph_data *fgd)
4559ea4e2bc4SSteven Rostedt {
4560ea4e2bc4SSteven Rostedt 	int ret = 0;
4561ea4e2bc4SSteven Rostedt 
4562ea4e2bc4SSteven Rostedt 	mutex_lock(&graph_lock);
4563ea4e2bc4SSteven Rostedt 	if ((file->f_mode & FMODE_WRITE) &&
45648650ae32SSteven Rostedt 	    (file->f_flags & O_TRUNC)) {
4565faf982a6SNamhyung Kim 		*fgd->count = 0;
4566faf982a6SNamhyung Kim 		memset(fgd->table, 0, fgd->size * sizeof(*fgd->table));
4567ea4e2bc4SSteven Rostedt 	}
4568ea4e2bc4SSteven Rostedt 	mutex_unlock(&graph_lock);
4569ea4e2bc4SSteven Rostedt 
4570faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4571faf982a6SNamhyung Kim 		ret = seq_open(file, fgd->seq_ops);
4572faf982a6SNamhyung Kim 		if (!ret) {
4573faf982a6SNamhyung Kim 			struct seq_file *m = file->private_data;
4574faf982a6SNamhyung Kim 			m->private = fgd;
4575faf982a6SNamhyung Kim 		}
4576faf982a6SNamhyung Kim 	} else
4577faf982a6SNamhyung Kim 		file->private_data = fgd;
4578a4ec5e0cSLi Zefan 
4579ea4e2bc4SSteven Rostedt 	return ret;
4580ea4e2bc4SSteven Rostedt }
4581ea4e2bc4SSteven Rostedt 
4582ea4e2bc4SSteven Rostedt static int
4583faf982a6SNamhyung Kim ftrace_graph_open(struct inode *inode, struct file *file)
4584faf982a6SNamhyung Kim {
4585faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd;
4586faf982a6SNamhyung Kim 
4587faf982a6SNamhyung Kim 	if (unlikely(ftrace_disabled))
4588faf982a6SNamhyung Kim 		return -ENODEV;
4589faf982a6SNamhyung Kim 
4590faf982a6SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
4591faf982a6SNamhyung Kim 	if (fgd == NULL)
4592faf982a6SNamhyung Kim 		return -ENOMEM;
4593faf982a6SNamhyung Kim 
4594faf982a6SNamhyung Kim 	fgd->table = ftrace_graph_funcs;
4595faf982a6SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
4596faf982a6SNamhyung Kim 	fgd->count = &ftrace_graph_count;
4597faf982a6SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
4598faf982a6SNamhyung Kim 
4599faf982a6SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
4600faf982a6SNamhyung Kim }
4601faf982a6SNamhyung Kim 
4602faf982a6SNamhyung Kim static int
460329ad23b0SNamhyung Kim ftrace_graph_notrace_open(struct inode *inode, struct file *file)
460429ad23b0SNamhyung Kim {
460529ad23b0SNamhyung Kim 	struct ftrace_graph_data *fgd;
460629ad23b0SNamhyung Kim 
460729ad23b0SNamhyung Kim 	if (unlikely(ftrace_disabled))
460829ad23b0SNamhyung Kim 		return -ENODEV;
460929ad23b0SNamhyung Kim 
461029ad23b0SNamhyung Kim 	fgd = kmalloc(sizeof(*fgd), GFP_KERNEL);
461129ad23b0SNamhyung Kim 	if (fgd == NULL)
461229ad23b0SNamhyung Kim 		return -ENOMEM;
461329ad23b0SNamhyung Kim 
461429ad23b0SNamhyung Kim 	fgd->table = ftrace_graph_notrace_funcs;
461529ad23b0SNamhyung Kim 	fgd->size = FTRACE_GRAPH_MAX_FUNCS;
461629ad23b0SNamhyung Kim 	fgd->count = &ftrace_graph_notrace_count;
461729ad23b0SNamhyung Kim 	fgd->seq_ops = &ftrace_graph_seq_ops;
461829ad23b0SNamhyung Kim 
461929ad23b0SNamhyung Kim 	return __ftrace_graph_open(inode, file, fgd);
462029ad23b0SNamhyung Kim }
462129ad23b0SNamhyung Kim 
462229ad23b0SNamhyung Kim static int
462387827111SLi Zefan ftrace_graph_release(struct inode *inode, struct file *file)
462487827111SLi Zefan {
4625faf982a6SNamhyung Kim 	if (file->f_mode & FMODE_READ) {
4626faf982a6SNamhyung Kim 		struct seq_file *m = file->private_data;
4627faf982a6SNamhyung Kim 
4628faf982a6SNamhyung Kim 		kfree(m->private);
462987827111SLi Zefan 		seq_release(inode, file);
4630faf982a6SNamhyung Kim 	} else {
4631faf982a6SNamhyung Kim 		kfree(file->private_data);
4632faf982a6SNamhyung Kim 	}
4633faf982a6SNamhyung Kim 
463487827111SLi Zefan 	return 0;
463587827111SLi Zefan }
463687827111SLi Zefan 
463787827111SLi Zefan static int
4638faf982a6SNamhyung Kim ftrace_set_func(unsigned long *array, int *idx, int size, char *buffer)
4639ea4e2bc4SSteven Rostedt {
46403ba00929SDmitry Safonov 	struct ftrace_glob func_g;
4641ea4e2bc4SSteven Rostedt 	struct dyn_ftrace *rec;
4642ea4e2bc4SSteven Rostedt 	struct ftrace_page *pg;
4643c7c6b1feSLi Zefan 	int fail = 1;
46443ba00929SDmitry Safonov 	int not;
4645f9349a8fSFrederic Weisbecker 	bool exists;
4646f9349a8fSFrederic Weisbecker 	int i;
4647ea4e2bc4SSteven Rostedt 
4648f9349a8fSFrederic Weisbecker 	/* decode regex */
46493ba00929SDmitry Safonov 	func_g.type = filter_parse_regex(buffer, strlen(buffer),
46503ba00929SDmitry Safonov 					 &func_g.search, &not);
4651faf982a6SNamhyung Kim 	if (!not && *idx >= size)
4652c7c6b1feSLi Zefan 		return -EBUSY;
4653f9349a8fSFrederic Weisbecker 
46543ba00929SDmitry Safonov 	func_g.len = strlen(func_g.search);
4655f9349a8fSFrederic Weisbecker 
465652baf119SSteven Rostedt 	mutex_lock(&ftrace_lock);
465745a4a237SSteven Rostedt 
465845a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled)) {
465945a4a237SSteven Rostedt 		mutex_unlock(&ftrace_lock);
466045a4a237SSteven Rostedt 		return -ENODEV;
466145a4a237SSteven Rostedt 	}
466245a4a237SSteven Rostedt 
4663265c831cSSteven Rostedt 	do_for_each_ftrace_rec(pg, rec) {
4664ea4e2bc4SSteven Rostedt 
46650b507e1eSDmitry Safonov 		if (ftrace_match_record(rec, &func_g, NULL, 0)) {
4666c7c6b1feSLi Zefan 			/* if it is in the array */
4667f9349a8fSFrederic Weisbecker 			exists = false;
4668c7c6b1feSLi Zefan 			for (i = 0; i < *idx; i++) {
4669f9349a8fSFrederic Weisbecker 				if (array[i] == rec->ip) {
4670f9349a8fSFrederic Weisbecker 					exists = true;
4671faec2ec5SLiming Wang 					break;
4672faec2ec5SLiming Wang 				}
4673c7c6b1feSLi Zefan 			}
4674c7c6b1feSLi Zefan 
4675c7c6b1feSLi Zefan 			if (!not) {
4676c7c6b1feSLi Zefan 				fail = 0;
4677c7c6b1feSLi Zefan 				if (!exists) {
4678f9349a8fSFrederic Weisbecker 					array[(*idx)++] = rec->ip;
4679faf982a6SNamhyung Kim 					if (*idx >= size)
4680c7c6b1feSLi Zefan 						goto out;
4681c7c6b1feSLi Zefan 				}
4682c7c6b1feSLi Zefan 			} else {
4683c7c6b1feSLi Zefan 				if (exists) {
4684c7c6b1feSLi Zefan 					array[i] = array[--(*idx)];
4685c7c6b1feSLi Zefan 					array[*idx] = 0;
4686c7c6b1feSLi Zefan 					fail = 0;
4687c7c6b1feSLi Zefan 				}
4688c7c6b1feSLi Zefan 			}
4689f9349a8fSFrederic Weisbecker 		}
4690265c831cSSteven Rostedt 	} while_for_each_ftrace_rec();
4691c7c6b1feSLi Zefan out:
469252baf119SSteven Rostedt 	mutex_unlock(&ftrace_lock);
4693ea4e2bc4SSteven Rostedt 
4694c7c6b1feSLi Zefan 	if (fail)
4695c7c6b1feSLi Zefan 		return -EINVAL;
4696c7c6b1feSLi Zefan 
4697c7c6b1feSLi Zefan 	return 0;
4698ea4e2bc4SSteven Rostedt }
4699ea4e2bc4SSteven Rostedt 
4700ea4e2bc4SSteven Rostedt static ssize_t
4701ea4e2bc4SSteven Rostedt ftrace_graph_write(struct file *file, const char __user *ubuf,
4702ea4e2bc4SSteven Rostedt 		   size_t cnt, loff_t *ppos)
4703ea4e2bc4SSteven Rostedt {
4704689fd8b6S[email protected] 	struct trace_parser parser;
47056a10108bSNamhyung Kim 	ssize_t read, ret = 0;
4706faf982a6SNamhyung Kim 	struct ftrace_graph_data *fgd = file->private_data;
4707ea4e2bc4SSteven Rostedt 
4708c7c6b1feSLi Zefan 	if (!cnt)
4709ea4e2bc4SSteven Rostedt 		return 0;
4710ea4e2bc4SSteven Rostedt 
47116a10108bSNamhyung Kim 	if (trace_parser_get_init(&parser, FTRACE_BUFF_MAX))
47126a10108bSNamhyung Kim 		return -ENOMEM;
4713ea4e2bc4SSteven Rostedt 
4714689fd8b6S[email protected] 	read = trace_get_user(&parser, ubuf, cnt, ppos);
4715689fd8b6S[email protected] 
47164ba7978eSLi Zefan 	if (read >= 0 && trace_parser_loaded((&parser))) {
4717689fd8b6S[email protected] 		parser.buffer[parser.idx] = 0;
4718ea4e2bc4SSteven Rostedt 
47196a10108bSNamhyung Kim 		mutex_lock(&graph_lock);
47206a10108bSNamhyung Kim 
4721f9349a8fSFrederic Weisbecker 		/* we allow only one expression at a time */
4722faf982a6SNamhyung Kim 		ret = ftrace_set_func(fgd->table, fgd->count, fgd->size,
4723689fd8b6S[email protected] 				      parser.buffer);
47246a10108bSNamhyung Kim 
47256a10108bSNamhyung Kim 		mutex_unlock(&graph_lock);
4726689fd8b6S[email protected] 	}
4727ea4e2bc4SSteven Rostedt 
47286a10108bSNamhyung Kim 	if (!ret)
4729ea4e2bc4SSteven Rostedt 		ret = read;
47301eb90f13SLi Zefan 
4731689fd8b6S[email protected] 	trace_parser_put(&parser);
4732ea4e2bc4SSteven Rostedt 
4733ea4e2bc4SSteven Rostedt 	return ret;
4734ea4e2bc4SSteven Rostedt }
4735ea4e2bc4SSteven Rostedt 
4736ea4e2bc4SSteven Rostedt static const struct file_operations ftrace_graph_fops = {
4737ea4e2bc4SSteven Rostedt 	.open		= ftrace_graph_open,
4738850a80cfSLai Jiangshan 	.read		= seq_read,
4739ea4e2bc4SSteven Rostedt 	.write		= ftrace_graph_write,
4740098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
474187827111SLi Zefan 	.release	= ftrace_graph_release,
4742ea4e2bc4SSteven Rostedt };
474329ad23b0SNamhyung Kim 
474429ad23b0SNamhyung Kim static const struct file_operations ftrace_graph_notrace_fops = {
474529ad23b0SNamhyung Kim 	.open		= ftrace_graph_notrace_open,
474629ad23b0SNamhyung Kim 	.read		= seq_read,
474729ad23b0SNamhyung Kim 	.write		= ftrace_graph_write,
4748098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
474929ad23b0SNamhyung Kim 	.release	= ftrace_graph_release,
475029ad23b0SNamhyung Kim };
4751ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4752ea4e2bc4SSteven Rostedt 
4753591dffdaSSteven Rostedt (Red Hat) void ftrace_create_filter_files(struct ftrace_ops *ops,
4754591dffdaSSteven Rostedt (Red Hat) 				struct dentry *parent)
4755591dffdaSSteven Rostedt (Red Hat) {
4756591dffdaSSteven Rostedt (Red Hat) 
4757591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_filter", 0644, parent,
4758591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_filter_fops);
4759591dffdaSSteven Rostedt (Red Hat) 
4760591dffdaSSteven Rostedt (Red Hat) 	trace_create_file("set_ftrace_notrace", 0644, parent,
4761591dffdaSSteven Rostedt (Red Hat) 			  ops, &ftrace_notrace_fops);
4762591dffdaSSteven Rostedt (Red Hat) }
4763591dffdaSSteven Rostedt (Red Hat) 
4764591dffdaSSteven Rostedt (Red Hat) /*
4765591dffdaSSteven Rostedt (Red Hat)  * The name "destroy_filter_files" is really a misnomer. Although
4766591dffdaSSteven Rostedt (Red Hat)  * in the future, it may actualy delete the files, but this is
4767591dffdaSSteven Rostedt (Red Hat)  * really intended to make sure the ops passed in are disabled
4768591dffdaSSteven Rostedt (Red Hat)  * and that when this function returns, the caller is free to
4769591dffdaSSteven Rostedt (Red Hat)  * free the ops.
4770591dffdaSSteven Rostedt (Red Hat)  *
4771591dffdaSSteven Rostedt (Red Hat)  * The "destroy" name is only to match the "create" name that this
4772591dffdaSSteven Rostedt (Red Hat)  * should be paired with.
4773591dffdaSSteven Rostedt (Red Hat)  */
4774591dffdaSSteven Rostedt (Red Hat) void ftrace_destroy_filter_files(struct ftrace_ops *ops)
4775591dffdaSSteven Rostedt (Red Hat) {
4776591dffdaSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
4777591dffdaSSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_ENABLED)
4778591dffdaSSteven Rostedt (Red Hat) 		ftrace_shutdown(ops, 0);
4779591dffdaSSteven Rostedt (Red Hat) 	ops->flags |= FTRACE_OPS_FL_DELETED;
4780591dffdaSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
4781591dffdaSSteven Rostedt (Red Hat) }
4782591dffdaSSteven Rostedt (Red Hat) 
47838434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_dyn_tracefs(struct dentry *d_tracer)
47845072c59fSSteven Rostedt {
47855072c59fSSteven Rostedt 
47865452af66SFrederic Weisbecker 	trace_create_file("available_filter_functions", 0444,
47875072c59fSSteven Rostedt 			d_tracer, NULL, &ftrace_avail_fops);
47885072c59fSSteven Rostedt 
4789647bcd03SSteven Rostedt 	trace_create_file("enabled_functions", 0444,
4790647bcd03SSteven Rostedt 			d_tracer, NULL, &ftrace_enabled_fops);
4791647bcd03SSteven Rostedt 
4792591dffdaSSteven Rostedt (Red Hat) 	ftrace_create_filter_files(&global_ops, d_tracer);
4793ad90c0e3SSteven Rostedt 
4794ea4e2bc4SSteven Rostedt #ifdef CONFIG_FUNCTION_GRAPH_TRACER
47955452af66SFrederic Weisbecker 	trace_create_file("set_graph_function", 0444, d_tracer,
4796ea4e2bc4SSteven Rostedt 				    NULL,
4797ea4e2bc4SSteven Rostedt 				    &ftrace_graph_fops);
479829ad23b0SNamhyung Kim 	trace_create_file("set_graph_notrace", 0444, d_tracer,
479929ad23b0SNamhyung Kim 				    NULL,
480029ad23b0SNamhyung Kim 				    &ftrace_graph_notrace_fops);
4801ea4e2bc4SSteven Rostedt #endif /* CONFIG_FUNCTION_GRAPH_TRACER */
4802ea4e2bc4SSteven Rostedt 
48035072c59fSSteven Rostedt 	return 0;
48045072c59fSSteven Rostedt }
48055072c59fSSteven Rostedt 
48069fd49328SSteven Rostedt static int ftrace_cmp_ips(const void *a, const void *b)
480768950619SSteven Rostedt {
48089fd49328SSteven Rostedt 	const unsigned long *ipa = a;
48099fd49328SSteven Rostedt 	const unsigned long *ipb = b;
481068950619SSteven Rostedt 
48119fd49328SSteven Rostedt 	if (*ipa > *ipb)
48129fd49328SSteven Rostedt 		return 1;
48139fd49328SSteven Rostedt 	if (*ipa < *ipb)
48149fd49328SSteven Rostedt 		return -1;
48159fd49328SSteven Rostedt 	return 0;
48169fd49328SSteven Rostedt }
48179fd49328SSteven Rostedt 
48185cb084bbSJiri Olsa static int ftrace_process_locs(struct module *mod,
481931e88909SSteven Rostedt 			       unsigned long *start,
482068bf21aaSSteven Rostedt 			       unsigned long *end)
482168bf21aaSSteven Rostedt {
4822706c81f8SSteven Rostedt 	struct ftrace_page *start_pg;
4823a7900875SSteven Rostedt 	struct ftrace_page *pg;
4824706c81f8SSteven Rostedt 	struct dyn_ftrace *rec;
4825a7900875SSteven Rostedt 	unsigned long count;
482668bf21aaSSteven Rostedt 	unsigned long *p;
482768bf21aaSSteven Rostedt 	unsigned long addr;
48284376cac6SSteven Rostedt 	unsigned long flags = 0; /* Shut up gcc */
4829a7900875SSteven Rostedt 	int ret = -ENOMEM;
4830a7900875SSteven Rostedt 
4831a7900875SSteven Rostedt 	count = end - start;
4832a7900875SSteven Rostedt 
4833a7900875SSteven Rostedt 	if (!count)
4834a7900875SSteven Rostedt 		return 0;
4835a7900875SSteven Rostedt 
48369fd49328SSteven Rostedt 	sort(start, count, sizeof(*start),
48376db02903SRasmus Villemoes 	     ftrace_cmp_ips, NULL);
48389fd49328SSteven Rostedt 
4839706c81f8SSteven Rostedt 	start_pg = ftrace_allocate_pages(count);
4840706c81f8SSteven Rostedt 	if (!start_pg)
4841a7900875SSteven Rostedt 		return -ENOMEM;
484268bf21aaSSteven Rostedt 
4843e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
4844a7900875SSteven Rostedt 
484532082309SSteven Rostedt 	/*
484632082309SSteven Rostedt 	 * Core and each module needs their own pages, as
484732082309SSteven Rostedt 	 * modules will free them when they are removed.
484832082309SSteven Rostedt 	 * Force a new page to be allocated for modules.
484932082309SSteven Rostedt 	 */
4850a7900875SSteven Rostedt 	if (!mod) {
4851a7900875SSteven Rostedt 		WARN_ON(ftrace_pages || ftrace_pages_start);
4852a7900875SSteven Rostedt 		/* First initialization */
4853706c81f8SSteven Rostedt 		ftrace_pages = ftrace_pages_start = start_pg;
4854a7900875SSteven Rostedt 	} else {
485532082309SSteven Rostedt 		if (!ftrace_pages)
4856a7900875SSteven Rostedt 			goto out;
485732082309SSteven Rostedt 
4858a7900875SSteven Rostedt 		if (WARN_ON(ftrace_pages->next)) {
4859a7900875SSteven Rostedt 			/* Hmm, we have free pages? */
4860a7900875SSteven Rostedt 			while (ftrace_pages->next)
486132082309SSteven Rostedt 				ftrace_pages = ftrace_pages->next;
486232082309SSteven Rostedt 		}
4863a7900875SSteven Rostedt 
4864706c81f8SSteven Rostedt 		ftrace_pages->next = start_pg;
486532082309SSteven Rostedt 	}
486632082309SSteven Rostedt 
486768bf21aaSSteven Rostedt 	p = start;
4868706c81f8SSteven Rostedt 	pg = start_pg;
486968bf21aaSSteven Rostedt 	while (p < end) {
487068bf21aaSSteven Rostedt 		addr = ftrace_call_adjust(*p++);
487120e5227eSSteven Rostedt 		/*
487220e5227eSSteven Rostedt 		 * Some architecture linkers will pad between
487320e5227eSSteven Rostedt 		 * the different mcount_loc sections of different
487420e5227eSSteven Rostedt 		 * object files to satisfy alignments.
487520e5227eSSteven Rostedt 		 * Skip any NULL pointers.
487620e5227eSSteven Rostedt 		 */
487720e5227eSSteven Rostedt 		if (!addr)
487820e5227eSSteven Rostedt 			continue;
4879706c81f8SSteven Rostedt 
4880706c81f8SSteven Rostedt 		if (pg->index == pg->size) {
4881706c81f8SSteven Rostedt 			/* We should have allocated enough */
4882706c81f8SSteven Rostedt 			if (WARN_ON(!pg->next))
4883a7900875SSteven Rostedt 				break;
4884706c81f8SSteven Rostedt 			pg = pg->next;
488568bf21aaSSteven Rostedt 		}
488668bf21aaSSteven Rostedt 
4887706c81f8SSteven Rostedt 		rec = &pg->records[pg->index++];
4888706c81f8SSteven Rostedt 		rec->ip = addr;
4889706c81f8SSteven Rostedt 	}
4890706c81f8SSteven Rostedt 
4891706c81f8SSteven Rostedt 	/* We should have used all pages */
4892706c81f8SSteven Rostedt 	WARN_ON(pg->next);
4893706c81f8SSteven Rostedt 
4894706c81f8SSteven Rostedt 	/* Assign the last page to ftrace_pages */
4895706c81f8SSteven Rostedt 	ftrace_pages = pg;
4896706c81f8SSteven Rostedt 
4897a4f18ed1SSteven Rostedt 	/*
48984376cac6SSteven Rostedt 	 * We only need to disable interrupts on start up
48994376cac6SSteven Rostedt 	 * because we are modifying code that an interrupt
49004376cac6SSteven Rostedt 	 * may execute, and the modification is not atomic.
49014376cac6SSteven Rostedt 	 * But for modules, nothing runs the code we modify
49024376cac6SSteven Rostedt 	 * until we are finished with it, and there's no
49034376cac6SSteven Rostedt 	 * reason to cause large interrupt latencies while we do it.
4904a4f18ed1SSteven Rostedt 	 */
49054376cac6SSteven Rostedt 	if (!mod)
4906a4f18ed1SSteven Rostedt 		local_irq_save(flags);
49071dc43cf0SJiri Slaby 	ftrace_update_code(mod, start_pg);
49084376cac6SSteven Rostedt 	if (!mod)
4909a4f18ed1SSteven Rostedt 		local_irq_restore(flags);
4910a7900875SSteven Rostedt 	ret = 0;
4911a7900875SSteven Rostedt  out:
4912e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
491368bf21aaSSteven Rostedt 
4914a7900875SSteven Rostedt 	return ret;
491568bf21aaSSteven Rostedt }
491668bf21aaSSteven Rostedt 
491793eb677dSSteven Rostedt #ifdef CONFIG_MODULES
491832082309SSteven Rostedt 
491932082309SSteven Rostedt #define next_to_ftrace_page(p) container_of(p, struct ftrace_page, next)
492032082309SSteven Rostedt 
4921b7ffffbbSSteven Rostedt (Red Hat) static int referenced_filters(struct dyn_ftrace *rec)
4922b7ffffbbSSteven Rostedt (Red Hat) {
4923b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_ops *ops;
4924b7ffffbbSSteven Rostedt (Red Hat) 	int cnt = 0;
4925b7ffffbbSSteven Rostedt (Red Hat) 
4926b7ffffbbSSteven Rostedt (Red Hat) 	for (ops = ftrace_ops_list; ops != &ftrace_list_end; ops = ops->next) {
4927b7ffffbbSSteven Rostedt (Red Hat) 		if (ops_references_rec(ops, rec))
4928b7ffffbbSSteven Rostedt (Red Hat) 		    cnt++;
4929b7ffffbbSSteven Rostedt (Red Hat) 	}
4930b7ffffbbSSteven Rostedt (Red Hat) 
4931b7ffffbbSSteven Rostedt (Red Hat) 	return cnt;
4932b7ffffbbSSteven Rostedt (Red Hat) }
4933b7ffffbbSSteven Rostedt (Red Hat) 
4934e7247a15S[email protected] void ftrace_release_mod(struct module *mod)
493593eb677dSSteven Rostedt {
493693eb677dSSteven Rostedt 	struct dyn_ftrace *rec;
493732082309SSteven Rostedt 	struct ftrace_page **last_pg;
493893eb677dSSteven Rostedt 	struct ftrace_page *pg;
4939a7900875SSteven Rostedt 	int order;
494093eb677dSSteven Rostedt 
494193eb677dSSteven Rostedt 	mutex_lock(&ftrace_lock);
494245a4a237SSteven Rostedt 
494345a4a237SSteven Rostedt 	if (ftrace_disabled)
494445a4a237SSteven Rostedt 		goto out_unlock;
494545a4a237SSteven Rostedt 
494632082309SSteven Rostedt 	/*
494732082309SSteven Rostedt 	 * Each module has its own ftrace_pages, remove
494832082309SSteven Rostedt 	 * them from the list.
494932082309SSteven Rostedt 	 */
495032082309SSteven Rostedt 	last_pg = &ftrace_pages_start;
495132082309SSteven Rostedt 	for (pg = ftrace_pages_start; pg; pg = *last_pg) {
495232082309SSteven Rostedt 		rec = &pg->records[0];
4953e7247a15S[email protected] 		if (within_module_core(rec->ip, mod)) {
495493eb677dSSteven Rostedt 			/*
495532082309SSteven Rostedt 			 * As core pages are first, the first
495632082309SSteven Rostedt 			 * page should never be a module page.
495793eb677dSSteven Rostedt 			 */
495832082309SSteven Rostedt 			if (WARN_ON(pg == ftrace_pages_start))
495932082309SSteven Rostedt 				goto out_unlock;
496032082309SSteven Rostedt 
496132082309SSteven Rostedt 			/* Check if we are deleting the last page */
496232082309SSteven Rostedt 			if (pg == ftrace_pages)
496332082309SSteven Rostedt 				ftrace_pages = next_to_ftrace_page(last_pg);
496432082309SSteven Rostedt 
496532082309SSteven Rostedt 			*last_pg = pg->next;
4966a7900875SSteven Rostedt 			order = get_count_order(pg->size / ENTRIES_PER_PAGE);
4967a7900875SSteven Rostedt 			free_pages((unsigned long)pg->records, order);
4968a7900875SSteven Rostedt 			kfree(pg);
496932082309SSteven Rostedt 		} else
497032082309SSteven Rostedt 			last_pg = &pg->next;
497193eb677dSSteven Rostedt 	}
497245a4a237SSteven Rostedt  out_unlock:
497393eb677dSSteven Rostedt 	mutex_unlock(&ftrace_lock);
497493eb677dSSteven Rostedt }
497593eb677dSSteven Rostedt 
4976b7ffffbbSSteven Rostedt (Red Hat) static void ftrace_module_enable(struct module *mod)
4977b7ffffbbSSteven Rostedt (Red Hat) {
4978b7ffffbbSSteven Rostedt (Red Hat) 	struct dyn_ftrace *rec;
4979b7ffffbbSSteven Rostedt (Red Hat) 	struct ftrace_page *pg;
4980b7ffffbbSSteven Rostedt (Red Hat) 
4981b7ffffbbSSteven Rostedt (Red Hat) 	mutex_lock(&ftrace_lock);
4982b7ffffbbSSteven Rostedt (Red Hat) 
4983b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_disabled)
4984b7ffffbbSSteven Rostedt (Red Hat) 		goto out_unlock;
4985b7ffffbbSSteven Rostedt (Red Hat) 
4986b7ffffbbSSteven Rostedt (Red Hat) 	/*
4987b7ffffbbSSteven Rostedt (Red Hat) 	 * If the tracing is enabled, go ahead and enable the record.
4988b7ffffbbSSteven Rostedt (Red Hat) 	 *
4989b7ffffbbSSteven Rostedt (Red Hat) 	 * The reason not to enable the record immediatelly is the
4990b7ffffbbSSteven Rostedt (Red Hat) 	 * inherent check of ftrace_make_nop/ftrace_make_call for
4991b7ffffbbSSteven Rostedt (Red Hat) 	 * correct previous instructions.  Making first the NOP
4992b7ffffbbSSteven Rostedt (Red Hat) 	 * conversion puts the module to the correct state, thus
4993b7ffffbbSSteven Rostedt (Red Hat) 	 * passing the ftrace_make_call check.
4994b7ffffbbSSteven Rostedt (Red Hat) 	 *
4995b7ffffbbSSteven Rostedt (Red Hat) 	 * We also delay this to after the module code already set the
4996b7ffffbbSSteven Rostedt (Red Hat) 	 * text to read-only, as we now need to set it back to read-write
4997b7ffffbbSSteven Rostedt (Red Hat) 	 * so that we can modify the text.
4998b7ffffbbSSteven Rostedt (Red Hat) 	 */
4999b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5000b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_prepare();
5001b7ffffbbSSteven Rostedt (Red Hat) 
5002b7ffffbbSSteven Rostedt (Red Hat) 	do_for_each_ftrace_rec(pg, rec) {
5003b7ffffbbSSteven Rostedt (Red Hat) 		int cnt;
5004b7ffffbbSSteven Rostedt (Red Hat) 		/*
5005b7ffffbbSSteven Rostedt (Red Hat) 		 * do_for_each_ftrace_rec() is a double loop.
5006b7ffffbbSSteven Rostedt (Red Hat) 		 * module text shares the pg. If a record is
5007b7ffffbbSSteven Rostedt (Red Hat) 		 * not part of this module, then skip this pg,
5008b7ffffbbSSteven Rostedt (Red Hat) 		 * which the "break" will do.
5009b7ffffbbSSteven Rostedt (Red Hat) 		 */
5010b7ffffbbSSteven Rostedt (Red Hat) 		if (!within_module_core(rec->ip, mod))
5011b7ffffbbSSteven Rostedt (Red Hat) 			break;
5012b7ffffbbSSteven Rostedt (Red Hat) 
5013b7ffffbbSSteven Rostedt (Red Hat) 		cnt = 0;
5014b7ffffbbSSteven Rostedt (Red Hat) 
5015b7ffffbbSSteven Rostedt (Red Hat) 		/*
5016b7ffffbbSSteven Rostedt (Red Hat) 		 * When adding a module, we need to check if tracers are
5017b7ffffbbSSteven Rostedt (Red Hat) 		 * currently enabled and if they are, and can trace this record,
5018b7ffffbbSSteven Rostedt (Red Hat) 		 * we need to enable the module functions as well as update the
5019b7ffffbbSSteven Rostedt (Red Hat) 		 * reference counts for those function records.
5020b7ffffbbSSteven Rostedt (Red Hat) 		 */
5021b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up)
5022b7ffffbbSSteven Rostedt (Red Hat) 			cnt += referenced_filters(rec);
5023b7ffffbbSSteven Rostedt (Red Hat) 
5024b7ffffbbSSteven Rostedt (Red Hat) 		/* This clears FTRACE_FL_DISABLED */
5025b7ffffbbSSteven Rostedt (Red Hat) 		rec->flags = cnt;
5026b7ffffbbSSteven Rostedt (Red Hat) 
5027b7ffffbbSSteven Rostedt (Red Hat) 		if (ftrace_start_up && cnt) {
5028b7ffffbbSSteven Rostedt (Red Hat) 			int failed = __ftrace_replace_code(rec, 1);
5029b7ffffbbSSteven Rostedt (Red Hat) 			if (failed) {
5030b7ffffbbSSteven Rostedt (Red Hat) 				ftrace_bug(failed, rec);
5031b7ffffbbSSteven Rostedt (Red Hat) 				goto out_loop;
5032b7ffffbbSSteven Rostedt (Red Hat) 			}
5033b7ffffbbSSteven Rostedt (Red Hat) 		}
5034b7ffffbbSSteven Rostedt (Red Hat) 
5035b7ffffbbSSteven Rostedt (Red Hat) 	} while_for_each_ftrace_rec();
5036b7ffffbbSSteven Rostedt (Red Hat) 
5037b7ffffbbSSteven Rostedt (Red Hat)  out_loop:
5038b7ffffbbSSteven Rostedt (Red Hat) 	if (ftrace_start_up)
5039b7ffffbbSSteven Rostedt (Red Hat) 		ftrace_arch_code_modify_post_process();
5040b7ffffbbSSteven Rostedt (Red Hat) 
5041b7ffffbbSSteven Rostedt (Red Hat)  out_unlock:
5042b7ffffbbSSteven Rostedt (Red Hat) 	mutex_unlock(&ftrace_lock);
5043b7ffffbbSSteven Rostedt (Red Hat) }
5044b7ffffbbSSteven Rostedt (Red Hat) 
5045a949ae56SSteven Rostedt (Red Hat) void ftrace_module_init(struct module *mod)
504693eb677dSSteven Rostedt {
504797e9b4fcSSteven Rostedt (Red Hat) 	if (ftrace_disabled || !mod->num_ftrace_callsites)
5048b6b71f66SAbel Vesa 		return;
5049b6b71f66SAbel Vesa 
505097e9b4fcSSteven Rostedt (Red Hat) 	ftrace_process_locs(mod, mod->ftrace_callsites,
505197e9b4fcSSteven Rostedt (Red Hat) 			    mod->ftrace_callsites + mod->num_ftrace_callsites);
505293eb677dSSteven Rostedt }
505393eb677dSSteven Rostedt 
50545156dca3SQiu Peiyang static int ftrace_module_notify(struct notifier_block *self,
50558c189ea6SSteven Rostedt (Red Hat) 				unsigned long val, void *data)
50568c189ea6SSteven Rostedt (Red Hat) {
50578c189ea6SSteven Rostedt (Red Hat) 	struct module *mod = data;
50588c189ea6SSteven Rostedt (Red Hat) 
50595156dca3SQiu Peiyang 	switch (val) {
50605156dca3SQiu Peiyang 	case MODULE_STATE_COMING:
50615156dca3SQiu Peiyang 		ftrace_module_enable(mod);
50625156dca3SQiu Peiyang 		break;
50635156dca3SQiu Peiyang 	case MODULE_STATE_GOING:
50648c189ea6SSteven Rostedt (Red Hat) 		ftrace_release_mod(mod);
50655156dca3SQiu Peiyang 		break;
50665156dca3SQiu Peiyang 	default:
50675156dca3SQiu Peiyang 		break;
50685156dca3SQiu Peiyang 	}
50698c189ea6SSteven Rostedt (Red Hat) 
507093eb677dSSteven Rostedt 	return 0;
507193eb677dSSteven Rostedt }
507293eb677dSSteven Rostedt #else
50735156dca3SQiu Peiyang static int ftrace_module_notify(struct notifier_block *self,
507493eb677dSSteven Rostedt 				unsigned long val, void *data)
507593eb677dSSteven Rostedt {
507693eb677dSSteven Rostedt 	return 0;
507793eb677dSSteven Rostedt }
507893eb677dSSteven Rostedt #endif /* CONFIG_MODULES */
507993eb677dSSteven Rostedt 
50805156dca3SQiu Peiyang struct notifier_block ftrace_module_nb = {
50815156dca3SQiu Peiyang 	.notifier_call = ftrace_module_notify,
50828c189ea6SSteven Rostedt (Red Hat) 	.priority = INT_MIN,	/* Run after anything that can remove kprobes */
50838c189ea6SSteven Rostedt (Red Hat) };
50848c189ea6SSteven Rostedt (Red Hat) 
508568bf21aaSSteven Rostedt void __init ftrace_init(void)
508668bf21aaSSteven Rostedt {
50871dc43cf0SJiri Slaby 	extern unsigned long __start_mcount_loc[];
50881dc43cf0SJiri Slaby 	extern unsigned long __stop_mcount_loc[];
50893a36cb11SJiri Slaby 	unsigned long count, flags;
509068bf21aaSSteven Rostedt 	int ret;
509168bf21aaSSteven Rostedt 
509268bf21aaSSteven Rostedt 	local_irq_save(flags);
50933a36cb11SJiri Slaby 	ret = ftrace_dyn_arch_init();
509468bf21aaSSteven Rostedt 	local_irq_restore(flags);
5095af64a7cbSJiri Slaby 	if (ret)
509668bf21aaSSteven Rostedt 		goto failed;
509768bf21aaSSteven Rostedt 
509868bf21aaSSteven Rostedt 	count = __stop_mcount_loc - __start_mcount_loc;
5099c867ccd8SJiri Slaby 	if (!count) {
5100c867ccd8SJiri Slaby 		pr_info("ftrace: No functions to be traced?\n");
510168bf21aaSSteven Rostedt 		goto failed;
5102c867ccd8SJiri Slaby 	}
5103c867ccd8SJiri Slaby 
5104c867ccd8SJiri Slaby 	pr_info("ftrace: allocating %ld entries in %ld pages\n",
5105c867ccd8SJiri Slaby 		count, count / ENTRIES_PER_PAGE + 1);
510668bf21aaSSteven Rostedt 
510768bf21aaSSteven Rostedt 	last_ftrace_enabled = ftrace_enabled = 1;
510868bf21aaSSteven Rostedt 
51095cb084bbSJiri Olsa 	ret = ftrace_process_locs(NULL,
511031e88909SSteven Rostedt 				  __start_mcount_loc,
511168bf21aaSSteven Rostedt 				  __stop_mcount_loc);
511268bf21aaSSteven Rostedt 
51135156dca3SQiu Peiyang 	ret = register_module_notifier(&ftrace_module_nb);
51148c189ea6SSteven Rostedt (Red Hat) 	if (ret)
51158c189ea6SSteven Rostedt (Red Hat) 		pr_warning("Failed to register trace ftrace module exit notifier\n");
511693eb677dSSteven Rostedt 
51172af15d6aSSteven Rostedt 	set_ftrace_early_filters();
51182af15d6aSSteven Rostedt 
511968bf21aaSSteven Rostedt 	return;
512068bf21aaSSteven Rostedt  failed:
512168bf21aaSSteven Rostedt 	ftrace_disabled = 1;
512268bf21aaSSteven Rostedt }
512368bf21aaSSteven Rostedt 
5124f3bea491SSteven Rostedt (Red Hat) /* Do nothing if arch does not support this */
5125f3bea491SSteven Rostedt (Red Hat) void __weak arch_ftrace_update_trampoline(struct ftrace_ops *ops)
5126f3bea491SSteven Rostedt (Red Hat) {
5127f3bea491SSteven Rostedt (Red Hat) }
5128f3bea491SSteven Rostedt (Red Hat) 
5129f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5130f3bea491SSteven Rostedt (Red Hat) {
513112cce594SSteven Rostedt (Red Hat) 
513212cce594SSteven Rostedt (Red Hat) /*
513312cce594SSteven Rostedt (Red Hat)  * Currently there's no safe way to free a trampoline when the kernel
513412cce594SSteven Rostedt (Red Hat)  * is configured with PREEMPT. That is because a task could be preempted
513512cce594SSteven Rostedt (Red Hat)  * when it jumped to the trampoline, it may be preempted for a long time
513612cce594SSteven Rostedt (Red Hat)  * depending on the system load, and currently there's no way to know
513712cce594SSteven Rostedt (Red Hat)  * when it will be off the trampoline. If the trampoline is freed
513812cce594SSteven Rostedt (Red Hat)  * too early, when the task runs again, it will be executing on freed
513912cce594SSteven Rostedt (Red Hat)  * memory and crash.
514012cce594SSteven Rostedt (Red Hat)  */
514112cce594SSteven Rostedt (Red Hat) #ifdef CONFIG_PREEMPT
5142f3bea491SSteven Rostedt (Red Hat) 	/* Currently, only non dynamic ops can have a trampoline */
5143f3bea491SSteven Rostedt (Red Hat) 	if (ops->flags & FTRACE_OPS_FL_DYNAMIC)
5144f3bea491SSteven Rostedt (Red Hat) 		return;
514512cce594SSteven Rostedt (Red Hat) #endif
5146f3bea491SSteven Rostedt (Red Hat) 
5147f3bea491SSteven Rostedt (Red Hat) 	arch_ftrace_update_trampoline(ops);
5148f3bea491SSteven Rostedt (Red Hat) }
5149f3bea491SSteven Rostedt (Red Hat) 
51503d083395SSteven Rostedt #else
51510b6e4d56SFrederic Weisbecker 
51522b499381SSteven Rostedt static struct ftrace_ops global_ops = {
5153bd69c30bSSteven Rostedt 	.func			= ftrace_stub,
5154e3eea140SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
5155e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_INITIALIZED |
5156e3eea140SSteven Rostedt (Red Hat) 				  FTRACE_OPS_FL_PID,
5157bd69c30bSSteven Rostedt };
5158bd69c30bSSteven Rostedt 
51590b6e4d56SFrederic Weisbecker static int __init ftrace_nodyn_init(void)
51600b6e4d56SFrederic Weisbecker {
51610b6e4d56SFrederic Weisbecker 	ftrace_enabled = 1;
51620b6e4d56SFrederic Weisbecker 	return 0;
51630b6e4d56SFrederic Weisbecker }
51646f415672SSteven Rostedt core_initcall(ftrace_nodyn_init);
51650b6e4d56SFrederic Weisbecker 
51668434dc93SSteven Rostedt (Red Hat) static inline int ftrace_init_dyn_tracefs(struct dentry *d_tracer) { return 0; }
5167df4fc315SSteven Rostedt static inline void ftrace_startup_enable(int command) { }
5168e1effa01SSteven Rostedt (Red Hat) static inline void ftrace_startup_all(int command) { }
51695a45cfe1SSteven Rostedt /* Keep as macros so we do not need to define the commands */
51703b6cfdb1SSteven Rostedt # define ftrace_startup(ops, command)					\
51713b6cfdb1SSteven Rostedt 	({								\
51728a56d776SSteven Rostedt (Red Hat) 		int ___ret = __register_ftrace_function(ops);		\
51738a56d776SSteven Rostedt (Red Hat) 		if (!___ret)						\
51743b6cfdb1SSteven Rostedt 			(ops)->flags |= FTRACE_OPS_FL_ENABLED;		\
51758a56d776SSteven Rostedt (Red Hat) 		___ret;							\
51763b6cfdb1SSteven Rostedt 	})
51771fcc1553SSteven Rostedt (Red Hat) # define ftrace_shutdown(ops, command)					\
51781fcc1553SSteven Rostedt (Red Hat) 	({								\
51791fcc1553SSteven Rostedt (Red Hat) 		int ___ret = __unregister_ftrace_function(ops);		\
51801fcc1553SSteven Rostedt (Red Hat) 		if (!___ret)						\
51811fcc1553SSteven Rostedt (Red Hat) 			(ops)->flags &= ~FTRACE_OPS_FL_ENABLED;		\
51821fcc1553SSteven Rostedt (Red Hat) 		___ret;							\
51831fcc1553SSteven Rostedt (Red Hat) 	})
51848a56d776SSteven Rostedt (Red Hat) 
5185b0fc494fSSteven Rostedt # define ftrace_startup_sysctl()	do { } while (0)
5186b0fc494fSSteven Rostedt # define ftrace_shutdown_sysctl()	do { } while (0)
5187b848914cSSteven Rostedt 
5188b848914cSSteven Rostedt static inline int
5189195a8afcSSteven Rostedt (Red Hat) ftrace_ops_test(struct ftrace_ops *ops, unsigned long ip, void *regs)
5190b848914cSSteven Rostedt {
5191b848914cSSteven Rostedt 	return 1;
5192b848914cSSteven Rostedt }
5193b848914cSSteven Rostedt 
5194f3bea491SSteven Rostedt (Red Hat) static void ftrace_update_trampoline(struct ftrace_ops *ops)
5195f3bea491SSteven Rostedt (Red Hat) {
5196f3bea491SSteven Rostedt (Red Hat) }
5197f3bea491SSteven Rostedt (Red Hat) 
51983d083395SSteven Rostedt #endif /* CONFIG_DYNAMIC_FTRACE */
51993d083395SSteven Rostedt 
52004104d326SSteven Rostedt (Red Hat) __init void ftrace_init_global_array_ops(struct trace_array *tr)
52014104d326SSteven Rostedt (Red Hat) {
52024104d326SSteven Rostedt (Red Hat) 	tr->ops = &global_ops;
52034104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
52044104d326SSteven Rostedt (Red Hat) }
52054104d326SSteven Rostedt (Red Hat) 
52064104d326SSteven Rostedt (Red Hat) void ftrace_init_array_ops(struct trace_array *tr, ftrace_func_t func)
52074104d326SSteven Rostedt (Red Hat) {
52084104d326SSteven Rostedt (Red Hat) 	/* If we filter on pids, update to use the pid function */
52094104d326SSteven Rostedt (Red Hat) 	if (tr->flags & TRACE_ARRAY_FL_GLOBAL) {
52104104d326SSteven Rostedt (Red Hat) 		if (WARN_ON(tr->ops->func != ftrace_stub))
52114104d326SSteven Rostedt (Red Hat) 			printk("ftrace ops had %pS for function\n",
52124104d326SSteven Rostedt (Red Hat) 			       tr->ops->func);
52134104d326SSteven Rostedt (Red Hat) 	}
52144104d326SSteven Rostedt (Red Hat) 	tr->ops->func = func;
52154104d326SSteven Rostedt (Red Hat) 	tr->ops->private = tr;
52164104d326SSteven Rostedt (Red Hat) }
52174104d326SSteven Rostedt (Red Hat) 
52184104d326SSteven Rostedt (Red Hat) void ftrace_reset_array_ops(struct trace_array *tr)
52194104d326SSteven Rostedt (Red Hat) {
52204104d326SSteven Rostedt (Red Hat) 	tr->ops->func = ftrace_stub;
52214104d326SSteven Rostedt (Red Hat) }
52224104d326SSteven Rostedt (Red Hat) 
52232f5f6ad9SSteven Rostedt static inline void
52242f5f6ad9SSteven Rostedt __ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5225a1e2e31dSSteven Rostedt 		       struct ftrace_ops *ignored, struct pt_regs *regs)
5226b848914cSSteven Rostedt {
5227cdbe61bfSSteven Rostedt 	struct ftrace_ops *op;
5228edc15cafSSteven Rostedt 	int bit;
5229b848914cSSteven Rostedt 
5230edc15cafSSteven Rostedt 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5231edc15cafSSteven Rostedt 	if (bit < 0)
5232b1cff0adSSteven Rostedt 		return;
5233b1cff0adSSteven Rostedt 
5234cdbe61bfSSteven Rostedt 	/*
5235cdbe61bfSSteven Rostedt 	 * Some of the ops may be dynamically allocated,
5236cdbe61bfSSteven Rostedt 	 * they must be freed after a synchronize_sched().
5237cdbe61bfSSteven Rostedt 	 */
5238cdbe61bfSSteven Rostedt 	preempt_disable_notrace();
5239ba27f2bcSSteven Rostedt (Red Hat) 
52400a016409SSteven Rostedt 	do_for_each_ftrace_op(op, ftrace_ops_list) {
5241ba27f2bcSSteven Rostedt (Red Hat) 		/*
5242ba27f2bcSSteven Rostedt (Red Hat) 		 * Check the following for each ops before calling their func:
5243ba27f2bcSSteven Rostedt (Red Hat) 		 *  if RCU flag is set, then rcu_is_watching() must be true
5244ba27f2bcSSteven Rostedt (Red Hat) 		 *  if PER_CPU is set, then ftrace_function_local_disable()
5245ba27f2bcSSteven Rostedt (Red Hat) 		 *                          must be false
5246ba27f2bcSSteven Rostedt (Red Hat) 		 *  Otherwise test if the ip matches the ops filter
5247ba27f2bcSSteven Rostedt (Red Hat) 		 *
5248ba27f2bcSSteven Rostedt (Red Hat) 		 * If any of the above fails then the op->func() is not executed.
5249ba27f2bcSSteven Rostedt (Red Hat) 		 */
5250ba27f2bcSSteven Rostedt (Red Hat) 		if ((!(op->flags & FTRACE_OPS_FL_RCU) || rcu_is_watching()) &&
5251ba27f2bcSSteven Rostedt (Red Hat) 		    (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5252ba27f2bcSSteven Rostedt (Red Hat) 		     !ftrace_function_local_disabled(op)) &&
5253ba27f2bcSSteven Rostedt (Red Hat) 		    ftrace_ops_test(op, ip, regs)) {
5254ba27f2bcSSteven Rostedt (Red Hat) 
52551d48d596SSteven Rostedt (Red Hat) 			if (FTRACE_WARN_ON(!op->func)) {
52561d48d596SSteven Rostedt (Red Hat) 				pr_warn("op=%p %pS\n", op, op);
52574104d326SSteven Rostedt (Red Hat) 				goto out;
52584104d326SSteven Rostedt (Red Hat) 			}
5259a1e2e31dSSteven Rostedt 			op->func(ip, parent_ip, op, regs);
52604104d326SSteven Rostedt (Red Hat) 		}
52610a016409SSteven Rostedt 	} while_for_each_ftrace_op(op);
52624104d326SSteven Rostedt (Red Hat) out:
5263cdbe61bfSSteven Rostedt 	preempt_enable_notrace();
5264edc15cafSSteven Rostedt 	trace_clear_recursion(bit);
5265b848914cSSteven Rostedt }
5266b848914cSSteven Rostedt 
52672f5f6ad9SSteven Rostedt /*
52682f5f6ad9SSteven Rostedt  * Some archs only support passing ip and parent_ip. Even though
52692f5f6ad9SSteven Rostedt  * the list function ignores the op parameter, we do not want any
52702f5f6ad9SSteven Rostedt  * C side effects, where a function is called without the caller
52712f5f6ad9SSteven Rostedt  * sending a third parameter.
5272a1e2e31dSSteven Rostedt  * Archs are to support both the regs and ftrace_ops at the same time.
5273a1e2e31dSSteven Rostedt  * If they support ftrace_ops, it is assumed they support regs.
5274a1e2e31dSSteven Rostedt  * If call backs want to use regs, they must either check for regs
527506aeaaeaSMasami Hiramatsu  * being NULL, or CONFIG_DYNAMIC_FTRACE_WITH_REGS.
527606aeaaeaSMasami Hiramatsu  * Note, CONFIG_DYNAMIC_FTRACE_WITH_REGS expects a full regs to be saved.
5277a1e2e31dSSteven Rostedt  * An architecture can pass partial regs with ftrace_ops and still
5278b8ec330aSLi Bin  * set the ARCH_SUPPORTS_FTRACE_OPS.
52792f5f6ad9SSteven Rostedt  */
52802f5f6ad9SSteven Rostedt #if ARCH_SUPPORTS_FTRACE_OPS
52812f5f6ad9SSteven Rostedt static void ftrace_ops_list_func(unsigned long ip, unsigned long parent_ip,
5282a1e2e31dSSteven Rostedt 				 struct ftrace_ops *op, struct pt_regs *regs)
52832f5f6ad9SSteven Rostedt {
5284a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, regs);
52852f5f6ad9SSteven Rostedt }
52862f5f6ad9SSteven Rostedt #else
52872f5f6ad9SSteven Rostedt static void ftrace_ops_no_ops(unsigned long ip, unsigned long parent_ip)
52882f5f6ad9SSteven Rostedt {
5289a1e2e31dSSteven Rostedt 	__ftrace_ops_list_func(ip, parent_ip, NULL, NULL);
52902f5f6ad9SSteven Rostedt }
52912f5f6ad9SSteven Rostedt #endif
52922f5f6ad9SSteven Rostedt 
5293f1ff6348SSteven Rostedt (Red Hat) /*
5294f1ff6348SSteven Rostedt (Red Hat)  * If there's only one function registered but it does not support
5295c68c0fa2SSteven Rostedt (Red Hat)  * recursion, needs RCU protection and/or requires per cpu handling, then
5296c68c0fa2SSteven Rostedt (Red Hat)  * this function will be called by the mcount trampoline.
5297f1ff6348SSteven Rostedt (Red Hat)  */
5298c68c0fa2SSteven Rostedt (Red Hat) static void ftrace_ops_assist_func(unsigned long ip, unsigned long parent_ip,
5299f1ff6348SSteven Rostedt (Red Hat) 				   struct ftrace_ops *op, struct pt_regs *regs)
5300f1ff6348SSteven Rostedt (Red Hat) {
5301f1ff6348SSteven Rostedt (Red Hat) 	int bit;
5302f1ff6348SSteven Rostedt (Red Hat) 
5303c68c0fa2SSteven Rostedt (Red Hat) 	if ((op->flags & FTRACE_OPS_FL_RCU) && !rcu_is_watching())
5304c68c0fa2SSteven Rostedt (Red Hat) 		return;
5305c68c0fa2SSteven Rostedt (Red Hat) 
5306f1ff6348SSteven Rostedt (Red Hat) 	bit = trace_test_and_set_recursion(TRACE_LIST_START, TRACE_LIST_MAX);
5307f1ff6348SSteven Rostedt (Red Hat) 	if (bit < 0)
5308f1ff6348SSteven Rostedt (Red Hat) 		return;
5309f1ff6348SSteven Rostedt (Red Hat) 
5310c68c0fa2SSteven Rostedt (Red Hat) 	preempt_disable_notrace();
5311f1ff6348SSteven Rostedt (Red Hat) 
5312c68c0fa2SSteven Rostedt (Red Hat) 	if (!(op->flags & FTRACE_OPS_FL_PER_CPU) ||
5313c68c0fa2SSteven Rostedt (Red Hat) 	    !ftrace_function_local_disabled(op)) {
5314c68c0fa2SSteven Rostedt (Red Hat) 		op->func(ip, parent_ip, op, regs);
5315c68c0fa2SSteven Rostedt (Red Hat) 	}
5316c68c0fa2SSteven Rostedt (Red Hat) 
5317c68c0fa2SSteven Rostedt (Red Hat) 	preempt_enable_notrace();
5318f1ff6348SSteven Rostedt (Red Hat) 	trace_clear_recursion(bit);
5319f1ff6348SSteven Rostedt (Red Hat) }
5320f1ff6348SSteven Rostedt (Red Hat) 
532187354059SSteven Rostedt (Red Hat) /**
532287354059SSteven Rostedt (Red Hat)  * ftrace_ops_get_func - get the function a trampoline should call
532387354059SSteven Rostedt (Red Hat)  * @ops: the ops to get the function for
532487354059SSteven Rostedt (Red Hat)  *
532587354059SSteven Rostedt (Red Hat)  * Normally the mcount trampoline will call the ops->func, but there
532687354059SSteven Rostedt (Red Hat)  * are times that it should not. For example, if the ops does not
532787354059SSteven Rostedt (Red Hat)  * have its own recursion protection, then it should call the
532887354059SSteven Rostedt (Red Hat)  * ftrace_ops_recurs_func() instead.
532987354059SSteven Rostedt (Red Hat)  *
533087354059SSteven Rostedt (Red Hat)  * Returns the function that the trampoline should call for @ops.
533187354059SSteven Rostedt (Red Hat)  */
533287354059SSteven Rostedt (Red Hat) ftrace_func_t ftrace_ops_get_func(struct ftrace_ops *ops)
533387354059SSteven Rostedt (Red Hat) {
533487354059SSteven Rostedt (Red Hat) 	/*
5335c68c0fa2SSteven Rostedt (Red Hat) 	 * If the function does not handle recursion, needs to be RCU safe,
5336c68c0fa2SSteven Rostedt (Red Hat) 	 * or does per cpu logic, then we need to call the assist handler.
533787354059SSteven Rostedt (Red Hat) 	 */
5338c68c0fa2SSteven Rostedt (Red Hat) 	if (!(ops->flags & FTRACE_OPS_FL_RECURSION_SAFE) ||
5339c68c0fa2SSteven Rostedt (Red Hat) 	    ops->flags & (FTRACE_OPS_FL_RCU | FTRACE_OPS_FL_PER_CPU))
5340c68c0fa2SSteven Rostedt (Red Hat) 		return ftrace_ops_assist_func;
534187354059SSteven Rostedt (Red Hat) 
534287354059SSteven Rostedt (Red Hat) 	return ops->func;
534387354059SSteven Rostedt (Red Hat) }
534487354059SSteven Rostedt (Red Hat) 
5345e32d8956SSteven Rostedt static void clear_ftrace_swapper(void)
5346e32d8956SSteven Rostedt {
5347e32d8956SSteven Rostedt 	struct task_struct *p;
5348e32d8956SSteven Rostedt 	int cpu;
5349e32d8956SSteven Rostedt 
5350e32d8956SSteven Rostedt 	get_online_cpus();
5351e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
5352e32d8956SSteven Rostedt 		p = idle_task(cpu);
5353e32d8956SSteven Rostedt 		clear_tsk_trace_trace(p);
5354e32d8956SSteven Rostedt 	}
5355e32d8956SSteven Rostedt 	put_online_cpus();
5356e32d8956SSteven Rostedt }
5357e32d8956SSteven Rostedt 
5358e32d8956SSteven Rostedt static void set_ftrace_swapper(void)
5359e32d8956SSteven Rostedt {
5360e32d8956SSteven Rostedt 	struct task_struct *p;
5361e32d8956SSteven Rostedt 	int cpu;
5362e32d8956SSteven Rostedt 
5363e32d8956SSteven Rostedt 	get_online_cpus();
5364e32d8956SSteven Rostedt 	for_each_online_cpu(cpu) {
5365e32d8956SSteven Rostedt 		p = idle_task(cpu);
5366e32d8956SSteven Rostedt 		set_tsk_trace_trace(p);
5367e32d8956SSteven Rostedt 	}
5368e32d8956SSteven Rostedt 	put_online_cpus();
5369e32d8956SSteven Rostedt }
5370e32d8956SSteven Rostedt 
5371e32d8956SSteven Rostedt static void clear_ftrace_pid(struct pid *pid)
5372978f3a45SSteven Rostedt {
5373978f3a45SSteven Rostedt 	struct task_struct *p;
5374978f3a45SSteven Rostedt 
5375229c4ef8SOleg Nesterov 	rcu_read_lock();
5376e32d8956SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
5377978f3a45SSteven Rostedt 		clear_tsk_trace_trace(p);
5378e32d8956SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
5379229c4ef8SOleg Nesterov 	rcu_read_unlock();
5380229c4ef8SOleg Nesterov 
5381e32d8956SSteven Rostedt 	put_pid(pid);
5382978f3a45SSteven Rostedt }
5383978f3a45SSteven Rostedt 
5384e32d8956SSteven Rostedt static void set_ftrace_pid(struct pid *pid)
5385978f3a45SSteven Rostedt {
5386978f3a45SSteven Rostedt 	struct task_struct *p;
5387978f3a45SSteven Rostedt 
5388229c4ef8SOleg Nesterov 	rcu_read_lock();
5389978f3a45SSteven Rostedt 	do_each_pid_task(pid, PIDTYPE_PID, p) {
5390978f3a45SSteven Rostedt 		set_tsk_trace_trace(p);
5391978f3a45SSteven Rostedt 	} while_each_pid_task(pid, PIDTYPE_PID, p);
5392229c4ef8SOleg Nesterov 	rcu_read_unlock();
5393978f3a45SSteven Rostedt }
5394978f3a45SSteven Rostedt 
5395756d17eeS[email protected] static void clear_ftrace_pid_task(struct pid *pid)
5396e32d8956SSteven Rostedt {
5397756d17eeS[email protected] 	if (pid == ftrace_swapper_pid)
5398e32d8956SSteven Rostedt 		clear_ftrace_swapper();
5399e32d8956SSteven Rostedt 	else
5400756d17eeS[email protected] 		clear_ftrace_pid(pid);
5401e32d8956SSteven Rostedt }
5402e32d8956SSteven Rostedt 
5403e32d8956SSteven Rostedt static void set_ftrace_pid_task(struct pid *pid)
5404e32d8956SSteven Rostedt {
5405e32d8956SSteven Rostedt 	if (pid == ftrace_swapper_pid)
5406e32d8956SSteven Rostedt 		set_ftrace_swapper();
5407e32d8956SSteven Rostedt 	else
5408e32d8956SSteven Rostedt 		set_ftrace_pid(pid);
5409e32d8956SSteven Rostedt }
5410e32d8956SSteven Rostedt 
5411756d17eeS[email protected] static int ftrace_pid_add(int p)
5412756d17eeS[email protected] {
5413756d17eeS[email protected] 	struct pid *pid;
5414756d17eeS[email protected] 	struct ftrace_pid *fpid;
5415756d17eeS[email protected] 	int ret = -EINVAL;
5416756d17eeS[email protected] 
5417756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5418756d17eeS[email protected] 
5419756d17eeS[email protected] 	if (!p)
5420756d17eeS[email protected] 		pid = ftrace_swapper_pid;
5421756d17eeS[email protected] 	else
5422756d17eeS[email protected] 		pid = find_get_pid(p);
5423756d17eeS[email protected] 
5424756d17eeS[email protected] 	if (!pid)
5425756d17eeS[email protected] 		goto out;
5426756d17eeS[email protected] 
5427756d17eeS[email protected] 	ret = 0;
5428756d17eeS[email protected] 
5429756d17eeS[email protected] 	list_for_each_entry(fpid, &ftrace_pids, list)
5430756d17eeS[email protected] 		if (fpid->pid == pid)
5431756d17eeS[email protected] 			goto out_put;
5432756d17eeS[email protected] 
5433756d17eeS[email protected] 	ret = -ENOMEM;
5434756d17eeS[email protected] 
5435756d17eeS[email protected] 	fpid = kmalloc(sizeof(*fpid), GFP_KERNEL);
5436756d17eeS[email protected] 	if (!fpid)
5437756d17eeS[email protected] 		goto out_put;
5438756d17eeS[email protected] 
5439756d17eeS[email protected] 	list_add(&fpid->list, &ftrace_pids);
5440756d17eeS[email protected] 	fpid->pid = pid;
5441756d17eeS[email protected] 
5442756d17eeS[email protected] 	set_ftrace_pid_task(pid);
5443756d17eeS[email protected] 
5444756d17eeS[email protected] 	ftrace_update_pid_func();
5445e1effa01SSteven Rostedt (Red Hat) 
5446e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5447756d17eeS[email protected] 
5448756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5449756d17eeS[email protected] 	return 0;
5450756d17eeS[email protected] 
5451756d17eeS[email protected] out_put:
5452756d17eeS[email protected] 	if (pid != ftrace_swapper_pid)
5453756d17eeS[email protected] 		put_pid(pid);
5454756d17eeS[email protected] 
5455756d17eeS[email protected] out:
5456756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5457756d17eeS[email protected] 	return ret;
5458756d17eeS[email protected] }
5459756d17eeS[email protected] 
5460756d17eeS[email protected] static void ftrace_pid_reset(void)
5461756d17eeS[email protected] {
5462756d17eeS[email protected] 	struct ftrace_pid *fpid, *safe;
5463756d17eeS[email protected] 
5464756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5465756d17eeS[email protected] 	list_for_each_entry_safe(fpid, safe, &ftrace_pids, list) {
5466756d17eeS[email protected] 		struct pid *pid = fpid->pid;
5467756d17eeS[email protected] 
5468756d17eeS[email protected] 		clear_ftrace_pid_task(pid);
5469756d17eeS[email protected] 
5470756d17eeS[email protected] 		list_del(&fpid->list);
5471756d17eeS[email protected] 		kfree(fpid);
5472756d17eeS[email protected] 	}
5473756d17eeS[email protected] 
5474756d17eeS[email protected] 	ftrace_update_pid_func();
5475e1effa01SSteven Rostedt (Red Hat) 	ftrace_startup_all(0);
5476756d17eeS[email protected] 
5477756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5478756d17eeS[email protected] }
5479756d17eeS[email protected] 
5480756d17eeS[email protected] static void *fpid_start(struct seq_file *m, loff_t *pos)
5481756d17eeS[email protected] {
5482756d17eeS[email protected] 	mutex_lock(&ftrace_lock);
5483756d17eeS[email protected] 
5484e3eea140SSteven Rostedt (Red Hat) 	if (!ftrace_pids_enabled() && (!*pos))
5485756d17eeS[email protected] 		return (void *) 1;
5486756d17eeS[email protected] 
5487756d17eeS[email protected] 	return seq_list_start(&ftrace_pids, *pos);
5488756d17eeS[email protected] }
5489756d17eeS[email protected] 
5490756d17eeS[email protected] static void *fpid_next(struct seq_file *m, void *v, loff_t *pos)
5491756d17eeS[email protected] {
5492756d17eeS[email protected] 	if (v == (void *)1)
5493756d17eeS[email protected] 		return NULL;
5494756d17eeS[email protected] 
5495756d17eeS[email protected] 	return seq_list_next(v, &ftrace_pids, pos);
5496756d17eeS[email protected] }
5497756d17eeS[email protected] 
5498756d17eeS[email protected] static void fpid_stop(struct seq_file *m, void *p)
5499756d17eeS[email protected] {
5500756d17eeS[email protected] 	mutex_unlock(&ftrace_lock);
5501756d17eeS[email protected] }
5502756d17eeS[email protected] 
5503756d17eeS[email protected] static int fpid_show(struct seq_file *m, void *v)
5504756d17eeS[email protected] {
5505756d17eeS[email protected] 	const struct ftrace_pid *fpid = list_entry(v, struct ftrace_pid, list);
5506756d17eeS[email protected] 
5507756d17eeS[email protected] 	if (v == (void *)1) {
5508fa6f0cc7SRasmus Villemoes 		seq_puts(m, "no pid\n");
5509756d17eeS[email protected] 		return 0;
5510756d17eeS[email protected] 	}
5511756d17eeS[email protected] 
5512756d17eeS[email protected] 	if (fpid->pid == ftrace_swapper_pid)
5513fa6f0cc7SRasmus Villemoes 		seq_puts(m, "swapper tasks\n");
5514756d17eeS[email protected] 	else
5515756d17eeS[email protected] 		seq_printf(m, "%u\n", pid_vnr(fpid->pid));
5516756d17eeS[email protected] 
5517756d17eeS[email protected] 	return 0;
5518756d17eeS[email protected] }
5519756d17eeS[email protected] 
5520756d17eeS[email protected] static const struct seq_operations ftrace_pid_sops = {
5521756d17eeS[email protected] 	.start = fpid_start,
5522756d17eeS[email protected] 	.next = fpid_next,
5523756d17eeS[email protected] 	.stop = fpid_stop,
5524756d17eeS[email protected] 	.show = fpid_show,
5525756d17eeS[email protected] };
5526756d17eeS[email protected] 
5527756d17eeS[email protected] static int
5528756d17eeS[email protected] ftrace_pid_open(struct inode *inode, struct file *file)
5529756d17eeS[email protected] {
5530756d17eeS[email protected] 	int ret = 0;
5531756d17eeS[email protected] 
5532756d17eeS[email protected] 	if ((file->f_mode & FMODE_WRITE) &&
5533756d17eeS[email protected] 	    (file->f_flags & O_TRUNC))
5534756d17eeS[email protected] 		ftrace_pid_reset();
5535756d17eeS[email protected] 
5536756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
5537756d17eeS[email protected] 		ret = seq_open(file, &ftrace_pid_sops);
5538756d17eeS[email protected] 
5539756d17eeS[email protected] 	return ret;
5540756d17eeS[email protected] }
5541756d17eeS[email protected] 
5542df4fc315SSteven Rostedt static ssize_t
5543df4fc315SSteven Rostedt ftrace_pid_write(struct file *filp, const char __user *ubuf,
5544df4fc315SSteven Rostedt 		   size_t cnt, loff_t *ppos)
5545df4fc315SSteven Rostedt {
5546457dc928SIngo Molnar 	char buf[64], *tmp;
5547df4fc315SSteven Rostedt 	long val;
5548df4fc315SSteven Rostedt 	int ret;
5549df4fc315SSteven Rostedt 
5550df4fc315SSteven Rostedt 	if (cnt >= sizeof(buf))
5551df4fc315SSteven Rostedt 		return -EINVAL;
5552df4fc315SSteven Rostedt 
5553df4fc315SSteven Rostedt 	if (copy_from_user(&buf, ubuf, cnt))
5554df4fc315SSteven Rostedt 		return -EFAULT;
5555df4fc315SSteven Rostedt 
5556df4fc315SSteven Rostedt 	buf[cnt] = 0;
5557df4fc315SSteven Rostedt 
5558756d17eeS[email protected] 	/*
5559756d17eeS[email protected] 	 * Allow "echo > set_ftrace_pid" or "echo -n '' > set_ftrace_pid"
5560756d17eeS[email protected] 	 * to clean the filter quietly.
5561756d17eeS[email protected] 	 */
5562457dc928SIngo Molnar 	tmp = strstrip(buf);
5563457dc928SIngo Molnar 	if (strlen(tmp) == 0)
5564756d17eeS[email protected] 		return 1;
5565756d17eeS[email protected] 
5566bcd83ea6SDaniel Walter 	ret = kstrtol(tmp, 10, &val);
5567df4fc315SSteven Rostedt 	if (ret < 0)
5568df4fc315SSteven Rostedt 		return ret;
5569df4fc315SSteven Rostedt 
5570756d17eeS[email protected] 	ret = ftrace_pid_add(val);
5571978f3a45SSteven Rostedt 
5572756d17eeS[email protected] 	return ret ? ret : cnt;
5573e32d8956SSteven Rostedt }
5574978f3a45SSteven Rostedt 
5575756d17eeS[email protected] static int
5576756d17eeS[email protected] ftrace_pid_release(struct inode *inode, struct file *file)
5577756d17eeS[email protected] {
5578756d17eeS[email protected] 	if (file->f_mode & FMODE_READ)
5579756d17eeS[email protected] 		seq_release(inode, file);
5580978f3a45SSteven Rostedt 
5581756d17eeS[email protected] 	return 0;
5582df4fc315SSteven Rostedt }
5583df4fc315SSteven Rostedt 
55845e2336a0SSteven Rostedt static const struct file_operations ftrace_pid_fops = {
5585756d17eeS[email protected] 	.open		= ftrace_pid_open,
5586df4fc315SSteven Rostedt 	.write		= ftrace_pid_write,
5587756d17eeS[email protected] 	.read		= seq_read,
5588098c879eSSteven Rostedt (Red Hat) 	.llseek		= tracing_lseek,
5589756d17eeS[email protected] 	.release	= ftrace_pid_release,
5590df4fc315SSteven Rostedt };
5591df4fc315SSteven Rostedt 
55928434dc93SSteven Rostedt (Red Hat) static __init int ftrace_init_tracefs(void)
5593df4fc315SSteven Rostedt {
5594df4fc315SSteven Rostedt 	struct dentry *d_tracer;
5595df4fc315SSteven Rostedt 
5596df4fc315SSteven Rostedt 	d_tracer = tracing_init_dentry();
559714a5ae40SSteven Rostedt (Red Hat) 	if (IS_ERR(d_tracer))
5598df4fc315SSteven Rostedt 		return 0;
5599df4fc315SSteven Rostedt 
56008434dc93SSteven Rostedt (Red Hat) 	ftrace_init_dyn_tracefs(d_tracer);
5601df4fc315SSteven Rostedt 
56025452af66SFrederic Weisbecker 	trace_create_file("set_ftrace_pid", 0644, d_tracer,
5603df4fc315SSteven Rostedt 			    NULL, &ftrace_pid_fops);
5604493762fcSSteven Rostedt 
56058434dc93SSteven Rostedt (Red Hat) 	ftrace_profile_tracefs(d_tracer);
5606493762fcSSteven Rostedt 
5607df4fc315SSteven Rostedt 	return 0;
5608df4fc315SSteven Rostedt }
56098434dc93SSteven Rostedt (Red Hat) fs_initcall(ftrace_init_tracefs);
5610df4fc315SSteven Rostedt 
56113d083395SSteven Rostedt /**
561281adbdc0SSteven Rostedt  * ftrace_kill - kill ftrace
5613a2bb6a3dSSteven Rostedt  *
5614a2bb6a3dSSteven Rostedt  * This function should be used by panic code. It stops ftrace
5615a2bb6a3dSSteven Rostedt  * but in a not so nice way. If you need to simply kill ftrace
5616a2bb6a3dSSteven Rostedt  * from a non-atomic section, use ftrace_kill.
5617a2bb6a3dSSteven Rostedt  */
561881adbdc0SSteven Rostedt void ftrace_kill(void)
5619a2bb6a3dSSteven Rostedt {
5620a2bb6a3dSSteven Rostedt 	ftrace_disabled = 1;
5621a2bb6a3dSSteven Rostedt 	ftrace_enabled = 0;
5622a2bb6a3dSSteven Rostedt 	clear_ftrace_function();
5623a2bb6a3dSSteven Rostedt }
5624a2bb6a3dSSteven Rostedt 
5625a2bb6a3dSSteven Rostedt /**
5626e0a413f6SSteven Rostedt  * Test if ftrace is dead or not.
5627e0a413f6SSteven Rostedt  */
5628e0a413f6SSteven Rostedt int ftrace_is_dead(void)
5629e0a413f6SSteven Rostedt {
5630e0a413f6SSteven Rostedt 	return ftrace_disabled;
5631e0a413f6SSteven Rostedt }
5632e0a413f6SSteven Rostedt 
5633e0a413f6SSteven Rostedt /**
56343d083395SSteven Rostedt  * register_ftrace_function - register a function for profiling
56353d083395SSteven Rostedt  * @ops - ops structure that holds the function for profiling.
56363d083395SSteven Rostedt  *
56373d083395SSteven Rostedt  * Register a function to be called by all functions in the
56383d083395SSteven Rostedt  * kernel.
56393d083395SSteven Rostedt  *
56403d083395SSteven Rostedt  * Note: @ops->func and all the functions it calls must be labeled
56413d083395SSteven Rostedt  *       with "notrace", otherwise it will go into a
56423d083395SSteven Rostedt  *       recursive loop.
56433d083395SSteven Rostedt  */
56443d083395SSteven Rostedt int register_ftrace_function(struct ftrace_ops *ops)
56453d083395SSteven Rostedt {
564645a4a237SSteven Rostedt 	int ret = -1;
56474eebcc81SSteven Rostedt 
5648f04f24fbSMasami Hiramatsu 	ftrace_ops_init(ops);
5649f04f24fbSMasami Hiramatsu 
5650e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5651e7d3737eSFrederic Weisbecker 
5652a1cd6173SSteven Rostedt 	ret = ftrace_startup(ops, 0);
5653b848914cSSteven Rostedt 
5654e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
56558d240dd8SBorislav Petkov 
5656b0fc494fSSteven Rostedt 	return ret;
56573d083395SSteven Rostedt }
5658cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(register_ftrace_function);
56593d083395SSteven Rostedt 
56603d083395SSteven Rostedt /**
566132632920SUwe Kleine-Koenig  * unregister_ftrace_function - unregister a function for profiling.
56623d083395SSteven Rostedt  * @ops - ops structure that holds the function to unregister
56633d083395SSteven Rostedt  *
56643d083395SSteven Rostedt  * Unregister a function that was added to be called by ftrace profiling.
56653d083395SSteven Rostedt  */
56663d083395SSteven Rostedt int unregister_ftrace_function(struct ftrace_ops *ops)
56673d083395SSteven Rostedt {
56683d083395SSteven Rostedt 	int ret;
56693d083395SSteven Rostedt 
5670e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
56718a56d776SSteven Rostedt (Red Hat) 	ret = ftrace_shutdown(ops, 0);
5672e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5673b0fc494fSSteven Rostedt 
5674b0fc494fSSteven Rostedt 	return ret;
5675b0fc494fSSteven Rostedt }
5676cdbe61bfSSteven Rostedt EXPORT_SYMBOL_GPL(unregister_ftrace_function);
5677b0fc494fSSteven Rostedt 
5678e309b41dSIngo Molnar int
5679b0fc494fSSteven Rostedt ftrace_enable_sysctl(struct ctl_table *table, int write,
56808d65af78SAlexey Dobriyan 		     void __user *buffer, size_t *lenp,
5681b0fc494fSSteven Rostedt 		     loff_t *ppos)
5682b0fc494fSSteven Rostedt {
568345a4a237SSteven Rostedt 	int ret = -ENODEV;
56844eebcc81SSteven Rostedt 
5685e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5686b0fc494fSSteven Rostedt 
568745a4a237SSteven Rostedt 	if (unlikely(ftrace_disabled))
568845a4a237SSteven Rostedt 		goto out;
568945a4a237SSteven Rostedt 
56908d65af78SAlexey Dobriyan 	ret = proc_dointvec(table, write, buffer, lenp, ppos);
5691b0fc494fSSteven Rostedt 
5692a32c7765SLi Zefan 	if (ret || !write || (last_ftrace_enabled == !!ftrace_enabled))
5693b0fc494fSSteven Rostedt 		goto out;
5694b0fc494fSSteven Rostedt 
5695a32c7765SLi Zefan 	last_ftrace_enabled = !!ftrace_enabled;
5696b0fc494fSSteven Rostedt 
5697b0fc494fSSteven Rostedt 	if (ftrace_enabled) {
5698b0fc494fSSteven Rostedt 
5699b0fc494fSSteven Rostedt 		/* we are starting ftrace again */
57005000c418SJan Kiszka 		if (ftrace_ops_list != &ftrace_list_end)
57015000c418SJan Kiszka 			update_ftrace_function();
5702b0fc494fSSteven Rostedt 
5703524a3868SSteven Rostedt (Red Hat) 		ftrace_startup_sysctl();
5704524a3868SSteven Rostedt (Red Hat) 
5705b0fc494fSSteven Rostedt 	} else {
5706b0fc494fSSteven Rostedt 		/* stopping ftrace calls (just send to ftrace_stub) */
5707b0fc494fSSteven Rostedt 		ftrace_trace_function = ftrace_stub;
5708b0fc494fSSteven Rostedt 
5709b0fc494fSSteven Rostedt 		ftrace_shutdown_sysctl();
5710b0fc494fSSteven Rostedt 	}
5711b0fc494fSSteven Rostedt 
5712b0fc494fSSteven Rostedt  out:
5713e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
57143d083395SSteven Rostedt 	return ret;
571516444a8aSArnaldo Carvalho de Melo }
5716f17845e5SIngo Molnar 
5717fb52607aSFrederic Weisbecker #ifdef CONFIG_FUNCTION_GRAPH_TRACER
5718e7d3737eSFrederic Weisbecker 
57195f151b24SSteven Rostedt (Red Hat) static struct ftrace_ops graph_ops = {
57205f151b24SSteven Rostedt (Red Hat) 	.func			= ftrace_stub,
57215f151b24SSteven Rostedt (Red Hat) 	.flags			= FTRACE_OPS_FL_RECURSION_SAFE |
57225f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_INITIALIZED |
5723e3eea140SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_PID |
57245f151b24SSteven Rostedt (Red Hat) 				   FTRACE_OPS_FL_STUB,
57255f151b24SSteven Rostedt (Red Hat) #ifdef FTRACE_GRAPH_TRAMP_ADDR
57265f151b24SSteven Rostedt (Red Hat) 	.trampoline		= FTRACE_GRAPH_TRAMP_ADDR,
5727aec0be2dSSteven Rostedt (Red Hat) 	/* trampoline_size is only needed for dynamically allocated tramps */
57285f151b24SSteven Rostedt (Red Hat) #endif
57295f151b24SSteven Rostedt (Red Hat) 	ASSIGN_OPS_HASH(graph_ops, &global_ops.local_hash)
57305f151b24SSteven Rostedt (Red Hat) };
57315f151b24SSteven Rostedt (Red Hat) 
573255577204SSteven Rostedt (Red Hat) void ftrace_graph_sleep_time_control(bool enable)
573355577204SSteven Rostedt (Red Hat) {
573455577204SSteven Rostedt (Red Hat) 	fgraph_sleep_time = enable;
573555577204SSteven Rostedt (Red Hat) }
573655577204SSteven Rostedt (Red Hat) 
573755577204SSteven Rostedt (Red Hat) void ftrace_graph_graph_time_control(bool enable)
573855577204SSteven Rostedt (Red Hat) {
573955577204SSteven Rostedt (Red Hat) 	fgraph_graph_time = enable;
574055577204SSteven Rostedt (Red Hat) }
574155577204SSteven Rostedt (Red Hat) 
5742e49dc19cSSteven Rostedt int ftrace_graph_entry_stub(struct ftrace_graph_ent *trace)
5743e49dc19cSSteven Rostedt {
5744e49dc19cSSteven Rostedt 	return 0;
5745e49dc19cSSteven Rostedt }
5746e49dc19cSSteven Rostedt 
5747287b6e68SFrederic Weisbecker /* The callbacks that hook a function */
5748287b6e68SFrederic Weisbecker trace_func_graph_ret_t ftrace_graph_return =
5749287b6e68SFrederic Weisbecker 			(trace_func_graph_ret_t)ftrace_stub;
5750e49dc19cSSteven Rostedt trace_func_graph_ent_t ftrace_graph_entry = ftrace_graph_entry_stub;
575123a8e844SSteven Rostedt (Red Hat) static trace_func_graph_ent_t __ftrace_graph_entry = ftrace_graph_entry_stub;
5752f201ae23SFrederic Weisbecker 
5753f201ae23SFrederic Weisbecker /* Try to assign a return stack array on FTRACE_RETSTACK_ALLOC_SIZE tasks. */
5754f201ae23SFrederic Weisbecker static int alloc_retstack_tasklist(struct ftrace_ret_stack **ret_stack_list)
5755f201ae23SFrederic Weisbecker {
5756f201ae23SFrederic Weisbecker 	int i;
5757f201ae23SFrederic Weisbecker 	int ret = 0;
5758f201ae23SFrederic Weisbecker 	unsigned long flags;
5759f201ae23SFrederic Weisbecker 	int start = 0, end = FTRACE_RETSTACK_ALLOC_SIZE;
5760f201ae23SFrederic Weisbecker 	struct task_struct *g, *t;
5761f201ae23SFrederic Weisbecker 
5762f201ae23SFrederic Weisbecker 	for (i = 0; i < FTRACE_RETSTACK_ALLOC_SIZE; i++) {
5763f201ae23SFrederic Weisbecker 		ret_stack_list[i] = kmalloc(FTRACE_RETFUNC_DEPTH
5764f201ae23SFrederic Weisbecker 					* sizeof(struct ftrace_ret_stack),
5765f201ae23SFrederic Weisbecker 					GFP_KERNEL);
5766f201ae23SFrederic Weisbecker 		if (!ret_stack_list[i]) {
5767f201ae23SFrederic Weisbecker 			start = 0;
5768f201ae23SFrederic Weisbecker 			end = i;
5769f201ae23SFrederic Weisbecker 			ret = -ENOMEM;
5770f201ae23SFrederic Weisbecker 			goto free;
5771f201ae23SFrederic Weisbecker 		}
5772f201ae23SFrederic Weisbecker 	}
5773f201ae23SFrederic Weisbecker 
5774f201ae23SFrederic Weisbecker 	read_lock_irqsave(&tasklist_lock, flags);
5775f201ae23SFrederic Weisbecker 	do_each_thread(g, t) {
5776f201ae23SFrederic Weisbecker 		if (start == end) {
5777f201ae23SFrederic Weisbecker 			ret = -EAGAIN;
5778f201ae23SFrederic Weisbecker 			goto unlock;
5779f201ae23SFrederic Weisbecker 		}
5780f201ae23SFrederic Weisbecker 
5781f201ae23SFrederic Weisbecker 		if (t->ret_stack == NULL) {
5782380c4b14SFrederic Weisbecker 			atomic_set(&t->tracing_graph_pause, 0);
5783f201ae23SFrederic Weisbecker 			atomic_set(&t->trace_overrun, 0);
578426c01624SSteven Rostedt 			t->curr_ret_stack = -1;
578526c01624SSteven Rostedt 			/* Make sure the tasks see the -1 first: */
578626c01624SSteven Rostedt 			smp_wmb();
578726c01624SSteven Rostedt 			t->ret_stack = ret_stack_list[start++];
5788f201ae23SFrederic Weisbecker 		}
5789f201ae23SFrederic Weisbecker 	} while_each_thread(g, t);
5790f201ae23SFrederic Weisbecker 
5791f201ae23SFrederic Weisbecker unlock:
5792f201ae23SFrederic Weisbecker 	read_unlock_irqrestore(&tasklist_lock, flags);
5793f201ae23SFrederic Weisbecker free:
5794f201ae23SFrederic Weisbecker 	for (i = start; i < end; i++)
5795f201ae23SFrederic Weisbecker 		kfree(ret_stack_list[i]);
5796f201ae23SFrederic Weisbecker 	return ret;
5797f201ae23SFrederic Weisbecker }
5798f201ae23SFrederic Weisbecker 
57998aef2d28SSteven Rostedt static void
5800c73464b1SPeter Zijlstra ftrace_graph_probe_sched_switch(void *ignore, bool preempt,
580138516ab5SSteven Rostedt 			struct task_struct *prev, struct task_struct *next)
58028aef2d28SSteven Rostedt {
58038aef2d28SSteven Rostedt 	unsigned long long timestamp;
58048aef2d28SSteven Rostedt 	int index;
58058aef2d28SSteven Rostedt 
5806be6f164aSSteven Rostedt 	/*
5807be6f164aSSteven Rostedt 	 * Does the user want to count the time a function was asleep.
5808be6f164aSSteven Rostedt 	 * If so, do not update the time stamps.
5809be6f164aSSteven Rostedt 	 */
581055577204SSteven Rostedt (Red Hat) 	if (fgraph_sleep_time)
5811be6f164aSSteven Rostedt 		return;
5812be6f164aSSteven Rostedt 
58138aef2d28SSteven Rostedt 	timestamp = trace_clock_local();
58148aef2d28SSteven Rostedt 
58158aef2d28SSteven Rostedt 	prev->ftrace_timestamp = timestamp;
58168aef2d28SSteven Rostedt 
58178aef2d28SSteven Rostedt 	/* only process tasks that we timestamped */
58188aef2d28SSteven Rostedt 	if (!next->ftrace_timestamp)
58198aef2d28SSteven Rostedt 		return;
58208aef2d28SSteven Rostedt 
58218aef2d28SSteven Rostedt 	/*
58228aef2d28SSteven Rostedt 	 * Update all the counters in next to make up for the
58238aef2d28SSteven Rostedt 	 * time next was sleeping.
58248aef2d28SSteven Rostedt 	 */
58258aef2d28SSteven Rostedt 	timestamp -= next->ftrace_timestamp;
58268aef2d28SSteven Rostedt 
58278aef2d28SSteven Rostedt 	for (index = next->curr_ret_stack; index >= 0; index--)
58288aef2d28SSteven Rostedt 		next->ret_stack[index].calltime += timestamp;
58298aef2d28SSteven Rostedt }
58308aef2d28SSteven Rostedt 
5831f201ae23SFrederic Weisbecker /* Allocate a return stack for each task */
5832fb52607aSFrederic Weisbecker static int start_graph_tracing(void)
5833f201ae23SFrederic Weisbecker {
5834f201ae23SFrederic Weisbecker 	struct ftrace_ret_stack **ret_stack_list;
58355b058bcdSFrederic Weisbecker 	int ret, cpu;
5836f201ae23SFrederic Weisbecker 
5837f201ae23SFrederic Weisbecker 	ret_stack_list = kmalloc(FTRACE_RETSTACK_ALLOC_SIZE *
5838f201ae23SFrederic Weisbecker 				sizeof(struct ftrace_ret_stack *),
5839f201ae23SFrederic Weisbecker 				GFP_KERNEL);
5840f201ae23SFrederic Weisbecker 
5841f201ae23SFrederic Weisbecker 	if (!ret_stack_list)
5842f201ae23SFrederic Weisbecker 		return -ENOMEM;
5843f201ae23SFrederic Weisbecker 
58445b058bcdSFrederic Weisbecker 	/* The cpu_boot init_task->ret_stack will never be freed */
5845179c498aSSteven Rostedt 	for_each_online_cpu(cpu) {
5846179c498aSSteven Rostedt 		if (!idle_task(cpu)->ret_stack)
5847868baf07SSteven Rostedt 			ftrace_graph_init_idle_task(idle_task(cpu), cpu);
5848179c498aSSteven Rostedt 	}
58495b058bcdSFrederic Weisbecker 
5850f201ae23SFrederic Weisbecker 	do {
5851f201ae23SFrederic Weisbecker 		ret = alloc_retstack_tasklist(ret_stack_list);
5852f201ae23SFrederic Weisbecker 	} while (ret == -EAGAIN);
5853f201ae23SFrederic Weisbecker 
58548aef2d28SSteven Rostedt 	if (!ret) {
585538516ab5SSteven Rostedt 		ret = register_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
58568aef2d28SSteven Rostedt 		if (ret)
58578aef2d28SSteven Rostedt 			pr_info("ftrace_graph: Couldn't activate tracepoint"
58588aef2d28SSteven Rostedt 				" probe to kernel_sched_switch\n");
58598aef2d28SSteven Rostedt 	}
58608aef2d28SSteven Rostedt 
5861f201ae23SFrederic Weisbecker 	kfree(ret_stack_list);
5862f201ae23SFrederic Weisbecker 	return ret;
5863f201ae23SFrederic Weisbecker }
5864f201ae23SFrederic Weisbecker 
58654a2b8ddaSFrederic Weisbecker /*
58664a2b8ddaSFrederic Weisbecker  * Hibernation protection.
58674a2b8ddaSFrederic Weisbecker  * The state of the current task is too much unstable during
58684a2b8ddaSFrederic Weisbecker  * suspend/restore to disk. We want to protect against that.
58694a2b8ddaSFrederic Weisbecker  */
58704a2b8ddaSFrederic Weisbecker static int
58714a2b8ddaSFrederic Weisbecker ftrace_suspend_notifier_call(struct notifier_block *bl, unsigned long state,
58724a2b8ddaSFrederic Weisbecker 							void *unused)
58734a2b8ddaSFrederic Weisbecker {
58744a2b8ddaSFrederic Weisbecker 	switch (state) {
58754a2b8ddaSFrederic Weisbecker 	case PM_HIBERNATION_PREPARE:
58764a2b8ddaSFrederic Weisbecker 		pause_graph_tracing();
58774a2b8ddaSFrederic Weisbecker 		break;
58784a2b8ddaSFrederic Weisbecker 
58794a2b8ddaSFrederic Weisbecker 	case PM_POST_HIBERNATION:
58804a2b8ddaSFrederic Weisbecker 		unpause_graph_tracing();
58814a2b8ddaSFrederic Weisbecker 		break;
58824a2b8ddaSFrederic Weisbecker 	}
58834a2b8ddaSFrederic Weisbecker 	return NOTIFY_DONE;
58844a2b8ddaSFrederic Weisbecker }
58854a2b8ddaSFrederic Weisbecker 
588623a8e844SSteven Rostedt (Red Hat) static int ftrace_graph_entry_test(struct ftrace_graph_ent *trace)
588723a8e844SSteven Rostedt (Red Hat) {
588823a8e844SSteven Rostedt (Red Hat) 	if (!ftrace_ops_test(&global_ops, trace->func, NULL))
588923a8e844SSteven Rostedt (Red Hat) 		return 0;
589023a8e844SSteven Rostedt (Red Hat) 	return __ftrace_graph_entry(trace);
589123a8e844SSteven Rostedt (Red Hat) }
589223a8e844SSteven Rostedt (Red Hat) 
589323a8e844SSteven Rostedt (Red Hat) /*
589423a8e844SSteven Rostedt (Red Hat)  * The function graph tracer should only trace the functions defined
589523a8e844SSteven Rostedt (Red Hat)  * by set_ftrace_filter and set_ftrace_notrace. If another function
589623a8e844SSteven Rostedt (Red Hat)  * tracer ops is registered, the graph tracer requires testing the
589723a8e844SSteven Rostedt (Red Hat)  * function against the global ops, and not just trace any function
589823a8e844SSteven Rostedt (Red Hat)  * that any ftrace_ops registered.
589923a8e844SSteven Rostedt (Red Hat)  */
590023a8e844SSteven Rostedt (Red Hat) static void update_function_graph_func(void)
590123a8e844SSteven Rostedt (Red Hat) {
59025f151b24SSteven Rostedt (Red Hat) 	struct ftrace_ops *op;
59035f151b24SSteven Rostedt (Red Hat) 	bool do_test = false;
59045f151b24SSteven Rostedt (Red Hat) 
59055f151b24SSteven Rostedt (Red Hat) 	/*
59065f151b24SSteven Rostedt (Red Hat) 	 * The graph and global ops share the same set of functions
59075f151b24SSteven Rostedt (Red Hat) 	 * to test. If any other ops is on the list, then
59085f151b24SSteven Rostedt (Red Hat) 	 * the graph tracing needs to test if its the function
59095f151b24SSteven Rostedt (Red Hat) 	 * it should call.
59105f151b24SSteven Rostedt (Red Hat) 	 */
59115f151b24SSteven Rostedt (Red Hat) 	do_for_each_ftrace_op(op, ftrace_ops_list) {
59125f151b24SSteven Rostedt (Red Hat) 		if (op != &global_ops && op != &graph_ops &&
59135f151b24SSteven Rostedt (Red Hat) 		    op != &ftrace_list_end) {
59145f151b24SSteven Rostedt (Red Hat) 			do_test = true;
59155f151b24SSteven Rostedt (Red Hat) 			/* in double loop, break out with goto */
59165f151b24SSteven Rostedt (Red Hat) 			goto out;
59175f151b24SSteven Rostedt (Red Hat) 		}
59185f151b24SSteven Rostedt (Red Hat) 	} while_for_each_ftrace_op(op);
59195f151b24SSteven Rostedt (Red Hat)  out:
59205f151b24SSteven Rostedt (Red Hat) 	if (do_test)
592123a8e844SSteven Rostedt (Red Hat) 		ftrace_graph_entry = ftrace_graph_entry_test;
59225f151b24SSteven Rostedt (Red Hat) 	else
59235f151b24SSteven Rostedt (Red Hat) 		ftrace_graph_entry = __ftrace_graph_entry;
592423a8e844SSteven Rostedt (Red Hat) }
592523a8e844SSteven Rostedt (Red Hat) 
59268275f69fSMathias Krause static struct notifier_block ftrace_suspend_notifier = {
59278275f69fSMathias Krause 	.notifier_call = ftrace_suspend_notifier_call,
59288275f69fSMathias Krause };
59298275f69fSMathias Krause 
5930287b6e68SFrederic Weisbecker int register_ftrace_graph(trace_func_graph_ret_t retfunc,
5931287b6e68SFrederic Weisbecker 			trace_func_graph_ent_t entryfunc)
593215e6cb36SFrederic Weisbecker {
5933e7d3737eSFrederic Weisbecker 	int ret = 0;
5934e7d3737eSFrederic Weisbecker 
5935e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5936e7d3737eSFrederic Weisbecker 
593705ce5818SSteven Rostedt 	/* we currently allow only one tracer registered at a time */
5938597af815SSteven Rostedt 	if (ftrace_graph_active) {
593905ce5818SSteven Rostedt 		ret = -EBUSY;
594005ce5818SSteven Rostedt 		goto out;
594105ce5818SSteven Rostedt 	}
594205ce5818SSteven Rostedt 
59434a2b8ddaSFrederic Weisbecker 	register_pm_notifier(&ftrace_suspend_notifier);
59444a2b8ddaSFrederic Weisbecker 
5945597af815SSteven Rostedt 	ftrace_graph_active++;
5946fb52607aSFrederic Weisbecker 	ret = start_graph_tracing();
5947f201ae23SFrederic Weisbecker 	if (ret) {
5948597af815SSteven Rostedt 		ftrace_graph_active--;
5949f201ae23SFrederic Weisbecker 		goto out;
5950f201ae23SFrederic Weisbecker 	}
5951e53a6319SSteven Rostedt 
5952287b6e68SFrederic Weisbecker 	ftrace_graph_return = retfunc;
595323a8e844SSteven Rostedt (Red Hat) 
595423a8e844SSteven Rostedt (Red Hat) 	/*
595523a8e844SSteven Rostedt (Red Hat) 	 * Update the indirect function to the entryfunc, and the
595623a8e844SSteven Rostedt (Red Hat) 	 * function that gets called to the entry_test first. Then
595723a8e844SSteven Rostedt (Red Hat) 	 * call the update fgraph entry function to determine if
595823a8e844SSteven Rostedt (Red Hat) 	 * the entryfunc should be called directly or not.
595923a8e844SSteven Rostedt (Red Hat) 	 */
596023a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = entryfunc;
596123a8e844SSteven Rostedt (Red Hat) 	ftrace_graph_entry = ftrace_graph_entry_test;
596223a8e844SSteven Rostedt (Red Hat) 	update_function_graph_func();
5963e53a6319SSteven Rostedt 
59645f151b24SSteven Rostedt (Red Hat) 	ret = ftrace_startup(&graph_ops, FTRACE_START_FUNC_RET);
5965e7d3737eSFrederic Weisbecker out:
5966e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
5967e7d3737eSFrederic Weisbecker 	return ret;
596815e6cb36SFrederic Weisbecker }
596915e6cb36SFrederic Weisbecker 
5970fb52607aSFrederic Weisbecker void unregister_ftrace_graph(void)
597115e6cb36SFrederic Weisbecker {
5972e6ea44e9SSteven Rostedt 	mutex_lock(&ftrace_lock);
5973e7d3737eSFrederic Weisbecker 
5974597af815SSteven Rostedt 	if (unlikely(!ftrace_graph_active))
59752aad1b76SSteven Rostedt 		goto out;
59762aad1b76SSteven Rostedt 
5977597af815SSteven Rostedt 	ftrace_graph_active--;
5978287b6e68SFrederic Weisbecker 	ftrace_graph_return = (trace_func_graph_ret_t)ftrace_stub;
5979e49dc19cSSteven Rostedt 	ftrace_graph_entry = ftrace_graph_entry_stub;
598023a8e844SSteven Rostedt (Red Hat) 	__ftrace_graph_entry = ftrace_graph_entry_stub;
59815f151b24SSteven Rostedt (Red Hat) 	ftrace_shutdown(&graph_ops, FTRACE_STOP_FUNC_RET);
59824a2b8ddaSFrederic Weisbecker 	unregister_pm_notifier(&ftrace_suspend_notifier);
598338516ab5SSteven Rostedt 	unregister_trace_sched_switch(ftrace_graph_probe_sched_switch, NULL);
5984e7d3737eSFrederic Weisbecker 
5985f3bea491SSteven Rostedt (Red Hat) #ifdef CONFIG_DYNAMIC_FTRACE
5986f3bea491SSteven Rostedt (Red Hat) 	/*
5987f3bea491SSteven Rostedt (Red Hat) 	 * Function graph does not allocate the trampoline, but
5988f3bea491SSteven Rostedt (Red Hat) 	 * other global_ops do. We need to reset the ALLOC_TRAMP flag
5989f3bea491SSteven Rostedt (Red Hat) 	 * if one was used.
5990f3bea491SSteven Rostedt (Red Hat) 	 */
5991f3bea491SSteven Rostedt (Red Hat) 	global_ops.trampoline = save_global_trampoline;
5992f3bea491SSteven Rostedt (Red Hat) 	if (save_global_flags & FTRACE_OPS_FL_ALLOC_TRAMP)
5993f3bea491SSteven Rostedt (Red Hat) 		global_ops.flags |= FTRACE_OPS_FL_ALLOC_TRAMP;
5994f3bea491SSteven Rostedt (Red Hat) #endif
5995f3bea491SSteven Rostedt (Red Hat) 
59962aad1b76SSteven Rostedt  out:
5997e6ea44e9SSteven Rostedt 	mutex_unlock(&ftrace_lock);
599815e6cb36SFrederic Weisbecker }
5999f201ae23SFrederic Weisbecker 
6000868baf07SSteven Rostedt static DEFINE_PER_CPU(struct ftrace_ret_stack *, idle_ret_stack);
6001868baf07SSteven Rostedt 
6002868baf07SSteven Rostedt static void
6003868baf07SSteven Rostedt graph_init_task(struct task_struct *t, struct ftrace_ret_stack *ret_stack)
6004868baf07SSteven Rostedt {
6005868baf07SSteven Rostedt 	atomic_set(&t->tracing_graph_pause, 0);
6006868baf07SSteven Rostedt 	atomic_set(&t->trace_overrun, 0);
6007868baf07SSteven Rostedt 	t->ftrace_timestamp = 0;
600825985edcSLucas De Marchi 	/* make curr_ret_stack visible before we add the ret_stack */
6009868baf07SSteven Rostedt 	smp_wmb();
6010868baf07SSteven Rostedt 	t->ret_stack = ret_stack;
6011868baf07SSteven Rostedt }
6012868baf07SSteven Rostedt 
6013868baf07SSteven Rostedt /*
6014868baf07SSteven Rostedt  * Allocate a return stack for the idle task. May be the first
6015868baf07SSteven Rostedt  * time through, or it may be done by CPU hotplug online.
6016868baf07SSteven Rostedt  */
6017868baf07SSteven Rostedt void ftrace_graph_init_idle_task(struct task_struct *t, int cpu)
6018868baf07SSteven Rostedt {
6019868baf07SSteven Rostedt 	t->curr_ret_stack = -1;
6020868baf07SSteven Rostedt 	/*
6021868baf07SSteven Rostedt 	 * The idle task has no parent, it either has its own
6022868baf07SSteven Rostedt 	 * stack or no stack at all.
6023868baf07SSteven Rostedt 	 */
6024868baf07SSteven Rostedt 	if (t->ret_stack)
6025868baf07SSteven Rostedt 		WARN_ON(t->ret_stack != per_cpu(idle_ret_stack, cpu));
6026868baf07SSteven Rostedt 
6027868baf07SSteven Rostedt 	if (ftrace_graph_active) {
6028868baf07SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
6029868baf07SSteven Rostedt 
6030868baf07SSteven Rostedt 		ret_stack = per_cpu(idle_ret_stack, cpu);
6031868baf07SSteven Rostedt 		if (!ret_stack) {
6032868baf07SSteven Rostedt 			ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6033868baf07SSteven Rostedt 					    * sizeof(struct ftrace_ret_stack),
6034868baf07SSteven Rostedt 					    GFP_KERNEL);
6035868baf07SSteven Rostedt 			if (!ret_stack)
6036868baf07SSteven Rostedt 				return;
6037868baf07SSteven Rostedt 			per_cpu(idle_ret_stack, cpu) = ret_stack;
6038868baf07SSteven Rostedt 		}
6039868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
6040868baf07SSteven Rostedt 	}
6041868baf07SSteven Rostedt }
6042868baf07SSteven Rostedt 
6043f201ae23SFrederic Weisbecker /* Allocate a return stack for newly created task */
6044fb52607aSFrederic Weisbecker void ftrace_graph_init_task(struct task_struct *t)
6045f201ae23SFrederic Weisbecker {
604684047e36SSteven Rostedt 	/* Make sure we do not use the parent ret_stack */
604784047e36SSteven Rostedt 	t->ret_stack = NULL;
6048ea14eb71SSteven Rostedt 	t->curr_ret_stack = -1;
604984047e36SSteven Rostedt 
6050597af815SSteven Rostedt 	if (ftrace_graph_active) {
605182310a32SSteven Rostedt 		struct ftrace_ret_stack *ret_stack;
605282310a32SSteven Rostedt 
605382310a32SSteven Rostedt 		ret_stack = kmalloc(FTRACE_RETFUNC_DEPTH
6054f201ae23SFrederic Weisbecker 				* sizeof(struct ftrace_ret_stack),
6055f201ae23SFrederic Weisbecker 				GFP_KERNEL);
605682310a32SSteven Rostedt 		if (!ret_stack)
6057f201ae23SFrederic Weisbecker 			return;
6058868baf07SSteven Rostedt 		graph_init_task(t, ret_stack);
605984047e36SSteven Rostedt 	}
6060f201ae23SFrederic Weisbecker }
6061f201ae23SFrederic Weisbecker 
6062fb52607aSFrederic Weisbecker void ftrace_graph_exit_task(struct task_struct *t)
6063f201ae23SFrederic Weisbecker {
6064eae849caSFrederic Weisbecker 	struct ftrace_ret_stack	*ret_stack = t->ret_stack;
6065eae849caSFrederic Weisbecker 
6066f201ae23SFrederic Weisbecker 	t->ret_stack = NULL;
6067eae849caSFrederic Weisbecker 	/* NULL must become visible to IRQs before we free it: */
6068eae849caSFrederic Weisbecker 	barrier();
6069eae849caSFrederic Weisbecker 
6070eae849caSFrederic Weisbecker 	kfree(ret_stack);
6071f201ae23SFrederic Weisbecker }
607215e6cb36SFrederic Weisbecker #endif
6073